1 |
|
---|
2 | /* -------------------------------------------------------------------------
|
---|
3 | * BKG NTRIP Client
|
---|
4 | * -------------------------------------------------------------------------
|
---|
5 | *
|
---|
6 | * Class: hassDecoder
|
---|
7 | *
|
---|
8 | * Purpose: Decode Data (PPP Corrections) in HASS Format
|
---|
9 | *
|
---|
10 | * Author: L. Mervart
|
---|
11 | *
|
---|
12 | * Created: 19-Nov-2011
|
---|
13 | *
|
---|
14 | * Changes:
|
---|
15 | *
|
---|
16 | * -----------------------------------------------------------------------*/
|
---|
17 |
|
---|
18 | #include <iostream>
|
---|
19 | #include "hassDecoder.h"
|
---|
20 | #include "bnctime.h"
|
---|
21 | #include "bncutils.h"
|
---|
22 |
|
---|
23 | using namespace std;
|
---|
24 |
|
---|
25 | // Constructor
|
---|
26 | ////////////////////////////////////////////////////////////////////////////
|
---|
27 | hassDecoder::hassDecoder(const QString& staID) : RTCM3coDecoder(staID) {
|
---|
28 | _GPSweeks = -1.0;
|
---|
29 | }
|
---|
30 |
|
---|
31 | // Destructor
|
---|
32 | ////////////////////////////////////////////////////////////////////////////
|
---|
33 | hassDecoder::~hassDecoder() {
|
---|
34 | }
|
---|
35 |
|
---|
36 | //
|
---|
37 | ////////////////////////////////////////////////////////////////////////////
|
---|
38 | t_irc hassDecoder::Decode(char* data, int dataLen, vector<string>& errmsg) {
|
---|
39 |
|
---|
40 | errmsg.clear();
|
---|
41 |
|
---|
42 | _buffer += QByteArray(data, dataLen);
|
---|
43 |
|
---|
44 | bool corrFound = false;
|
---|
45 | int indexEOL = -1;
|
---|
46 | while ( (indexEOL = _buffer.indexOf('\n')) != -1) {
|
---|
47 | QByteArray line = _buffer.left(indexEOL-1);
|
---|
48 | _buffer = _buffer.mid(indexEOL+1);
|
---|
49 |
|
---|
50 | if (QString(line).split(QRegExp("\\s+"), QString::SkipEmptyParts).count() != 11) {
|
---|
51 | continue;
|
---|
52 | }
|
---|
53 | else {
|
---|
54 | corrFound = true;
|
---|
55 | }
|
---|
56 |
|
---|
57 | QTextStream in(line, QIODevice::ReadOnly | QIODevice::Text);
|
---|
58 | int mjd, IOD;
|
---|
59 | double daySec;
|
---|
60 | ColumnVector dx(3);
|
---|
61 | ColumnVector dxRate(3);
|
---|
62 | double clkFull;
|
---|
63 |
|
---|
64 | QString prn;
|
---|
65 |
|
---|
66 | in >> mjd >> daySec >> prn >> IOD >> dx[0] >> dx[1] >> dx[2] >> clkFull
|
---|
67 | >> dxRate[0] >> dxRate[1] >> dxRate[2];
|
---|
68 |
|
---|
69 | // Correction Time
|
---|
70 | // ---------------
|
---|
71 | bncTime tt;
|
---|
72 | tt.setmjd(daySec, mjd);
|
---|
73 |
|
---|
74 | _GPSweeks = tt.gpssec();
|
---|
75 | long coTime = tt.gpsw() * 7*24*3600 + long(floor(_GPSweeks+0.5));
|
---|
76 |
|
---|
77 | // Transform Correction
|
---|
78 | // --------------------
|
---|
79 | dx = -dx;
|
---|
80 | dxRate = -dxRate;
|
---|
81 |
|
---|
82 | //// beg test
|
---|
83 | continue;
|
---|
84 | //// end test
|
---|
85 | //// t_eph* eph = 0;
|
---|
86 | //// if (_eph.contains(prn)) {
|
---|
87 | //// if (_eph.value(prn)->last && _eph.value(prn)->last->IOD() == IOD) {
|
---|
88 | //// eph = _eph.value(prn)->last;
|
---|
89 | //// }
|
---|
90 | //// else if (_eph.value(prn)->prev && _eph.value(prn)->prev->IOD() == IOD) {
|
---|
91 | //// eph = _eph.value(prn)->prev;
|
---|
92 | //// }
|
---|
93 | //// }
|
---|
94 | //// if (!eph) {
|
---|
95 | //// continue;
|
---|
96 | //// }
|
---|
97 |
|
---|
98 | ColumnVector xc(4);
|
---|
99 | ColumnVector vv(3);
|
---|
100 | //// eph->position(tt.gpsw(), tt.gpssec(), xc.data(), vv.data());
|
---|
101 |
|
---|
102 | ColumnVector rao(3);
|
---|
103 | XYZ_to_RSW(xc.Rows(1,3), vv, dx, rao);
|
---|
104 |
|
---|
105 | ColumnVector dotRao(3);
|
---|
106 | XYZ_to_RSW(xc.Rows(1,3), vv, dxRate, dotRao);
|
---|
107 |
|
---|
108 | double dClk = clkFull - xc[3] * t_CST::c;
|
---|
109 |
|
---|
110 | // Print Correction Line
|
---|
111 | // ---------------------
|
---|
112 | QString corrLine;
|
---|
113 |
|
---|
114 | int updateInterval = 0;
|
---|
115 | int messageType = 0;
|
---|
116 | if (prn[0] == 'G') {
|
---|
117 | messageType = COTYPE_GPSCOMBINED;
|
---|
118 | }
|
---|
119 | else if (prn[0] == 'R') {
|
---|
120 | messageType = COTYPE_GLONASSCOMBINED;
|
---|
121 | }
|
---|
122 |
|
---|
123 | corrLine.sprintf("%d %d %d %.1f %s"
|
---|
124 | " %3d"
|
---|
125 | " %8.3f %8.3f %8.3f %8.3f"
|
---|
126 | " %10.5f %10.5f %10.5f %10.5f"
|
---|
127 | " %10.5f",
|
---|
128 | messageType, updateInterval, tt.gpsw(), _GPSweeks,
|
---|
129 | prn.toAscii().data(), IOD,
|
---|
130 | dClk, rao[0], rao[1], rao[2],
|
---|
131 | 0.0, dotRao[0], dotRao[1], dotRao[2], 0.0);
|
---|
132 |
|
---|
133 | reopen(_fileNameSkl, _fileName, _out);
|
---|
134 | printLine(corrLine, coTime);
|
---|
135 | }
|
---|
136 |
|
---|
137 | if (corrFound) {
|
---|
138 | return success;
|
---|
139 | }
|
---|
140 | else {
|
---|
141 | return failure;
|
---|
142 | }
|
---|
143 | }
|
---|