Changeset 3319 in ntrip for trunk/BNC/bncpppclient.cpp

Timestamp:

Jun 27, 2011, 6:18:10 PM (13 years ago)

Author:

mervart

Message:

 

File:

• trunk/BNC/bncpppclient.cpp (modified) (4 diffs)

trunk/BNC/bncpppclient.cpp

@@ -376 +376 @@
           if      (eLast && eLast->IOD() == cc->iod) {
             eLast->position(tt.gpsw(), tt.gpssec(), xc.data(), vv.data());
-            applyCorr(tt, cc, xc, vv);
-            return success;
+            return applyCorr(tt, cc, xc, vv);
           }
           else if (ePrev && ePrev->IOD() == cc->iod) {
             ePrev->position(tt.gpsw(), tt.gpssec(), xc.data(), vv.data());
-            applyCorr(tt, cc, xc, vv);
-            return success;
+            return applyCorr(tt, cc, xc, vv);
           }
         }
@@ -400 +398 @@
 // 
 ////////////////////////////////////////////////////////////////////////////
-void bncPPPclient::applyCorr(const bncTime& tt, const t_corr* cc, 
+t_irc bncPPPclient::applyCorr(const bncTime& tt, const t_corr* cc, 
                              ColumnVector& xc, ColumnVector& vv) {
   ColumnVector dx(3);
@@ -406 +404 @@
   double dt = tt - cc->tt;
   ColumnVector raoHlp = cc->rao + cc->dotRao * dt + cc->dotDotRao * dt * dt;
+
+  if (raoHlp.norm_Frobenius() > 20.0) {
+    return failure;
+  }
 
   RSW_to_XYZ(xc.Rows(1,3), vv, raoHlp, dx);
@@ -413 +415 @@
   xc[2] -= dx[2];
   xc[3] += cc->dClk + cc->dotDClk * dt + cc->dotDotDClk * dt * dt;
+
+  return success;
 }