source: ntrip/branches/BNC_2.12/src/bncgetthread.cpp@ 9127

Last change on this file since 9127 was 9127, checked in by stuerze, 4 years ago

minor changes regarding ssr, long mountpoint names and latency

File size: 30.8 KB
RevLine 
[280]1// Part of BNC, a utility for retrieving decoding and
[464]2// converting GNSS data streams from NTRIP broadcasters.
[280]3//
[464]4// Copyright (C) 2007
[280]5// German Federal Agency for Cartography and Geodesy (BKG)
6// http://www.bkg.bund.de
[464]7// Czech Technical University Prague, Department of Geodesy
[280]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.
[35]24
25/* -------------------------------------------------------------------------
[93]26 * BKG NTRIP Client
[35]27 * -------------------------------------------------------------------------
28 *
29 * Class: bncGetThread
30 *
31 * Purpose: Thread that retrieves data from NTRIP caster
32 *
33 * Author: L. Mervart
34 *
35 * Created: 24-Dec-2005
36 *
[7486]37 * Changes:
[35]38 *
39 * -----------------------------------------------------------------------*/
40
[277]41#include <stdlib.h>
[1044]42#include <iomanip>
[1218]43#include <sstream>
[277]44
[35]45#include <QFile>
46#include <QTextStream>
[5524]47#include <QMutex>
[35]48#include <QtNetwork>
[356]49#include <QTime>
[35]50
51#include "bncgetthread.h"
[192]52#include "bnctabledlg.h"
[5070]53#include "bnccore.h"
[352]54#include "bncutils.h"
[8418]55#include "bnctime.h"
[423]56#include "bnczerodecoder.h"
[1621]57#include "bncnetqueryv0.h"
[1387]58#include "bncnetqueryv1.h"
59#include "bncnetqueryv2.h"
[1410]60#include "bncnetqueryrtp.h"
[1721]61#include "bncnetqueryudp.h"
[1779]62#include "bncnetqueryudp0.h"
[1753]63#include "bncnetquerys.h"
[1535]64#include "bncsettings.h"
[1558]65#include "latencychecker.h"
[3168]66#include "upload/bncrtnetdecoder.h"
[243]67#include "RTCM/RTCM2Decoder.h"
[297]68#include "RTCM3/RTCM3Decoder.h"
[1318]69#include "serial/qextserialport.h"
[35]70
71using namespace std;
72
[1143]73// Constructor 1
[35]74////////////////////////////////////////////////////////////////////////////
[2519]75bncGetThread::bncGetThread(bncRawFile* rawFile) {
[1138]76
[8083]77 _rawFile = rawFile;
78 _format = rawFile->format();
79 _staID = rawFile->staID();
80 _rawOutput = false;
[2390]81 _ntripVersion = "N";
82
[1555]83 initialize();
[1138]84}
85
[1143]86// Constructor 2
87////////////////////////////////////////////////////////////////////////////
[8083]88bncGetThread::bncGetThread(const QUrl& mountPoint, const QByteArray& format,
89 const QByteArray& latitude, const QByteArray& longitude,
90 const QByteArray& nmea, const QByteArray& ntripVersion) {
91 _rawFile = 0;
92 _mountPoint = mountPoint;
93 _staID = mountPoint.path().mid(1).toAscii();
94 _format = format;
95 _latitude = latitude;
96 _longitude = longitude;
97 _nmea = nmea;
[1353]98 _ntripVersion = ntripVersion;
[1139]99
[2386]100 bncSettings settings;
101 if (!settings.value("rawOutFile").toString().isEmpty()) {
102 _rawOutput = true;
[8273]103 }
104 else {
[3734]105 _rawOutput = false;
[2386]106 }
[8273]107 if (!settings.value("miscMount").toString().isEmpty()) {
108 _latencycheck = true;
109 }
110 else {
111 _latencycheck = false;
112 }
[1139]113 initialize();
[3523]114 initDecoder();
[1139]115}
116
[1555]117// Initialization (common part of the constructor)
[1143]118////////////////////////////////////////////////////////////////////////////
[1139]119void bncGetThread::initialize() {
120
[3528]121 bncSettings settings;
122
[1555]123 setTerminationEnabled(true);
124
[7486]125 connect(this, SIGNAL(newMessage(QByteArray,bool)),
[8083]126 BNC_CORE, SLOT(slotMessage(const QByteArray,bool)));
[1555]127
[1525]128 _isToBeDeleted = false;
[8083]129 _query = 0;
130 _nextSleep = 0;
131 _miscMount = settings.value("miscMount").toString();
132 _decoder = 0;
[255]133
[7180]134 // NMEA Port
135 // -----------
136 QListIterator<QString> iSta(settings.value("PPP/staTable").toStringList());
137 int nmeaPort = 0;
138 while (iSta.hasNext()) {
139 QStringList hlp = iSta.next().split(",");
[8083]140 if (hlp.size() < 10) {
141 continue;
142 }
[7180]143 QByteArray mp = hlp[0].toAscii();
144 if (_staID == mp) {
145 nmeaPort = hlp[9].toInt();
146 }
147 }
148 if (nmeaPort != 0) {
149 _nmeaServer = new QTcpServer;
[8083]150 if (!_nmeaServer->listen(QHostAddress::Any, nmeaPort)) {
[7180]151 emit newMessage("bncCaster: Cannot listen on port", true);
[8083]152 } else {
153 connect(_nmeaServer, SIGNAL(newConnection()), this,
154 SLOT(slotNewNMEAConnection()));
155 connect(BNC_CORE, SIGNAL(newNMEAstr(QByteArray, QByteArray)), this,
156 SLOT(slotNewNMEAstr(QByteArray, QByteArray)));
[7180]157 _nmeaSockets = new QList<QTcpSocket*>;
158 _nmeaPortsMap[_staID] = nmeaPort;
159 }
160 } else {
161 _nmeaServer = 0;
162 _nmeaSockets = 0;
163 }
164
[1555]165 // Serial Port
166 // -----------
[8083]167 _serialNMEA = NO_NMEA;
[1710]168 _serialOutFile = 0;
[8083]169 _serialPort = 0;
[1710]170
[8083]171 if (!_staID.isEmpty()
172 && settings.value("serialMountPoint").toString() == _staID) {
173 _serialPort = new QextSerialPort(
174 settings.value("serialPortName").toString());
175 _serialPort->setTimeout(0, 100);
[1710]176
177 // Baud Rate
178 // ---------
[1330]179 QString hlp = settings.value("serialBaudRate").toString();
[8083]180 if (hlp == "110") {
[7486]181 _serialPort->setBaudRate(BAUD110);
[8083]182 } else if (hlp == "300") {
[7486]183 _serialPort->setBaudRate(BAUD300);
[8083]184 } else if (hlp == "600") {
[7486]185 _serialPort->setBaudRate(BAUD600);
[8083]186 } else if (hlp == "1200") {
[7486]187 _serialPort->setBaudRate(BAUD1200);
[8083]188 } else if (hlp == "2400") {
[7486]189 _serialPort->setBaudRate(BAUD2400);
[8083]190 } else if (hlp == "4800") {
[7486]191 _serialPort->setBaudRate(BAUD4800);
[8083]192 } else if (hlp == "9600") {
[7486]193 _serialPort->setBaudRate(BAUD9600);
[8083]194 } else if (hlp == "19200") {
[7486]195 _serialPort->setBaudRate(BAUD19200);
[8083]196 } else if (hlp == "38400") {
[7486]197 _serialPort->setBaudRate(BAUD38400);
[8083]198 } else if (hlp == "57600") {
[7486]199 _serialPort->setBaudRate(BAUD57600);
[8083]200 } else if (hlp == "115200") {
[7486]201 _serialPort->setBaudRate(BAUD115200);
[1330]202 }
[1710]203
204 // Parity
205 // ------
[1330]206 hlp = settings.value("serialParity").toString();
[8083]207 if (hlp == "NONE") {
[7486]208 _serialPort->setParity(PAR_NONE);
[8083]209 } else if (hlp == "ODD") {
[7486]210 _serialPort->setParity(PAR_ODD);
[8083]211 } else if (hlp == "EVEN") {
[7486]212 _serialPort->setParity(PAR_EVEN);
[8083]213 } else if (hlp == "SPACE") {
[7486]214 _serialPort->setParity(PAR_SPACE);
[1330]215 }
[1710]216
217 // Data Bits
218 // ---------
[1330]219 hlp = settings.value("serialDataBits").toString();
[8083]220 if (hlp == "5") {
[7486]221 _serialPort->setDataBits(DATA_5);
[8083]222 } else if (hlp == "6") {
[7486]223 _serialPort->setDataBits(DATA_6);
[8083]224 } else if (hlp == "7") {
[7486]225 _serialPort->setDataBits(DATA_7);
[8083]226 } else if (hlp == "8") {
[7486]227 _serialPort->setDataBits(DATA_8);
[1330]228 }
229 hlp = settings.value("serialStopBits").toString();
[8083]230 if (hlp == "1") {
[7486]231 _serialPort->setStopBits(STOP_1);
[8083]232 } else if (hlp == "2") {
[7486]233 _serialPort->setStopBits(STOP_2);
[1330]234 }
[1710]235
236 // Flow Control
237 // ------------
238 hlp = settings.value("serialFlowControl").toString();
[1711]239 if (hlp == "XONXOFF") {
[7486]240 _serialPort->setFlowControl(FLOW_XONXOFF);
[8083]241 } else if (hlp == "HARDWARE") {
[7486]242 _serialPort->setFlowControl(FLOW_HARDWARE);
[8083]243 } else {
[7486]244 _serialPort->setFlowControl(FLOW_OFF);
[1711]245 }
[1710]246
247 // Open Serial Port
248 // ----------------
[8083]249 _serialPort->open(QIODevice::ReadWrite | QIODevice::Unbuffered);
[1331]250 if (!_serialPort->isOpen()) {
251 delete _serialPort;
252 _serialPort = 0;
[1451]253 emit(newMessage((_staID + ": Cannot open serial port\n"), true));
[1331]254 }
[8083]255 connect(_serialPort, SIGNAL(readyRead()), this,
256 SLOT(slotSerialReadyRead()));
[1606]257
[1710]258 // Automatic NMEA
259 // --------------
[6785]260 QString nmeaMode = settings.value("serialAutoNMEA").toString();
261 if (nmeaMode == "Auto") {
[1710]262 _serialNMEA = AUTO_NMEA;
263 QString fName = settings.value("serialFileNMEA").toString();
264 if (!fName.isEmpty()) {
265 _serialOutFile = new QFile(fName);
[8083]266 if (Qt::CheckState(settings.value("rnxAppend").toInt())
267 == Qt::Checked) {
[1710]268 _serialOutFile->open(QIODevice::WriteOnly | QIODevice::Append);
[8083]269 } else {
[1710]270 _serialOutFile->open(QIODevice::WriteOnly);
271 }
[1634]272 }
[1606]273 }
[1710]274 // Manual NMEA
275 // -----------
[8083]276 if ((nmeaMode == "Manual GPGGA") || (nmeaMode == "Manual GNGGA")) {
[1710]277 _serialNMEA = MANUAL_NMEA;
[6751]278 bncSettings settings;
279 _manualNMEASampl = settings.value("serialManualNMEASampling").toInt();
[8083]280 QString hlp = settings.value("serialHeightNMEA").toString();
[6751]281 if (hlp.isEmpty()) {
282 hlp = "0.0";
283 }
284 QByteArray _serialHeightNMEA = hlp.toAscii();
[8083]285 _manualNMEAString = ggaString(_latitude, _longitude, _serialHeightNMEA,
286 nmeaMode);
[1636]287 }
[1318]288 }
289
[8273]290 if (!_staID.isEmpty() && _latencycheck) {
[3532]291 _latencyChecker = new latencyChecker(_staID);
[9127]292 _rtcmObs = false;
293 _rtcmSsrOrb = false;
294 _rtcmSsrClk = false;
295 _rtcmSsrOrbClk = false;
296 _rtcmSsrCbi = false;
297 _rtcmSsrPbi = false;
298 _rtcmSsrVtec = false;
299 _rtcmSsrUra = false;
300 _rtcmSsrHr = false;
301 _rtcmSsrIgs = false;
302 _ssrEpoch = 0;
[8083]303 } else {
[3532]304 _latencyChecker = 0;
305 }
[3523]306}
307
308// Instantiate the decoder
309//////////////////////////////////////////////////////////////////////////////
310t_irc bncGetThread::initDecoder() {
311
[3560]312 _decoder = 0;
313
[8083]314 if (_format.indexOf("RTCM_2") != -1 || _format.indexOf("RTCM2") != -1
315 || _format.indexOf("RTCM 2") != -1) {
[1555]316 emit(newMessage(_staID + ": Get data in RTCM 2.x format", true));
[3560]317 _decoder = new RTCM2Decoder(_staID.data());
[8083]318 } else if (_format.indexOf("RTCM_3") != -1 || _format.indexOf("RTCM3") != -1
319 || _format.indexOf("RTCM 3") != -1) {
[1555]320 emit(newMessage(_staID + ": Get data in RTCM 3.x format", true));
[3558]321 RTCM3Decoder* newDecoder = new RTCM3Decoder(_staID, _rawFile);
[3560]322 _decoder = newDecoder;
[7486]323 connect((RTCM3Decoder*) newDecoder, SIGNAL(newMessage(QByteArray,bool)),
[8083]324 this, SIGNAL(newMessage(QByteArray,bool)));
325 } else if (_format.indexOf("ZERO") != -1) {
[1555]326 emit(newMessage(_staID + ": Get data in original format", true));
[3560]327 _decoder = new bncZeroDecoder(_staID);
[8083]328 } else if (_format.indexOf("RTNET") != -1) {
[3168]329 emit(newMessage(_staID + ": Get data in RTNet format", true));
[3560]330 _decoder = new bncRtnetDecoder();
[8083]331 } else {
[1555]332 emit(newMessage(_staID + ": Unknown data format " + _format, true));
333 _isToBeDeleted = true;
[3523]334 return failure;
[1555]335 }
336
[319]337 msleep(100); //sleep 0.1 sec
[7486]338
[8083]339 _decoder->initRinex(_staID, _mountPoint, _latitude, _longitude, _nmea,
340 _ntripVersion);
[3560]341
342 if (_rawFile) {
343 _decodersRaw[_staID] = _decoder;
[3530]344 }
345
[3523]346 return success;
[35]347}
348
[3523]349// Current decoder in use
350////////////////////////////////////////////////////////////////////////////
351GPSDecoder* bncGetThread::decoder() {
[3560]352 if (!_rawFile) {
353 return _decoder;
[8083]354 } else {
[3560]355 if (_decodersRaw.contains(_staID) || initDecoder() == success) {
356 return _decodersRaw[_staID];
357 }
[3523]358 }
[3560]359 return 0;
[3523]360}
361
[35]362// Destructor
363////////////////////////////////////////////////////////////////////////////
364bncGetThread::~bncGetThread() {
[1928]365 if (isRunning()) {
366 wait();
367 }
[1527]368 if (_query) {
369 _query->stop();
[1708]370 _query->deleteLater();
[1527]371 }
[3560]372 if (_rawFile) {
373 QMapIterator<QString, GPSDecoder*> it(_decodersRaw);
374 while (it.hasNext()) {
375 it.next();
376 delete it.value();
377 }
[8083]378 } else {
[3560]379 delete _decoder;
380 }
[2519]381 delete _rawFile;
[1607]382 delete _serialOutFile;
[1328]383 delete _serialPort;
[1557]384 delete _latencyChecker;
[1556]385 emit getThreadFinished(_staID);
[35]386}
387
[7486]388//
[1390]389////////////////////////////////////////////////////////////////////////////
390void bncGetThread::terminate() {
[1525]391 _isToBeDeleted = true;
[7854]392
[8083]393 if (_nmeaPortsMap.contains(_staID)) {
[7854]394 _nmeaPortsMap.remove(_staID);
[1559]395 }
[7854]396 if (_nmeaServer) {
397 delete _nmeaServer;
398 }
399 if (_nmeaSockets) {
400 delete _nmeaSockets;
401 }
[7858]402
403#ifdef BNC_DEBUG
[7859]404 if (BNC_CORE->mode() != t_bncCore::interactive) {
[8083]405 while (!isFinished()) {
406 wait();
407 }
[7859]408 delete this;
[8083]409 } else {
410 if (!isRunning()) {
411 delete this;
412 }
[7858]413 }
414#else
[8083]415 if (!isRunning()) {delete this;}
[7858]416#endif
417
[1390]418}
419
[136]420// Run
421////////////////////////////////////////////////////////////////////////////
422void bncGetThread::run() {
423
[35]424 while (true) {
[629]425 try {
[1555]426 if (_isToBeDeleted) {
427 QThread::exit(0);
428 this->deleteLater();
429 return;
[629]430 }
[621]431
[1555]432 if (tryReconnect() != success) {
[3532]433 if (_latencyChecker) {
434 _latencyChecker->checkReconnect();
435 }
[1555]436 continue;
[621]437 }
[1555]438
439 // Delete old observations
440 // -----------------------
[3560]441 if (_rawFile) {
442 QMapIterator<QString, GPSDecoder*> itDec(_decodersRaw);
443 while (itDec.hasNext()) {
444 itDec.next();
445 GPSDecoder* decoder = itDec.value();
446 decoder->_obsList.clear();
447 }
[8083]448 } else {
[3560]449 _decoder->_obsList.clear();
450 }
[621]451
[1555]452 // Read Data
453 // ---------
[1377]454 QByteArray data;
[8083]455 if (_query) {
[1377]456 _query->waitForReadyRead(data);
[8083]457 } else if (_rawFile) {
[2527]458 data = _rawFile->readChunk();
[3523]459 _format = _rawFile->format();
[8083]460 _staID = _rawFile->staID();
[2388]461
[5903]462 QCoreApplication::processEvents();
463
[7977]464 if (data.isEmpty() || BNC_CORE->sigintReceived) {
465 cout << "no more data or Ctrl-C received" << endl;
[5068]466 BNC_CORE->stopCombination();
[5900]467 BNC_CORE->stopPPP();
[9127]468 sleep(1);
[5903]469 ::exit(0);
[1555]470 }
[1138]471 }
[1555]472 qint64 nBytes = data.size();
[1138]473
[1555]474 // Timeout, reconnect
475 // ------------------
476 if (nBytes == 0) {
[3532]477 if (_latencyChecker) {
478 _latencyChecker->checkReconnect();
479 }
[1555]480 emit(newMessage(_staID + ": Data timeout, reconnecting", true));
[2355]481 msleep(10000); //sleep 10 sec, G. Weber
[1555]482 continue;
[8083]483 } else {
[567]484 emit newBytes(_staID, nBytes);
[5648]485 emit newRawData(_staID, data);
[1555]486 }
[567]487
[1555]488 // Output Data
489 // -----------
[2386]490 if (_rawOutput) {
[7486]491 BNC_CORE->writeRawData(data, _staID, _format);
[2386]492 }
[2385]493
[1555]494 if (_serialPort) {
[1633]495 slotSerialReadyRead();
[1555]496 _serialPort->write(data);
497 }
[7486]498
[1555]499 // Decode Data
500 // -----------
501 vector<string> errmsg;
[3526]502 if (!decoder()) {
503 _isToBeDeleted = true;
504 continue;
505 }
[7753]506
[3523]507 t_irc irc = decoder()->Decode(data.data(), data.size(), errmsg);
[1137]508
[7753]509 if (irc != success) {
510 continue;
511 }
[1555]512 // Perform various scans and checks
513 // --------------------------------
[3532]514 if (_latencyChecker) {
[8273]515 _latencyChecker->checkOutage(irc);
[8083]516 QListIterator<int> it(decoder()->_typeList);
[8273]517 _ssrEpoch = static_cast<int>(decoder()->corrGPSEpochTime());
[8727]518 if (_ssrEpoch != -1) {
[9127]519 if (_rtcmSsrOrb) {
[8727]520 _latencyChecker->checkCorrLatency(_ssrEpoch, 1057);
[9127]521 _rtcmSsrOrb = false;
[8083]522 }
[9127]523 if (_rtcmSsrClk) {
[8727]524 _latencyChecker->checkCorrLatency(_ssrEpoch, 1058);
[9127]525 _rtcmSsrClk = false;
[8083]526 }
[9127]527 if (_rtcmSsrOrbClk) {
[8727]528 _latencyChecker->checkCorrLatency(_ssrEpoch, 1060);
[9127]529 _rtcmSsrOrbClk = false;
[8083]530 }
[9127]531 if (_rtcmSsrCbi) {
[8727]532 _latencyChecker->checkCorrLatency(_ssrEpoch, 1059);
[9127]533 _rtcmSsrCbi = false;
[8083]534 }
[9127]535 if (_rtcmSsrPbi) {
[8727]536 _latencyChecker->checkCorrLatency(_ssrEpoch, 1265);
[9127]537 _rtcmSsrPbi = false;
[8083]538 }
[9127]539 if (_rtcmSsrVtec) {
[8727]540 _latencyChecker->checkCorrLatency(_ssrEpoch, 1264);
[9127]541 _rtcmSsrVtec = false;
[8083]542 }
[9127]543 if (_rtcmSsrUra) {
[8727]544 _latencyChecker->checkCorrLatency(_ssrEpoch, 1061);
[9127]545 _rtcmSsrUra = false;
[8083]546 }
[9127]547 if (_rtcmSsrHr) {
[8727]548 _latencyChecker->checkCorrLatency(_ssrEpoch, 1062);
[9127]549 _rtcmSsrHr = false;
[8083]550 }
[9127]551 if (_rtcmSsrIgs) {
552 _latencyChecker->checkCorrLatency(_ssrEpoch, 4076);
553 _rtcmSsrIgs = false;
554 }
[8083]555 }
556 while (it.hasNext()) {
557 int rtcmType = it.next();
558 if ((rtcmType >= 1001 && rtcmType <= 1004) || // legacy RTCM OBS
559 (rtcmType >= 1009 && rtcmType <= 1012) || // legacy RTCM OBS
[9010]560 (rtcmType >= 1071 && rtcmType <= 1137)) { // MSM RTCM OBS
[9127]561 _rtcmObs = true;
[8083]562 } else if ((rtcmType >= 1057 && rtcmType <= 1068) ||
[9127]563 (rtcmType >= 1240 && rtcmType <= 1270) ||
564 (rtcmType == 4076)) {
[8083]565 switch (rtcmType) {
566 case 1057: case 1063: case 1240: case 1246: case 1252: case 1258:
[9127]567 _rtcmSsrOrb = true;
[8083]568 break;
569 case 1058: case 1064: case 1241: case 1247: case 1253: case 1259:
[9127]570 _rtcmSsrClk = true;
[8083]571 break;
572 case 1060: case 1066: case 1243: case 1249: case 1255: case 1261:
[9127]573 _rtcmSsrOrbClk = true;
[8083]574 break;
[9127]575 case 1059: case 1065: case 1242: case 1248: case 1254: case 1260:
576 _rtcmSsrCbi = true;
[8083]577 break;
578 case 1265: case 1266: case 1267: case 1268: case 1269: case 1270:
[9127]579 _rtcmSsrPbi = true;
[8083]580 break;
581 case 1264:
[9127]582 _rtcmSsrVtec = true;
[8083]583 break;
584 case 1061: case 1067: case 1244: case 1250: case 1256: case 1262:
[9127]585 _rtcmSsrUra = true;
[8083]586 break;
587 case 1062: case 1068: case 1245: case 1251: case 1257: case 1263:
[9127]588 _rtcmSsrHr = true;
[8083]589 break;
[9127]590 case 4076:
591 _rtcmSsrIgs = true;
592 break;
[8083]593 }
594 }
595 }
[9127]596 if (_rtcmObs) {
[8083]597 _latencyChecker->checkObsLatency(decoder()->_obsList);
598 }
[3532]599 emit newLatency(_staID, _latencyChecker->currentLatency());
600 }
[7753]601 miscScanRTCM();
[1138]602
[1555]603 // Loop over all observations (observations output)
604 // ------------------------------------------------
[6137]605 QListIterator<t_satObs> it(decoder()->_obsList);
[5524]606
[6137]607 QList<t_satObs> obsListHlp;
[5524]608
[1555]609 while (it.hasNext()) {
[6137]610 const t_satObs& obs = it.next();
[2711]611
[1555]612 // Check observation epoch
613 // -----------------------
[5739]614 if (!_rawFile) {
[8012]615 bool wrongObservationEpoch = checkForWrongObsEpoch(obs._time);
616 if (wrongObservationEpoch) {
[8022]617 QString prn(obs._prn.toString().c_str());
[8083]618 emit(newMessage(
619 _staID + " (" + prn.toAscii() + ")"
620 + ": Wrong observation epoch(s)", false));
[1555]621 continue;
[940]622 }
[686]623 }
[6812]624
[3305]625 // Check observations coming twice (e.g. KOUR0 Problem)
626 // ----------------------------------------------------
[3535]627 if (!_rawFile) {
[8012]628 QString prn(obs._prn.toString().c_str());
[8418]629 bncTime obsTime = obs._time;
630 QMap<QString, bncTime>::const_iterator it = _prnLastEpo.find(prn);
[3535]631 if (it != _prnLastEpo.end()) {
[8418]632 bncTime oldTime = it.value();
[8083]633 if (obsTime < oldTime) {
[8418]634 emit(newMessage(_staID + ": old observation " + prn.toLatin1(), false));
[3535]635 continue;
[8083]636 } else if (obsTime == oldTime) {
[8418]637 emit(newMessage(_staID + ": observation coming more than once "
638 + prn.toLatin1(), false));
[3535]639 continue;
640 }
[3302]641 }
[3535]642 _prnLastEpo[prn] = obsTime;
[3301]643 }
644
[3528]645 decoder()->dumpRinexEpoch(obs, _format);
646
[5524]647 // Save observations
648 // -----------------
649 obsListHlp.append(obs);
650 }
[2030]651
[5524]652 // Emit signal
653 // -----------
654 if (!_isToBeDeleted && obsListHlp.size() > 0) {
655 emit newObs(_staID, obsListHlp);
[249]656 }
[5524]657
[8083]658 } catch (Exception& exc) {
[3311]659 emit(newMessage(_staID + " " + exc.what(), true));
660 _isToBeDeleted = true;
[8083]661 } catch (...) {
[3311]662 emit(newMessage(_staID + " bncGetThread exception", true));
[1559]663 _isToBeDeleted = true;
[1555]664 }
[35]665 }
666}
667
[7486]668// Try Re-Connect
[136]669////////////////////////////////////////////////////////////////////////////
[1555]670t_irc bncGetThread::tryReconnect() {
671
672 // Easy Return
673 // -----------
674 if (_query && _query->status() == bncNetQuery::running) {
675 _nextSleep = 0;
[3560]676 if (_rawFile) {
677 QMapIterator<QString, GPSDecoder*> itDec(_decodersRaw);
678 while (itDec.hasNext()) {
679 itDec.next();
680 GPSDecoder* decoder = itDec.value();
681 decoder->setRinexReconnectFlag(false);
682 }
[8083]683 } else {
[3560]684 _decoder->setRinexReconnectFlag(false);
685 }
[1555]686 return success;
[408]687 }
[1555]688
689 // Start a new query
690 // -----------------
[2519]691 if (!_rawFile) {
[1555]692
[138]693 sleep(_nextSleep);
[1555]694 if (_nextSleep == 0) {
695 _nextSleep = 1;
[8083]696 } else {
[1555]697 _nextSleep = 2 * _nextSleep;
[442]698 if (_nextSleep > 256) {
699 _nextSleep = 256;
[152]700 }
[1816]701#ifdef MLS_SOFTWARE
[1817]702 if (_nextSleep > 4) {
703 _nextSleep = 4;
[1816]704 }
705#endif
[138]706 }
[8124]707 delete _query;
[8083]708 if (_ntripVersion == "U") {
[1721]709 _query = new bncNetQueryUdp();
[8083]710 } else if (_ntripVersion == "R") {
[1555]711 _query = new bncNetQueryRtp();
[8083]712 } else if (_ntripVersion == "S") {
[1753]713 _query = new bncNetQueryS();
[8083]714 } else if (_ntripVersion == "N") {
[1621]715 _query = new bncNetQueryV0();
[8083]716 } else if (_ntripVersion == "UN") {
[1779]717 _query = new bncNetQueryUdp0();
[8083]718 } else if (_ntripVersion == "2") {
[3337]719 _query = new bncNetQueryV2(false);
[8083]720 } else if (_ntripVersion == "2s") {
[3337]721 _query = new bncNetQueryV2(true);
[8083]722 } else {
[1555]723 _query = new bncNetQueryV1();
724 }
[6770]725 if (_nmea == "yes") {
726 if (_serialNMEA == MANUAL_NMEA) {
727 _query->startRequest(_mountPoint, _manualNMEAString);
728 _lastManualNMEA = QDateTime::currentDateTime();
[8083]729 } else if (_serialNMEA == AUTO_NMEA) {
[6770]730 if (_serialPort) {
731 int nb = _serialPort->bytesAvailable();
732 if (nb > 0) {
733 QByteArray data = _serialPort->read(nb);
734 int i1 = data.indexOf("$GPGGA");
735 if (i1 == -1) {
736 i1 = data.indexOf("$GNGGA");
737 }
738 if (i1 != -1) {
739 int i2 = data.indexOf("*", i1);
740 if (i2 != -1 && data.size() > i2 + 1) {
741 QByteArray gga = data.mid(i1, i2 - i1 + 3);
742 _query->startRequest(_mountPoint, gga);
743 }
744 }
745 }
746 }
747 }
[8083]748 } else {
[1555]749 _query->startRequest(_mountPoint, "");
750 }
[6770]751
[1555]752 if (_query->status() != bncNetQuery::running) {
753 return failure;
754 }
[138]755 }
[658]756
[3560]757 if (_rawFile) {
758 QMapIterator<QString, GPSDecoder*> itDec(_decodersRaw);
759 while (itDec.hasNext()) {
760 itDec.next();
761 GPSDecoder* decoder = itDec.value();
762 decoder->setRinexReconnectFlag(false);
763 }
[8083]764 } else {
765 _decoder->setRinexReconnectFlag(false);
[658]766 }
[1555]767
768 return success;
[658]769}
[1044]770
[1555]771// RTCM scan output
[1044]772//////////////////////////////////////////////////////////////////////////////
[7423]773void bncGetThread::miscScanRTCM() {
[1044]774
[8083]775 if (!decoder()) {
[3558]776 return;
777 }
778
[1555]779 bncSettings settings;
[8083]780 if (Qt::CheckState(settings.value("miscScanRTCM").toInt()) == Qt::Checked) {
[1574]781
[8083]782 if (_miscMount == _staID || _miscMount == "ALL") {
[1575]783 // RTCM message types
784 // ------------------
[4476]785 for (int ii = 0; ii < decoder()->_typeList.size(); ii++) {
[8083]786 QString type = QString("%1 ").arg(decoder()->_typeList[ii]);
787 emit(newMessage(_staID + ": Received message type " + type.toAscii(),
788 true));
[1574]789 }
[7486]790
[4476]791 // Check Observation Types
792 // -----------------------
793 for (int ii = 0; ii < decoder()->_obsList.size(); ii++) {
[6137]794 t_satObs& obs = decoder()->_obsList[ii];
795 QVector<QString>& rnxTypes = _rnxTypes[obs._prn.system()];
[4476]796 bool allFound = true;
[6137]797 for (unsigned iFrq = 0; iFrq < obs._obs.size(); iFrq++) {
[6579]798 if (obs._obs[iFrq]->_codeValid) {
799 QString rnxStr('C');
800 rnxStr.append(obs._obs[iFrq]->_rnxType2ch.c_str());
[8083]801 if (_format.indexOf("RTCM_2") != -1
802 || _format.indexOf("RTCM2") != -1
803 || _format.indexOf("RTCM 2") != -1) {
[6580]804 rnxStr = t_rnxObsFile::type3to2(obs._prn.system(), rnxStr);
805 }
[6579]806 if (rnxTypes.indexOf(rnxStr) == -1) {
807 rnxTypes.push_back(rnxStr);
808 allFound = false;
809 }
[4476]810 }
[6579]811 if (obs._obs[iFrq]->_phaseValid) {
812 QString rnxStr('L');
813 rnxStr.append(obs._obs[iFrq]->_rnxType2ch.c_str());
[8083]814 if (_format.indexOf("RTCM_2") != -1
815 || _format.indexOf("RTCM2") != -1
816 || _format.indexOf("RTCM 2") != -1) {
[6580]817 rnxStr = t_rnxObsFile::type3to2(obs._prn.system(), rnxStr);
818 }
[6579]819 if (rnxTypes.indexOf(rnxStr) == -1) {
820 rnxTypes.push_back(rnxStr);
821 allFound = false;
822 }
823 }
[8083]824 if (obs._obs[iFrq]->_dopplerValid) {
[6579]825 QString rnxStr('D');
826 rnxStr.append(obs._obs[iFrq]->_rnxType2ch.c_str());
[8083]827 if (_format.indexOf("RTCM_2") != -1
828 || _format.indexOf("RTCM2") != -1
829 || _format.indexOf("RTCM 2") != -1) {
[6580]830 rnxStr = t_rnxObsFile::type3to2(obs._prn.system(), rnxStr);
831 }
[6579]832 if (rnxTypes.indexOf(rnxStr) == -1) {
833 rnxTypes.push_back(rnxStr);
834 allFound = false;
835 }
836 }
[8083]837 if (obs._obs[iFrq]->_snrValid) {
[6579]838 QString rnxStr('S');
839 rnxStr.append(obs._obs[iFrq]->_rnxType2ch.c_str());
[8083]840 if (_format.indexOf("RTCM_2") != -1
841 || _format.indexOf("RTCM2") != -1
842 || _format.indexOf("RTCM 2") != -1) {
[6580]843 rnxStr = t_rnxObsFile::type3to2(obs._prn.system(), rnxStr);
844 }
[6579]845 if (rnxTypes.indexOf(rnxStr) == -1) {
846 rnxTypes.push_back(rnxStr);
847 allFound = false;
848 }
849 }
[4476]850 }
851 if (!allFound) {
[7486]852 QString msg;
[4477]853 QTextStream str(&msg);
[6579]854 QString s;
[8083]855 str << obs._prn.system() << " "
856 << s.sprintf("%2d", rnxTypes.size()) << " ";
[4476]857 for (int iType = 0; iType < rnxTypes.size(); iType++) {
[4478]858 str << " " << rnxTypes[iType];
[4476]859 }
[8083]860 emit(newMessage(_staID + ": Observation Types: " + msg.toAscii(),
861 true));
[4476]862 }
863 }
864
[1574]865 // RTCMv3 antenna descriptor
866 // -------------------------
[4476]867 for (int ii = 0; ii < decoder()->_antType.size(); ii++) {
[8083]868 QString ant1 = QString("%1 ").arg(decoder()->_antType[ii]);
[1574]869 emit(newMessage(_staID + ": Antenna descriptor " + ant1.toAscii(), true));
870 }
[1555]871
[1575]872 // RTCM Antenna Coordinates
873 // ------------------------
[8083]874 for (int ii = 0; ii < decoder()->_antList.size(); ii++) {
[1574]875 QByteArray antT;
[8083]876 if (decoder()->_antList[ii].type == GPSDecoder::t_antInfo::ARP) {
[1574]877 antT = "ARP";
[8083]878 } else if (decoder()->_antList[ii].type == GPSDecoder::t_antInfo::APC) {
[1574]879 antT = "APC";
880 }
[1575]881 QByteArray ant1, ant2, ant3;
[8083]882 ant1 =
883 QString("%1 ").arg(decoder()->_antList[ii].xx, 0, 'f', 4).toAscii();
884 ant2 =
885 QString("%1 ").arg(decoder()->_antList[ii].yy, 0, 'f', 4).toAscii();
886 ant3 =
887 QString("%1 ").arg(decoder()->_antList[ii].zz, 0, 'f', 4).toAscii();
[1575]888 emit(newMessage(_staID + ": " + antT + " (ITRF) X " + ant1 + "m", true));
889 emit(newMessage(_staID + ": " + antT + " (ITRF) Y " + ant2 + "m", true));
890 emit(newMessage(_staID + ": " + antT + " (ITRF) Z " + ant3 + "m", true));
[3595]891 double hh = 0.0;
[3523]892 if (decoder()->_antList[ii].height_f) {
[3595]893 hh = decoder()->_antList[ii].height;
[8083]894 QByteArray ant4 = QString("%1 ").arg(hh, 0, 'f', 4).toAscii();
895 emit(newMessage(
896 _staID + ": Antenna height above marker " + ant4 + "m", true));
[1575]897 }
[7486]898 emit(newAntCrd(_staID, decoder()->_antList[ii].xx,
[8083]899 decoder()->_antList[ii].yy, decoder()->_antList[ii].zz, hh, antT));
[1218]900 }
[6864]901
[8200]902 // RTCMv3 receiver descriptor
903 // --------------------------
904 for (int ii = 0; ii < decoder()->_recType.size(); ii++) {
905 QString rec1 = QString("%1 ").arg(decoder()->_recType[ii]);
906 emit(newMessage(_staID + ": Receiver descriptor " + rec1.toLatin1(), true));
907 }
908
[6864]909 // RTCM GLONASS slots
910 // ------------------
911 if (decoder()->_gloFrq.size()) {
912 bool allFound = true;
913 QString slot = decoder()->_gloFrq;
[8083]914 slot.replace(" ", " ").replace(" ", ":");
[6864]915 if (_gloSlots.indexOf(slot) == -1) {
916 _gloSlots.append(slot);
917 allFound = false;
918 }
919 if (!allFound) {
920 _gloSlots.sort();
[8083]921 emit(newMessage(
922 _staID + ": GLONASS Slot:Freq " + _gloSlots.join(" ").toAscii(),
923 true));
[6864]924 }
925 }
[1218]926 }
[1044]927 }
[1575]928
[1770]929#ifdef MLS_SOFTWARE
[3523]930 for (int ii=0; ii <decoder()->_antList.size(); ii++) {
[8083]931 QByteArray antT;
932 if (decoder()->_antList[ii].type == GPSDecoder::t_antInfo::ARP) {
933 antT = "ARP";
934 }
935 else if (decoder()->_antList[ii].type == GPSDecoder::t_antInfo::APC) {
936 antT = "APC";
937 }
938 double hh = 0.0;
939 if (decoder()->_antList[ii].height_f) {
940 hh = decoder()->_antList[ii].height;
941 }
942 emit(newAntCrd(_staID, decoder()->_antList[ii].xx,
943 decoder()->_antList[ii].yy, decoder()->_antList[ii].zz,
944 hh, antT));
[1770]945 }
[2356]946
[3523]947 for (int ii = 0; ii <decoder()->_typeList.size(); ii++) {
948 emit(newRTCMMessage(_staID, decoder()->_typeList[ii]));
[2356]949 }
[1770]950#endif
951
[6864]952 decoder()->_gloFrq.clear();
[3523]953 decoder()->_typeList.clear();
954 decoder()->_antType.clear();
[8200]955 decoder()->_recType.clear();
[3523]956 decoder()->_antList.clear();
[1044]957}
[1555]958
[1606]959// Handle Data from Serial Port
960////////////////////////////////////////////////////////////////////////////
961void bncGetThread::slotSerialReadyRead() {
[6770]962
[1607]963 if (_serialPort) {
[6770]964
[6773]965 if (_nmea == "yes" && _serialNMEA == MANUAL_NMEA) {
966 if (_manualNMEASampl) {
967 int dt = _lastManualNMEA.secsTo(QDateTime::currentDateTime());
968 if (dt && (fmod(double(dt), double(_manualNMEASampl)) == 0.0)) {
969 _query->sendNMEA(_manualNMEAString);
970 _lastManualNMEA = QDateTime::currentDateTime();
971 }
972 }
973 }
974
[1633]975 int nb = _serialPort->bytesAvailable();
976 if (nb > 0) {
977 QByteArray data = _serialPort->read(nb);
[1711]978
[6695]979 if (_nmea == "yes" && _serialNMEA == AUTO_NMEA) {
[1725]980 int i1 = data.indexOf("$GPGGA");
[6651]981 if (i1 == -1) {
982 i1 = data.indexOf("$GNGGA");
983 }
[1725]984 if (i1 != -1) {
[6751]985 int i2 = data.indexOf("*", i1);
[1725]986 if (i2 != -1 && data.size() > i2 + 1) {
[6751]987 QByteArray gga = data.mid(i1, i2 - i1 + 3);
[1725]988 _query->sendNMEA(gga);
[6751]989 }
990 }
[1711]991 }
992
[1633]993 if (_serialOutFile) {
994 _serialOutFile->write(data);
995 _serialOutFile->flush();
996 }
[1607]997 }
998 }
[1606]999}
[7180]1000
1001void bncGetThread::slotNewNMEAConnection() {
1002 _nmeaSockets->push_back(_nmeaServer->nextPendingConnection());
[8083]1003 emit(newMessage(
1004 QString("New PPP client on port: # %1").arg(_nmeaSockets->size()).toAscii(),
1005 true));
[7180]1006}
1007
1008//
1009////////////////////////////////////////////////////////////////////////////
1010void bncGetThread::slotNewNMEAstr(QByteArray staID, QByteArray str) {
1011 if (_nmeaPortsMap.contains(staID)) {
1012 int nmeaPort = _nmeaPortsMap.value(staID);
1013 QMutableListIterator<QTcpSocket*> is(*_nmeaSockets);
1014 while (is.hasNext()) {
1015 QTcpSocket* sock = is.next();
1016 if (sock->localPort() == nmeaPort) {
1017 if (sock->state() == QAbstractSocket::ConnectedState) {
1018 sock->write(str);
[8083]1019 } else if (sock->state() != QAbstractSocket::ConnectingState) {
[7180]1020 delete sock;
1021 is.remove();
1022 }
1023 }
1024 }
1025 }
1026}
Note: See TracBrowser for help on using the repository browser.