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

Timestamp:

Aug 6, 2014, 3:59:50 PM (10 years ago)

Author:

mervart

Message:

 

File:

• trunk/BNC/src/ephemeris.cpp (modified) (2 diffs)

trunk/BNC/src/ephemeris.cpp

@@ -12 +12 @@
 #include "bnctime.h"
 #include "bnccore.h"
+#include "bncutils.h"
 #include "PPP/pppInclude.h"
 
@@ -63 +64 @@
   position(tt.gpsw(), tt.gpssec(), xc.data(), vv.data());
   if (useCorr) {
-    throw "t_eph::getCrd: not yet implemented";
+    if (_orbCorr && _clkCorr) {
+      ColumnVector xr = _orbCorr->getX(tt); 
+      ColumnVector dx(3);
+      if (_orbCorr->_system == 'R') {
+        RSW_to_XYZ(xc.Rows(1,3), vv.Rows(1,3), xr, dx);
+      }
+      else {
+        dx = xr;
+      }
+      xc[0] -= dx[0];
+      xc[1] -= dx[1];
+      xc[2] -= dx[2];
+      xc[3] += _clkCorr->getClk(tt);
+    }
+    else {
+      return failure;
+    }
   }
   return success;