Changeset 5849 in ntrip for trunk/BNC/src/ephemeris.cpp

Timestamp:

Aug 7, 2014, 12:20:26 PM (10 years ago)

Author:

mervart

Message:

 

File:

• trunk/BNC/src/ephemeris.cpp (modified) (1 diff)

trunk/BNC/src/ephemeris.cpp

@@ -65 +65 @@
   if (useCorr) {
     if (_orbCorr && _clkCorr) {
-      ColumnVector xr = _orbCorr->getX(tt); 
+
+      double dtO = tt - _orbCorr->_time;
       ColumnVector dx(3);
+      dx[0] = _orbCorr->_xr[0] + _orbCorr->_dotXr[0] * dtO;
+      dx[1] = _orbCorr->_xr[1] + _orbCorr->_dotXr[1] * dtO;
+      dx[2] = _orbCorr->_xr[2] + _orbCorr->_dotXr[2] * dtO;
+
       if (_orbCorr->_system == 'R') {
-        RSW_to_XYZ(xc.Rows(1,3), vv.Rows(1,3), xr, dx);
-      }
-      else {
-        dx = xr;
-      }
+        RSW_to_XYZ(xc.Rows(1,3), vv.Rows(1,3), dx, dx);
+      }
+
       xc[0] -= dx[0];
       xc[1] -= dx[1];
       xc[2] -= dx[2];
-      xc[3] += _clkCorr->getClk(tt);
+
+      double dtC = tt - _clkCorr->_time;
+      xc[3] += _clkCorr->_dClk + _clkCorr->_dotDClk * dtC + _clkCorr->_dotDotDClk * dtC * dtC;
     }
     else {