source: ntrip/trunk/BNC/src/RTCM3/RTCM3Decoder.cpp@ 6137

Last change on this file since 6137 was 6137, checked in by mervart, 10 years ago
File size: 13.7 KB
Line 
1// Part of BNC, a utility for retrieving decoding and
2// converting GNSS data streams from NTRIP broadcasters.
3//
4// Copyright (C) 2007
5// German Federal Agency for Cartography and Geodesy (BKG)
6// http://www.bkg.bund.de
7// Czech Technical University Prague, Department of Geodesy
8// http://www.fsv.cvut.cz
9//
10// Email: euref-ip@bkg.bund.de
11//
12// This program is free software; you can redistribute it and/or
13// modify it under the terms of the GNU General Public License
14// as published by the Free Software Foundation, version 2.
15//
16// This program is distributed in the hope that it will be useful,
17// but WITHOUT ANY WARRANTY; without even the implied warranty of
18// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
19// GNU General Public License for more details.
20//
21// You should have received a copy of the GNU General Public License
22// along with this program; if not, write to the Free Software
23// Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
24
25/* -------------------------------------------------------------------------
26 * BKG NTRIP Client
27 * -------------------------------------------------------------------------
28 *
29 * Class: RTCM3Decoder
30 *
31 * Purpose: RTCM3 Decoder
32 *
33 * Author: L. Mervart
34 *
35 * Created: 24-Aug-2006
36 *
37 * Changes:
38 *
39 * -----------------------------------------------------------------------*/
40
41#include <iostream>
42#include <iomanip>
43#include <sstream>
44#include <math.h>
45#include <string.h>
46
47#include "RTCM3Decoder.h"
48#include "../RTCM/rtcm_utils.h"
49#include "bncconst.h"
50#include "bnccore.h"
51#include "bncutils.h"
52#include "bncsettings.h"
53
54using namespace std;
55
56#ifndef isinf
57# define isinf(x) 0
58#endif
59
60// Error Handling
61////////////////////////////////////////////////////////////////////////////
62void RTCM3Error(const char*, ...) {
63}
64
65// Constructor
66////////////////////////////////////////////////////////////////////////////
67RTCM3Decoder::RTCM3Decoder(const QString& staID, bncRawFile* rawFile) :
68 GPSDecoder() {
69
70 _staID = staID;
71 _rawFile = rawFile;
72
73 bncSettings settings;
74 _checkMountPoint = settings.value("miscMount").toString();
75
76 connect(this, SIGNAL(newGPSEph(gpsephemeris*)),
77 BNC_CORE, SLOT(slotNewGPSEph(gpsephemeris*)));
78 connect(this, SIGNAL(newGlonassEph(glonassephemeris*, const QString&)),
79 BNC_CORE, SLOT(slotNewGlonassEph(glonassephemeris*, const QString&)));
80 connect(this, SIGNAL(newGalileoEph(galileoephemeris*)),
81 BNC_CORE, SLOT(slotNewGalileoEph(galileoephemeris*)));
82
83 // Mode can be either observations or corrections
84 // ----------------------------------------------
85 _mode = unknown;
86
87 // Antenna position (used for decoding of message 1003)
88 // ----------------------------------------------------
89 _antXYZ[0] = _antXYZ[1] = _antXYZ[2] = 0;
90
91}
92
93// Destructor
94////////////////////////////////////////////////////////////////////////////
95RTCM3Decoder::~RTCM3Decoder() {
96 QMapIterator<QByteArray, RTCM3coDecoder*> it(_coDecoders);
97 while (it.hasNext()) {
98 it.next();
99 delete it.value();
100 }
101}
102
103//
104////////////////////////////////////////////////////////////////////////////
105t_irc RTCM3Decoder::Decode(char* buffer, int bufLen, vector<string>& errmsg) {
106
107 errmsg.clear();
108
109 bool decoded = false;
110
111 // If read from file, mode is always uknown
112 // ----------------------------------------
113 if (_rawFile) {
114 _mode = unknown;
115 _staID = _rawFile->staID();
116 }
117
118 // Try to decode Clock and Orbit Corrections
119 // -----------------------------------------
120 if (_mode == unknown || _mode == corrections) {
121
122 // Find the corresponding coDecoder
123 // --------------------------------
124 if (!_coDecoders.contains(_staID.toAscii())) {
125 _coDecoders[_staID.toAscii()] = new RTCM3coDecoder(_staID);
126 }
127 RTCM3coDecoder* coDecoder = _coDecoders[_staID.toAscii()];
128
129 if ( coDecoder->Decode(buffer, bufLen, errmsg) == success ) {
130 decoded = true;
131 if (!_rawFile && _mode == unknown) {
132 _mode = corrections;
133 }
134 }
135 }
136
137 // Find the corresponding parser, initialize a new parser if necessary
138 // -------------------------------------------------------------------
139 bool newParser = !_parsers.contains(_staID.toAscii());
140 RTCM3ParserData& parser = _parsers[_staID.toAscii()];
141 if (newParser) {
142 memset(&parser, 0, sizeof(parser));
143 parser.rinex3 = 0;
144 double secGPS;
145 currentGPSWeeks(parser.GPSWeek, secGPS);
146 parser.GPSTOW = int(secGPS);
147 }
148
149 // Get Glonass Slot Numbers from Global Array
150 // ------------------------------------------
151 BNC_CORE->getGlonassSlotNums(parser.GLOFreq);
152
153 // Remaining part decodes the Observations
154 // ---------------------------------------
155 if (_mode == unknown || _mode == observations ||
156 _checkMountPoint == _staID || _checkMountPoint == "ALL") {
157
158 for (int iByte = 0; iByte < bufLen; iByte++) {
159
160 parser.Message[parser.MessageSize++] = buffer[iByte];
161
162 if (parser.MessageSize >= parser.NeedBytes) {
163
164 while (int rr = RTCM3Parser(&parser)) {
165
166 // RTCMv3 message types
167 // --------------------
168 _typeList.push_back(parser.blocktype);
169
170 // RTCMv3 antenna descriptor
171 // -------------------------
172 if (rr == 1007 || rr == 1008 || rr == 1033) {
173 _antType.push_back(parser.antenna);
174 }
175
176 // RTCMv3 antenna XYZ
177 // ------------------
178 else if (rr == 1005) {
179 _antList.push_back(t_antInfo());
180 _antList.back().type = t_antInfo::ARP;
181 _antList.back().xx = parser.antX * 1e-4;
182 _antList.back().yy = parser.antY * 1e-4;
183 _antList.back().zz = parser.antZ * 1e-4;
184 _antList.back().message = rr;
185
186 // Remember station position for 1003 message decoding
187 _antXYZ[0] = parser.antX * 1e-4;
188 _antXYZ[1] = parser.antY * 1e-4;
189 _antXYZ[2] = parser.antZ * 1e-4;
190 }
191
192 // RTCMv3 antenna XYZ-H
193 // --------------------
194 else if(rr == 1006) {
195 _antList.push_back(t_antInfo());
196 _antList.back().type = t_antInfo::ARP;
197 _antList.back().xx = parser.antX * 1e-4;
198 _antList.back().yy = parser.antY * 1e-4;
199 _antList.back().zz = parser.antZ * 1e-4;
200 _antList.back().height = parser.antH * 1e-4;
201 _antList.back().height_f = true;
202 _antList.back().message = rr;
203
204 // Remember station position for 1003 message decoding
205 _antXYZ[0] = parser.antX * 1e-4;
206 _antXYZ[1] = parser.antY * 1e-4;
207 _antXYZ[2] = parser.antZ * 1e-4;
208 }
209
210 // GNSS Observations
211 // -----------------
212 else if (rr == 1 || rr == 2) {
213 decoded = true;
214
215 if (!parser.init) {
216 HandleHeader(&parser);
217 parser.init = 1;
218 }
219
220 if (rr == 2) {
221 emit(newMessage( (_staID +
222 ": No valid RINEX! All values are modulo 299792.458!").toAscii(),
223 true));
224 }
225
226 gnssdata& gnssData = parser.Data;
227
228 for (int iSat = 0; iSat < gnssData.numsats; iSat++) {
229
230 t_satObs obs;
231 int satID = gnssData.satellites[iSat];
232
233 // GPS
234 // ---
235 if (satID >= PRN_GPS_START && satID <= PRN_GPS_END) {
236 obs._prn.set('G', satID);
237 }
238
239 // Glonass
240 // -------
241 else if (satID >= PRN_GLONASS_START && satID <= PRN_GLONASS_END) {
242 obs._prn.set('R', satID - PRN_GLONASS_START + 1);
243 }
244
245 // Galileo
246 // -------
247 else if (satID >= PRN_GALILEO_START && satID <= PRN_GALILEO_END) {
248 obs._prn.set('E', satID - PRN_GALILEO_START + 1);
249 }
250
251 // SBAS
252 // ----
253 else if (satID >= PRN_SBAS_START && satID <= PRN_SBAS_END) {
254 obs._prn.set('S', satID - PRN_SBAS_START + 20);
255 }
256
257 // Giove A and B
258 // -------------
259 else if (satID >= PRN_GIOVE_START && satID <= PRN_GIOVE_END) {
260 obs._prn.set('E', satID - PRN_GIOVE_START + PRN_GIOVE_OFFSET);
261 }
262
263 // QZSS
264 // -------------
265 else if (satID >= PRN_QZSS_START && satID <= PRN_QZSS_END) {
266 obs._prn.set('J', satID - PRN_QZSS_START + 1);
267 }
268
269 // COMPASS
270 // -------------
271 else if (satID >= PRN_COMPASS_START && satID <= PRN_COMPASS_END) {
272 obs._prn.set('C', satID - PRN_COMPASS_START + 1);
273 }
274
275 // Unknown System
276 // --------------
277 else {
278 continue;
279 }
280
281 obs._time.set(gnssData.week, gnssData.timeofweek / 1000.0);
282
283 QString prn(obs._prn.toString().c_str());
284
285 int obs_slip_cnt_L1 = 0;
286 int obs_slip_cnt_L2 = 0;
287 int obs_slip_cnt_L5 = 0;
288
289 // Handle loss-of-lock flags
290 // -------------------------
291 const int maxSlipCnt = 100;
292 if (!_slip_cnt_L1.contains(prn)) {
293 _slip_cnt_L1[prn] = 0;
294 _slip_cnt_L2[prn] = 0;
295 _slip_cnt_L5[prn] = 0;
296 }
297 if (GNSSDF2_LOCKLOSSL1 & gnssData.dataflags2[iSat]) {
298 if (_slip_cnt_L1[prn] < maxSlipCnt) {
299 ++_slip_cnt_L1[prn];
300 }
301 else {
302 _slip_cnt_L1[prn] = 1;
303 }
304 obs_slip_cnt_L1 = _slip_cnt_L1[prn];
305 }
306 if (GNSSDF2_LOCKLOSSL2 & gnssData.dataflags2[iSat]) {
307 if (_slip_cnt_L2[prn] < maxSlipCnt) {
308 ++_slip_cnt_L2[prn];
309 }
310 else {
311 _slip_cnt_L2[prn] = 1;
312 }
313 obs_slip_cnt_L2 = _slip_cnt_L2[prn];
314 }
315 if (GNSSDF2_LOCKLOSSL5 & gnssData.dataflags2[iSat]) {
316 if (_slip_cnt_L5[prn] < maxSlipCnt) {
317 ++_slip_cnt_L5[prn];
318 }
319 else {
320 _slip_cnt_L5[prn] = 1;
321 }
322 obs_slip_cnt_L5 = _slip_cnt_L5[prn];
323 }
324
325 // Loop over all data types
326 // ------------------------
327 for (int iEntry = 0; iEntry < GNSSENTRY_NUMBER; ++iEntry) {
328 if (gnssData.codetype[iSat][iEntry] == 0) {
329 continue;
330 }
331 string rnxType(gnssData.codetype[iSat][iEntry]);
332 cout << "rnxType " << rnxType << endl;
333
334 t_frqObs* frqObs = 0;
335 for (unsigned iFrq = 0; iFrq < obs._obs.size(); iFrq++) {
336 if (obs._obs[iFrq]->_rnxType2ch == rnxType) {
337 frqObs = obs._obs[iFrq];
338 break;
339 }
340 }
341 if (frqObs == 0) {
342 frqObs = new t_frqObs;
343 frqObs->_rnxType2ch = rnxType;
344 obs._obs.push_back(frqObs);
345 }
346
347 switch(iEntry & 3) {
348 case GNSSENTRY_CODE:
349 frqObs->_codeValid = true;
350 frqObs->_code = gnssData.measdata[iSat][iEntry];
351 break;
352 case GNSSENTRY_PHASE:
353 frqObs->_phaseValid = true;
354 frqObs->_phase = gnssData.measdata[iSat][iEntry];
355 if (rnxType[0] == '1') {
356 frqObs->_slipCounter = obs_slip_cnt_L1;
357 }
358 else if (rnxType[0] == '2') {
359 frqObs->_slipCounter = obs_slip_cnt_L2;
360 }
361 else if (rnxType[0] == '5') {
362 frqObs->_slipCounter = obs_slip_cnt_L5;
363 }
364 break;
365 case GNSSENTRY_DOPPLER:
366 frqObs->_dopplerValid = true;
367 frqObs->_doppler = gnssData.measdata[iSat][iEntry];
368 break;
369 case GNSSENTRY_SNR:
370 frqObs->_snrValid = true;
371 frqObs->_snr = gnssData.measdata[iSat][iEntry];
372 break;
373 }
374 }
375 _obsList.push_back(obs);
376 }
377 }
378
379 // GPS Ephemeris
380 // -------------
381 else if (rr == 1019) {
382 decoded = true;
383 emit newGPSEph(new gpsephemeris(parser.ephemerisGPS));
384 }
385
386 // GLONASS Ephemeris
387 // -----------------
388 else if (rr == 1020 && parser.ephemerisGLONASS.almanac_number >= 1
389 && parser.ephemerisGLONASS.almanac_number <= PRN_GLONASS_NUM) {
390 decoded = true;
391 emit newGlonassEph(new glonassephemeris(parser.ephemerisGLONASS), _staID);
392 }
393
394 // Galileo Ephemeris
395 // -----------------
396 else if (rr == 1045 || rr == 1046) {
397 decoded = true;
398 emit newGalileoEph(new galileoephemeris(parser.ephemerisGALILEO));
399 }
400 }
401 }
402 }
403 if (!_rawFile && _mode == unknown && decoded) {
404 _mode = observations;
405 }
406 }
407
408 if (decoded) {
409 BNC_CORE->storeGlonassSlotNums(parser.GLOFreq);
410 return success;
411 }
412 else {
413 return failure;
414 }
415}
416
417// Time of Corrections
418//////////////////////////////////////////////////////////////////////////////
419int RTCM3Decoder::corrGPSEpochTime() const {
420 if (_mode == corrections && _coDecoders.size() > 0) {
421 return _coDecoders.begin().value()->corrGPSEpochTime();
422 }
423 else {
424 return -1;
425 }
426}
Note: See TracBrowser for help on using the repository browser.