From ec96120bfa83f97bca3d2fce25eb5bb741f473ec Mon Sep 17 00:00:00 2001
From: OSQZSS <osqzss@gmail.com>
Date: Mon, 8 Aug 2016 17:44:16 +0900
Subject: [PATCH] Fix ephemeris updates

---
 gpssim.c | 25 ++++++++++++++++++++++++-
 1 file changed, 24 insertions(+), 1 deletion(-)

diff --git a/gpssim.c b/gpssim.c
index 91d5c72..f41dc22 100644
--- a/gpssim.c
+++ b/gpssim.c
@@ -2105,8 +2105,8 @@ int main(int argc, char *argv[])
 			if (chan[i].prn>0)
 			{
 				// Refresh code phase and data bit counters
-				int sv = chan[i].prn-1;
 				range_t rho;
+				sv = chan[i].prn-1;
 
 				// Current pseudorange
 				computeRange(&rho, eph[ieph][sv], &ionoutc, grx, xyz[iumd]);
@@ -2230,6 +2230,29 @@ int main(int argc, char *argv[])
 				if (chan[i].prn>0)
 					generateNavMsg(grx, &chan[i], 0);
 
+			// Refresh ephemeris and subframes
+			// Quick and dirty fix. Need more elegant way.
+			for (sv=0; sv<MAX_SAT; sv++)
+			{
+				if (eph[ieph+1][sv].vflg==1)
+				{
+					dt = subGpsTime(eph[ieph+1][sv].toc, grx);
+					if (dt<SECONDS_IN_HOUR)
+					{
+						ieph++;
+
+						for (i=0; i<MAX_CHAN; i++)
+						{
+							// Generate new subframes if allocated
+							if (chan[i].prn!=0) 
+								eph2sbf(eph[ieph][chan[i].prn-1], ionoutc, chan[i].sbf);
+						}
+					}
+						
+					break;
+				}
+			}
+
 			// Update channel allocation
 			allocateChannel(chan, eph[ieph], ionoutc, grx, xyz[iumd], elvmask);