Changeset 1687 in ntrip for trunk/BNS/bnsutils.cpp

Timestamp:

Mar 3, 2009, 11:18:48 AM (15 years ago)

Author:

mervart

Message:

* empty log message *

File:

• trunk/BNS/bnsutils.cpp (modified) (1 diff)

trunk/BNS/bnsutils.cpp

@@ -112 +112 @@
                 const ColumnVector& xyz, ColumnVector& rsw) {
 
-  ColumnVector cross = crossproduct(rr, vv);
+  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, rr)    / rr.norm_Frobenius();
-  rsw(2) = DotProduct(xyz, vv)    / vv.norm_Frobenius();
-  rsw(3) = DotProduct(xyz, cross) / cross.norm_Frobenius();
+  rsw(1) = DotProduct(xyz, radial);
+  rsw(2) = DotProduct(xyz, along);
+  rsw(3) = DotProduct(xyz, cross);
 }