Changeset 661 in ntrip for trunk/BNC/RTIGS/RTIGSDecoder.cpp

Timestamp:

Jan 29, 2008, 3:53:43 PM (17 years ago)

Author:

mervart

Message:

* empty log message *

File:

• trunk/BNC/RTIGS/RTIGSDecoder.cpp (modified) (5 diffs)

trunk/BNC/RTIGS/RTIGSDecoder.cpp

@@ -41 +41 @@
 #include "RTIGSDecoder.h"
 #include "bncconst.h"
+#include "bncapp.h"
 
 using namespace std;
@@ -46 +47 @@
 #undef L1
 #undef L2
+
+// 
+////////////////////////////////////////////////////////////////////////////
+ephSenderRTIGS::ephSenderRTIGS() {
+  connect(this, SIGNAL(newGPSEph(gpsephemeris*)), 
+          (bncApp*) qApp, SLOT(slotNewGPSEph(gpsephemeris*)));
+  //connect(this, SIGNAL(newGlonassEph(glonassephemeris*)), 
+  //        (bncApp*) qApp, SLOT(slotNewGlonassEph(glonassephemeris*)));
+}
 
 // Constructor
@@ -74 +84 @@
       SwitchBytes( (char*) &xx, sizeof(xx) );
     }
-    if (xx == 200) {
+    if (xx == 200 || xx == 300 ) { // 2/1/2008 SPG
       _buffer = _buffer.substr(ii);
       found = true;
@@ -97 +107 @@
   }
 
+  // 2/1/2008 SPG Start
   // Decode the epoch
   // ----------------
   if (messType == 200) {
+  // Decode Obs
     RTIGSO_T  rtigs_obs;
     short numObs = _GPSTrans.Decode_RTIGS_Obs(p_buf, numbytes, rtigs_obs);
@@ -121 +133 @@
     }
   }
+  if(messType==300){
+  // Decode Ephemeris
+    RTIGSE_T rtigs_eph;
+    BEPH_T new_eph;
+    short PRN;
+    // To TNAV_T
+    // ---------
+    short retval = _GPSTrans.Decode_RTIGS_Eph(p_buf, numbytes , rtigs_eph, PRN);
+    // Ensure it was decoded ok.
+    // ------------------------
+    if(retval==1){      
+    // TNAV To BEPH (decodes subframes)
+    // --------------------------------
+      _GPSTrans.TNAV_To_BEPH(&_GPSTrans.TNAV_Eph.Eph[PRN-1],&new_eph);
+      gpsephemeris* ep = new gpsephemeris();
+      // Match datatypes
+      // ---------------
+      ep->flags            = (int)new_eph.l2pflag;
+      ep->satellite        = (int)new_eph.satellite;
+      ep->IODE             = (int)new_eph.issue_of_eph;
+      ep->URAindex         = (int)new_eph.user_range_acc;
+      ep->SVhealth         = (int)new_eph.sat_health;
+      ep->GPSweek          = (int)new_eph.gps_week;
+      ep->IODC             = (int)new_eph.issue_of_clock;
+      ep->TOW              = (int)new_eph.transmit_time;
+      ep->TOC              = (int)new_eph.clock_ref_time;
+      ep->TOE              = (int)new_eph.eph_ref_time;
+      ep->clock_bias       = new_eph.a0;
+      ep->clock_drift      = new_eph.a1;
+      ep->clock_driftrate  = new_eph.a2;
+      ep->Crs              = new_eph.orbit_sin_corr;
+      ep->Delta_n          = new_eph.mean_mot_diff ;
+      ep->M0               = new_eph.ref_mean_anmly;
+      ep->Cuc              = new_eph.lat_cos_corr;
+      ep->e                = new_eph.orbit_ecc;
+      ep->Cus              = new_eph.lat_sin_corr;
+      ep->sqrt_A           = new_eph.orbit_semimaj;
+      ep->Cic              = new_eph.incl_cos_corr;
+      ep->OMEGA0           = new_eph.right_asc;
+      ep->Cis              = new_eph.incl_sin_corr;
+      ep->i0               = new_eph.orbit_incl;
+      ep->Crc              = new_eph.orbit_cos_corr;
+      ep->omega            = new_eph.arg_of_perigee;
+      ep->OMEGADOT         = new_eph.right_asc_rate;
+      ep->IDOT             = new_eph.incl_rate;
+      ep->TGD              = new_eph.group_delay;
+
+      // Pass back to parent class
+      // --------------------
+      emit _ephSender.newGPSEph(ep);
+    }   
+  }
+
+  // 2/1/2008 SPG End
 
   // Unprocessed bytes remain in buffer
   // ----------------------------------
   _buffer = _buffer.substr(numbytes);
-
   return success;
 }