Changeset 2043 in ntrip for trunk/BNC/bncutils.cpp

Timestamp:

Nov 26, 2009, 4:06:08 PM (14 years ago)

Author:

mervart

Message:

* empty log message *

File:

• trunk/BNC/bncutils.cpp (modified) (1 diff)

trunk/BNC/bncutils.cpp

@@ -168 +168 @@
   return gga.toAscii();
 }
+
+// 
+////////////////////////////////////////////////////////////////////////////
+void RSW_to_XYZ(const ColumnVector& rr, const ColumnVector& vv,
+                const ColumnVector& rsw, ColumnVector& xyz) {
+
+  ColumnVector along  = vv / vv.norm_Frobenius();
+  ColumnVector cross  = crossproduct(rr, vv); cross /= cross.norm_Frobenius();
+  ColumnVector radial = crossproduct(along, cross);
+
+  Matrix RR(3,3);
+  RR.Column(1) = radial;
+  RR.Column(2) = along;
+  RR.Column(3) = cross;
+
+  xyz = RR * rsw;
+}