Changeset 2043 in ntrip

Timestamp:

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

Author:

mervart

Message:

* empty log message *

Location:

trunk/BNC

Files:

• bncpppclient.cpp (modified) (3 diffs)
• bncutils.cpp (modified) (1 diff)
• bncutils.h (modified) (2 diffs)

trunk/BNC/bncpppclient.cpp

@@ -43 +43 @@
 
 #include "bncpppclient.h"
+#include "bncutils.h"
 
 extern "C" {
@@ -154 +155 @@
       }
       cc->tt.set(GPSweek, GPSweeks);
+      cc->rao.ReSize(3);
       in >> cc->iod >> cc->dClk >> cc->rao[0] >> cc->rao[1] >> cc->rao[2];
     }
@@ -190 +192 @@
 void bncPPPclient::applyCorr(const t_corr* cc, ColumnVector& xc, 
                              ColumnVector& vv) {
+  ColumnVector dx(3);
+  RSW_to_XYZ(xc.Rows(1,3), vv, cc->rao, dx);
+
 
 }

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;
+}

trunk/BNC/bncutils.h

@@ -29 +29 @@
 #include <QDateTime>
 
+#include <newmat.h>
+
 void expandEnvVar(QString& str);
 
@@ -41 +43 @@
                      const QByteArray& height);
 
+void RSW_to_XYZ(const ColumnVector& rr, const ColumnVector& vv,
+                const ColumnVector& rsw, ColumnVector& xyz);
+
 #endif