Changeset 1834 in ntrip for trunk/BNC/RTCM3/RTCM3coDecoder.cpp

Timestamp:

May 7, 2009, 11:27:19 AM (15 years ago)

Author:

mervart

Message:

* empty log message *

File:

• trunk/BNC/RTCM3/RTCM3coDecoder.cpp (modified) (2 diffs)

trunk/BNC/RTCM3/RTCM3coDecoder.cpp

@@ -47 +47 @@
 #include "bncapp.h"
 #include "bncsettings.h"
+#include "rtcm3torinex.h"
 
 using namespace std;
@@ -163 +164 @@
         }
         else {
-          double GPSdaysec = fmod(_GPSweeks, 86400.0);
-          int    weekDay   = int((_GPSweeks - GPSdaysec) / 86400.0);
-          if      (GPSdaysec > _co.GLONASSEpochTime + 3600.0) {
+
+          // Guess GPS week and sec using system time
+          // ----------------------------------------
+          int week;
+          double sec;
+          currentGPSWeeks(week, sec); 
+          int weekDay      = int(sec/86400.0); 
+          int GPSDaySecHlp = int(sec) - weekDay * 86400;
+
+          // cout << "week, sec " << week << " " << sec << endl;
+
+          // Second of day (GPS time) from Glonass Epoch
+          // -------------------------------------------
+          QDate date = dateAndTimeFromGPSweek(week, sec).date();
+          int leapSecond = gnumleap(date.year(), date.month(), date.day());
+          int GPSDaySec  = _co.GLONASSEpochTime + 3 * 3600 + leapSecond;
+
+          // cout << "GlonassEpoch, leapSecond, GPSDaySec "
+          //      << _co.GLONASSEpochTime << " " << leapSecond << " "
+          //      << GPSDaySec << endl;
+
+          // Handle the difference between system clock and correction epoch
+          // ---------------------------------------------------------------
+          if      (GPSDaySec < GPSDaySecHlp - 3600) {
             weekDay += 1;
-            if (weekDay > 6) {
-              weekDay = 0;
-              GPSweek += 1;
-            }
           }
-          else if (GPSdaysec < _co.GLONASSEpochTime - 3600.0) {
+          else if (GPSDaySec > GPSDaySecHlp + 3600) {
             weekDay -= 1;
-            if (weekDay < 0) {
-              weekDay = 6;
-              GPSweek -= 1;
-            }
-          }
-          _GPSweeks = weekDay * 86400.0 + _co.GLONASSEpochTime;
+          } 
+
+          _GPSweeks = weekDay * 86400.0 + GPSDaySec;
+                      
+          // cout << "weekDay, _GPSweeks " << weekDay << " " 
+          //      << _GPSweeks << endl;
         }