Changeset 3751 in ntrip

Timestamp:

Mar 30, 2012, 3:44:32 PM (12 years ago)

Author:

mervart

Message:

 

Location:

trunk/BNC

Files:

• bncephuser.cpp (modified) (3 diffs)
• bncephuser.h (modified) (3 diffs)
• bncpppclient.cpp (modified) (6 diffs)
• combination/bnccomb.cpp (modified) (8 diffs)

trunk/BNC/bncephuser.cpp

@@ -208 +208 @@
   double  GPSweeks;
   in >> updateInterval >> GPSweek >> GPSweeks >> prn;
-
-  tt.set(GPSweek, GPSweeks);
 
   if      ( messageType == COTYPE_GPSCOMBINED    || 
@@ -226 +224 @@
     dotDClk    /= t_CST::c;
     dotDotDClk /= t_CST::c;
-    raoSet  = true;
-    dClkSet = true;
+
+    tClk.set(GPSweek, GPSweeks);
+    tRao.set(GPSweek, GPSweeks);
   }
   else if ( messageType == COTYPE_GPSORBIT    || 
@@ -238 +237 @@
       >> dotRao[0]    >> dotRao[1]    >> dotRao[2]
       >> dotDotRao[0] >> dotDotRao[1] >> dotDotRao[2];
-    raoSet  = true;
+
+    tRao.set(GPSweek, GPSweeks);
   }
   else if ( messageType == COTYPE_GPSCLOCK    || 
             messageType == COTYPE_GLONASSCLOCK ) {
-    int dummyIOD;
-    dClk       = 0.0;
-    dotDClk    = 0.0;
-    dotDotDClk = 0.0;
-    in >> dummyIOD >> dClk >> dotDClk >> dotDotDClk;
-    dClk       /= t_CST::c;
-    dotDClk    /= t_CST::c;
-    dotDotDClk /= t_CST::c;
-    dClkSet = true;
+    if (tRao.valid()) {
+      int dummyIOD;
+      dClk       = 0.0;
+      dotDClk    = 0.0;
+      dotDotDClk = 0.0;
+      in >> dummyIOD >> dClk >> dotDClk >> dotDotDClk;
+      dClk       /= t_CST::c;
+      dotDClk    /= t_CST::c;
+      dotDotDClk /= t_CST::c;
+
+      tClk.set(GPSweek, GPSweeks);
+    }
   }
   else if ( messageType == COTYPE_GPSHR    ||
             messageType == COTYPE_GLONASSHR ) {
-    int dummyIOD;
-    in >> dummyIOD >> hrClk;
-    hrClk /= t_CST::c; 
+    if (tRao.valid() && tClk.valid()) {
+      int dummyIOD;
+      in >> dummyIOD >> hrClk;
+      hrClk /= t_CST::c; 
+    }
   }
 

trunk/BNC/bncephuser.h

@@ -40 +40 @@
  public:
   t_corr() {
-    raoSet  = false;
-    dClkSet = false;
-    eph     = 0;
-    hrClk   = 0.0;
+    rao.ReSize(3);       
+    dotRao.ReSize(3);    
+    dotDotRao.ReSize(3); 
+    iod        = 0;
+    dClk       = 0.0;
+    dotDClk    = 0.0;
+    dotDotDClk = 0.0;
+    hrClk      = 0.0;
+    rao        = 0.0;
+    dotRao     = 0.0;
+    dotDotRao  = 0.0;
+    eph        = 0;
   }
-  bool ready() {return raoSet && dClkSet;}
+  
+  ~t_corr() {}
+
+  bool ready() {return tRao.valid() && tClk.valid();}
 
   static bool relevantMessageType(int msgType) {
@@ -61 +72 @@
 
   QString      prn;
-  bncTime      tt;
+  bncTime      tClk;
+  bncTime      tRao;
   int          iod;
   double       dClk;
@@ -70 +82 @@
   ColumnVector dotRao;
   ColumnVector dotDotRao;
-  bool         raoSet;
-  bool         dClkSet;
   const t_eph* eph;
 };

trunk/BNC/bncpppclient.cpp

@@ -271 +271 @@
   }
 
-  // Remove All Corrections
-  // ----------------------
-  //  QMapIterator<QString, t_corr*> ic(_corr);
-  //  while (ic.hasNext()) {
-  //    ic.next();
-  //    delete ic.value();
-  //  }
-  //  _corr.clear();
-
   QListIterator<QString> it(corrList);
   while (it.hasNext()) {
@@ -303 +294 @@
 
       cc->readLine(line);
-      _corr_tt = cc->tt;
+      _corr_tt = cc->tClk;
     }
     else if ( messageType == BTYPE_GPS ) { 
@@ -337 +328 @@
   }
 
-  QMutableMapIterator<QString, t_corr*> im(_corr);
-  while (im.hasNext()) {
-    im.next();
-    t_corr* cc = im.value();
-    if (!cc->ready()) {
-      delete cc;
-      im.remove();
-    }
-  }
 }
 
@@ -360 +342 @@
       if (_corr.contains(prn)) {
         t_corr* cc = _corr.value(prn);
-        if (tt - cc->tt < MAXAGE) {
+        if (cc->ready() && tt - cc->tClk < MAXAGE) {
           t_eph*  eLast = _eph.value(prn)->last;
           t_eph*  ePrev = _eph.value(prn)->prev;
@@ -390 +372 @@
                               ColumnVector& xc, ColumnVector& vv) {
 
-  double dt = tt - cc->tt;
-  ColumnVector raoHlp = cc->rao + cc->dotRao * dt + cc->dotDotRao * dt * dt;
+  double dtRao = tt - cc->tRao;
+  ColumnVector raoHlp = cc->rao + cc->dotRao * dtRao 
+                      + cc->dotDotRao * dtRao * dtRao;
 
   if (raoHlp.norm_Frobenius() > 20.0) {
@@ -402 +385 @@
   xc[1] -= dx[1];
   xc[2] -= dx[2];
-  xc[3] += cc->dClk + cc->dotDClk * dt + cc->dotDotDClk * dt * dt
+
+  double dtClk = tt - cc->tClk;
+
+  xc[3] += cc->dClk + cc->dotDClk * dtClk + cc->dotDotDClk * dtClk * dtClk
         + cc->hrClk;
 

trunk/BNC/combination/bnccomb.cpp

@@ -309 +309 @@
   // Save Orbit-Only Corrections
   // ---------------------------
-  if (newCorr->raoSet && !newCorr->dClkSet) {
+  if (newCorr->tRao.valid() && !newCorr->tClk.valid()) {
     QString corrID = newCorr->ID();
     if (_orbitCorrs.find(corrID) != _orbitCorrs.end()) {
@@ -320 +320 @@
   // Merge with saved orbit correction
   // ---------------------------------
-  else if (newCorr->dClkSet && !newCorr->raoSet) {
+  else if (newCorr->tClk.valid() && !newCorr->tRao.valid()) {
     QString corrID = newCorr->ID();
     if (_orbitCorrs.find(corrID) != _orbitCorrs.end()) {
@@ -329 +329 @@
   // Check Modulo Time
   // -----------------
-  if (int(newCorr->tt.gpssec()) % moduloTime != 0.0) {
+  if (int(newCorr->tClk.gpssec()) % moduloTime != 0.0) {
     delete newCorr;
     return;
@@ -336 +336 @@
   // Delete old corrections
   // ----------------------
-  if (_resTime.valid() && newCorr->tt <= _resTime) {
+  if (_resTime.valid() && newCorr->tClk <= _resTime) {
     delete newCorr;
     return;
@@ -368 +368 @@
   while (itTime.hasNext()) {
     bncTime epoTime = itTime.next();
-    if (epoTime < newCorr->tt - moduloTime) {
+    if (epoTime < newCorr->tClk - moduloTime) {
       _resTime = epoTime;
       processEpoch();
@@ -376 +376 @@
   // Merge or add the correction
   // ---------------------------
-  QVector<cmbCorr*>& corrs = _buffer[newCorr->tt].corrs;
+  QVector<cmbCorr*>& corrs = _buffer[newCorr->tClk].corrs;
   cmbCorr* existingCorr = 0;
   QVectorIterator<cmbCorr*> itCorr(corrs);
@@ -406 +406 @@
   ColumnVector oldXC(4);
   ColumnVector oldVV(3);
-  corr->eph->position(corr->tt.gpsw(), corr->tt.gpssec(), 
+  corr->eph->position(corr->tRao.gpsw(), corr->tRao.gpssec(), 
                       oldXC.data(), oldVV.data());
 
   ColumnVector newXC(4);
   ColumnVector newVV(3);
-  lastEph->position(corr->tt.gpsw(), corr->tt.gpssec(), 
+  lastEph->position(corr->tRao.gpsw(), corr->tRao.gpssec(), 
                     newXC.data(), newVV.data());
 
@@ -1154 +1154 @@
 t_irc bncComb::mergeOrbitCorr(const cmbCorr* orbitCorr, cmbCorr* clkCorr) {
 
-  double dt = clkCorr->tt - orbitCorr->tt;
-
-  clkCorr->iod = orbitCorr->iod; // is it always correct?
-  clkCorr->eph = orbitCorr->eph; 
-
-  clkCorr->rao = orbitCorr->rao 
-               + orbitCorr->dotRao    * dt
-               + orbitCorr->dotDotRao * dt * dt;
-
-  clkCorr->dotRao = orbitCorr->dotRao
-                  + orbitCorr->dotDotRao * dt;
-
+  clkCorr->iod       = orbitCorr->iod; // is it always correct?
+  clkCorr->eph       = orbitCorr->eph; 
+  clkCorr->tRao      = orbitCorr->tRao;
+  clkCorr->rao       = orbitCorr->rao;
+  clkCorr->dotRao    = orbitCorr->dotRao;
   clkCorr->dotDotRao = orbitCorr->dotDotRao;
 
-  clkCorr->raoSet = true;
-
   return success;
 }