Changeset 3571 in ntrip for branches/BNC_LM/GPSS/hassDecoder.cpp

Timestamp:

Dec 25, 2011, 7:27:03 PM (12 years ago)

Author:

mervart

Message:

 

File:

• branches/BNC_LM/GPSS/hassDecoder.cpp (modified) (5 diffs)

branches/BNC_LM/GPSS/hassDecoder.cpp

@@ -16 +16 @@
  * -----------------------------------------------------------------------*/
 
+#include <iostream>
 #include "hassDecoder.h"
 #include "bnctime.h"
+#include "bncutils.h"
 
 using namespace std;
@@ -44 +46 @@
   while ( (indexEOL = _buffer.indexOf('\n')) != -1) {
     QByteArray line = _buffer.left(indexEOL-1);
-    _buffer = _buffer.mid(indexEOL);
+    _buffer = _buffer.mid(indexEOL+1);
 
-    if (QString(line).split(QRegExp("\\s+")).count() != 11) {
+    if (QString(line).split(QRegExp("\\s+"), QString::SkipEmptyParts).count() != 11) {
       continue;
     }
@@ -56 +58 @@
     int     mjd, IOD;
     double  daySec;
-    double  deltaX, deltaY, deltaZ, deltaClk;
-    double  rateDeltaX, rateDeltaY, rateDeltaZ;
+    ColumnVector dx(3);
+    ColumnVector dxRate(3);
+    double clkFull;
+
     QString prn;
     
-    in >> mjd >> daySec >> prn >> IOD >> deltaX >> deltaY >> deltaZ
-       >> deltaClk >> rateDeltaX >> rateDeltaY >> rateDeltaZ;
+    in >> mjd >> daySec >> prn >> IOD >> dx[0] >> dx[1] >> dx[2] >> clkFull
+       >> dxRate[0] >> dxRate[1] >> dxRate[2];
 
+    // Correction Time
+    // ---------------
     bncTime tt; 
     tt.setmjd(daySec, mjd);
@@ -69 +75 @@
     long coTime = tt.gpsw() * 7*24*3600 + long(floor(_GPSweeks+0.5));
 
+    // Transform Correction
+    // --------------------
+    dx     = -dx;
+    dxRate = -dxRate;
+
+    //// beg test
+    continue;
+    //// end test
+    ////  t_eph* eph = 0;
+    ////  if (_eph.contains(prn)) {
+    ////    if      (_eph.value(prn)->last && _eph.value(prn)->last->IOD() == IOD) {
+    ////      eph = _eph.value(prn)->last;
+    ////    }
+    ////    else if (_eph.value(prn)->prev && _eph.value(prn)->prev->IOD() == IOD) {
+    ////      eph = _eph.value(prn)->prev;
+    ////    }
+    ////  }
+    ////  if (!eph) {
+    ////    continue;
+    ////  }
+
+    ColumnVector xc(4);
+    ColumnVector vv(3);
+    ////  eph->position(tt.gpsw(), tt.gpssec(), xc.data(), vv.data());
+
+    ColumnVector rao(3);
+    XYZ_to_RSW(xc.Rows(1,3), vv, dx,     rao);
+
+    ColumnVector dotRao(3);
+    XYZ_to_RSW(xc.Rows(1,3), vv, dxRate, dotRao);
+
+    double dClk = clkFull - xc[3] * t_CST::c;
+
+    // Print Correction Line
+    // ---------------------
     QString corrLine;
 
-    int updateInterval =  0;
-    int messageType = 0;
+    int updateInterval = 0;
+    int messageType    = 0;
     if      (prn[0] == 'G') {
-      messageType = -COTYPE_GPSCOMBINED;
+      messageType = COTYPE_GPSCOMBINED;
     }
     else if (prn[0] == 'R') {
-      messageType = -COTYPE_GLONASSCOMBINED;
+      messageType = COTYPE_GLONASSCOMBINED;
     }
 
@@ -87 +128 @@
                      messageType, updateInterval, tt.gpsw(), _GPSweeks,
                      prn.toAscii().data(), IOD, 
-                     deltaClk, deltaX, deltaY, deltaZ, 
-                     0.0, rateDeltaX, rateDeltaY, rateDeltaZ, 0.0);
-    
+                     dClk, rao[0], rao[1], rao[2],
+                     0.0, dotRao[0], dotRao[1], dotRao[2], 0.0);
+
+    reopen(_fileNameSkl, _fileName, _out);    
     printLine(corrLine, coTime);
   }