Changeset 2988 in ntrip

Timestamp:

Feb 8, 2011, 5:08:02 PM (13 years ago)

Author:

mervart

Message:

 

Location:

trunk/BNC

Files:

• bncutils.cpp (modified) (1 diff)
• bncutils.h (modified) (1 diff)
• combination/bnccomb.cpp (modified) (2 diffs)

trunk/BNC/bncutils.cpp

@@ -191 +191 @@
 }
 
+// Transformation xyz --> radial, along track, out-of-plane
+////////////////////////////////////////////////////////////////////////////
+void XYZ_to_RSW(const ColumnVector& rr, const ColumnVector& vv,
+                const ColumnVector& xyz, ColumnVector& rsw) {
+
+  ColumnVector along  = vv / vv.norm_Frobenius();
+  ColumnVector cross  = crossproduct(rr, vv); cross /= cross.norm_Frobenius();
+  ColumnVector radial = crossproduct(along, cross);
+
+  rsw.ReSize(3);
+  rsw(1) = DotProduct(xyz, radial);
+  rsw(2) = DotProduct(xyz, along);
+  rsw(3) = DotProduct(xyz, cross);
+}
+
 // Rectangular Coordinates -> Ellipsoidal Coordinates
 ////////////////////////////////////////////////////////////////////////////

trunk/BNC/bncutils.h

@@ -47 +47 @@
                 const ColumnVector& rsw, ColumnVector& xyz);
 
+void XYZ_to_RSW(const ColumnVector& rr, const ColumnVector& vv,
+                const ColumnVector& xyz, ColumnVector& rsw);
+
 t_irc xyz2ell(const double* XYZ, double* Ell);
 

trunk/BNC/combination/bnccomb.cpp

@@ -23 +23 @@
 #include "bncsettings.h"
 #include "bncmodel.h"
+#include "bncutils.h"
 
 using namespace std;
@@ -344 +345 @@
   prevEph->position(newCorr->tt.gpsw(), newCorr->tt.gpssec(), 
                     oldXC.data(), oldVV.data());
+
   ColumnVector newXC(4);
   ColumnVector newVV(3);
   lastEph->position(newCorr->tt.gpsw(), newCorr->tt.gpssec(), 
                     newXC.data(), newVV.data());
+
+  ColumnVector dX = newXC.Rows(1,3) - oldXC.Rows(1,3);
+  ColumnVector dRAO(3);
+  XYZ_to_RSW(newXC.Rows(1,3), newVV, dX, dRAO);
 }