[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: bncCaster
|
---|
| 30 | *
|
---|
| 31 | * Purpose: buffers and disseminates the data
|
---|
| 32 | *
|
---|
| 33 | * Author: L. Mervart
|
---|
| 34 | *
|
---|
| 35 | * Created: 24-Dec-2005
|
---|
| 36 | *
|
---|
| 37 | * Changes:
|
---|
| 38 | *
|
---|
| 39 | * -----------------------------------------------------------------------*/
|
---|
| 40 |
|
---|
[222] | 41 | #include <math.h>
|
---|
[636] | 42 | #include <unistd.h>
|
---|
[222] | 43 |
|
---|
[35] | 44 | #include "bnccaster.h"
|
---|
[1170] | 45 | #include "bncapp.h"
|
---|
[35] | 46 | #include "bncgetthread.h"
|
---|
[134] | 47 | #include "bncutils.h"
|
---|
[1535] | 48 | #include "bncsettings.h"
|
---|
[207] | 49 | #include "RTCM/GPSDecoder.h"
|
---|
[35] | 50 |
|
---|
| 51 | // Constructor
|
---|
| 52 | ////////////////////////////////////////////////////////////////////////////
|
---|
| 53 | bncCaster::bncCaster(const QString& outFileName, int port) {
|
---|
| 54 |
|
---|
[1535] | 55 | bncSettings settings;
|
---|
[275] | 56 |
|
---|
[1299] | 57 | connect(this, SIGNAL(newMessage(QByteArray,bool)),
|
---|
| 58 | (bncApp*) qApp, SLOT(slotMessage(const QByteArray,bool)));
|
---|
[1228] | 59 |
|
---|
[35] | 60 | if ( !outFileName.isEmpty() ) {
|
---|
[134] | 61 | QString lName = outFileName;
|
---|
| 62 | expandEnvVar(lName);
|
---|
| 63 | _outFile = new QFile(lName);
|
---|
[275] | 64 | if ( Qt::CheckState(settings.value("rnxAppend").toInt()) == Qt::Checked) {
|
---|
| 65 | _outFile->open(QIODevice::WriteOnly | QIODevice::Append);
|
---|
| 66 | }
|
---|
| 67 | else {
|
---|
| 68 | _outFile->open(QIODevice::WriteOnly);
|
---|
| 69 | }
|
---|
[35] | 70 | _out = new QTextStream(_outFile);
|
---|
| 71 | _out->setRealNumberNotation(QTextStream::FixedNotation);
|
---|
| 72 | }
|
---|
| 73 | else {
|
---|
| 74 | _outFile = 0;
|
---|
| 75 | _out = 0;
|
---|
| 76 | }
|
---|
| 77 |
|
---|
| 78 | _port = port;
|
---|
| 79 |
|
---|
| 80 | if (_port != 0) {
|
---|
| 81 | _server = new QTcpServer;
|
---|
[1228] | 82 | if ( !_server->listen(QHostAddress::Any, _port) ) {
|
---|
[1450] | 83 | emit newMessage("bncCaster: Cannot listen on sync port", true);
|
---|
[1228] | 84 | }
|
---|
[35] | 85 | connect(_server, SIGNAL(newConnection()), this, SLOT(slotNewConnection()));
|
---|
| 86 | _sockets = new QList<QTcpSocket*>;
|
---|
| 87 | }
|
---|
| 88 | else {
|
---|
| 89 | _server = 0;
|
---|
| 90 | _sockets = 0;
|
---|
| 91 | }
|
---|
| 92 |
|
---|
[1222] | 93 | int uPort = settings.value("outUPort").toInt();
|
---|
| 94 | if (uPort != 0) {
|
---|
| 95 | _uServer = new QTcpServer;
|
---|
[1228] | 96 | if ( !_uServer->listen(QHostAddress::Any, uPort) ) {
|
---|
[1450] | 97 | emit newMessage("bncCaster: Cannot listen on usync port", true);
|
---|
[1228] | 98 | }
|
---|
[1222] | 99 | connect(_uServer, SIGNAL(newConnection()), this, SLOT(slotNewUConnection()));
|
---|
| 100 | _uSockets = new QList<QTcpSocket*>;
|
---|
| 101 | }
|
---|
| 102 | else {
|
---|
| 103 | _uServer = 0;
|
---|
| 104 | _uSockets = 0;
|
---|
| 105 | }
|
---|
| 106 |
|
---|
[2183] | 107 | int nmeaPort = settings.value("nmeaPort").toInt();
|
---|
| 108 | if (nmeaPort != 0) {
|
---|
| 109 | _nmeaServer = new QTcpServer;
|
---|
| 110 | if ( !_nmeaServer->listen(QHostAddress::Any, nmeaPort) ) {
|
---|
| 111 | emit newMessage("bncCaster: Cannot listen on port", true);
|
---|
| 112 | }
|
---|
| 113 | connect(_nmeaServer, SIGNAL(newConnection()), this, SLOT(slotNewNMEAConnection()));
|
---|
| 114 | _nmeaSockets = new QList<QTcpSocket*>;
|
---|
| 115 | }
|
---|
| 116 | else {
|
---|
| 117 | _nmeaServer = 0;
|
---|
| 118 | _nmeaSockets = 0;
|
---|
| 119 | }
|
---|
| 120 |
|
---|
[622] | 121 | _epochs = new QMultiMap<long, p_obs>;
|
---|
[35] | 122 |
|
---|
[2316] | 123 | _lastDumpSec = 0;
|
---|
[133] | 124 |
|
---|
[1705] | 125 | _confInterval = -1;
|
---|
[35] | 126 | }
|
---|
| 127 |
|
---|
| 128 | // Destructor
|
---|
| 129 | ////////////////////////////////////////////////////////////////////////////
|
---|
| 130 | bncCaster::~bncCaster() {
|
---|
[2647] | 131 |
|
---|
| 132 | QMutexLocker locker(&_mutex);
|
---|
| 133 |
|
---|
[186] | 134 | QListIterator<bncGetThread*> it(_threads);
|
---|
| 135 | while(it.hasNext()){
|
---|
| 136 | bncGetThread* thread = it.next();
|
---|
[1525] | 137 | thread->terminate();
|
---|
[186] | 138 | }
|
---|
[35] | 139 | delete _out;
|
---|
| 140 | delete _outFile;
|
---|
[187] | 141 | delete _server;
|
---|
[631] | 142 | delete _sockets;
|
---|
[1222] | 143 | delete _uServer;
|
---|
| 144 | delete _uSockets;
|
---|
[2186] | 145 | delete _nmeaServer;
|
---|
| 146 | delete _nmeaSockets;
|
---|
[603] | 147 | if (_epochs) {
|
---|
[622] | 148 | QListIterator<p_obs> it(_epochs->values());
|
---|
[603] | 149 | while (it.hasNext()) {
|
---|
| 150 | delete it.next();
|
---|
| 151 | }
|
---|
| 152 | delete _epochs;
|
---|
| 153 | }
|
---|
[35] | 154 | }
|
---|
| 155 |
|
---|
| 156 | // New Observations
|
---|
| 157 | ////////////////////////////////////////////////////////////////////////////
|
---|
[622] | 158 | void bncCaster::newObs(const QByteArray staID, bool firstObs, p_obs obs) {
|
---|
[35] | 159 |
|
---|
[243] | 160 | QMutexLocker locker(&_mutex);
|
---|
| 161 |
|
---|
[624] | 162 | obs->_status = t_obs::received;
|
---|
| 163 |
|
---|
[2316] | 164 | long iSec = long(floor(obs->_o.GPSWeeks+0.5));
|
---|
| 165 | long newTime = obs->_o.GPSWeek * 7*24*3600 + iSec;
|
---|
[35] | 166 |
|
---|
[160] | 167 | // Rename the Station
|
---|
| 168 | // ------------------
|
---|
[622] | 169 | strncpy(obs->_o.StatID, staID.constData(),sizeof(obs->_o.StatID));
|
---|
| 170 | obs->_o.StatID[sizeof(obs->_o.StatID)-1] = '\0';
|
---|
[160] | 171 |
|
---|
[1222] | 172 | const char begObs[] = "BEGOBS";
|
---|
| 173 | const int begObsNBytes = sizeof(begObs) - 1;
|
---|
| 174 |
|
---|
| 175 | // Output into the socket
|
---|
| 176 | // ----------------------
|
---|
| 177 | if (_uSockets) {
|
---|
| 178 | QMutableListIterator<QTcpSocket*> is(*_uSockets);
|
---|
| 179 | while (is.hasNext()) {
|
---|
| 180 | QTcpSocket* sock = is.next();
|
---|
| 181 | if (sock->state() == QAbstractSocket::ConnectedState) {
|
---|
| 182 | bool ok = true;
|
---|
| 183 | if (myWrite(sock, begObs, begObsNBytes) != begObsNBytes) {
|
---|
| 184 | ok = false;
|
---|
| 185 | }
|
---|
| 186 | int numBytes = sizeof(obs->_o);
|
---|
| 187 | if (myWrite(sock, (const char*)(&obs->_o), numBytes) != numBytes) {
|
---|
| 188 | ok = false;
|
---|
| 189 | }
|
---|
| 190 | if (!ok) {
|
---|
| 191 | delete sock;
|
---|
| 192 | is.remove();
|
---|
| 193 | }
|
---|
| 194 | }
|
---|
| 195 | else if (sock->state() != QAbstractSocket::ConnectingState) {
|
---|
| 196 | delete sock;
|
---|
| 197 | is.remove();
|
---|
| 198 | }
|
---|
| 199 | }
|
---|
| 200 | }
|
---|
| 201 |
|
---|
[35] | 202 | // First time, set the _lastDumpSec immediately
|
---|
| 203 | // --------------------------------------------
|
---|
[2316] | 204 | if (_lastDumpSec == 0) {
|
---|
| 205 | _lastDumpSec = newTime - 1;
|
---|
[35] | 206 | }
|
---|
| 207 |
|
---|
| 208 | // An old observation - throw it away
|
---|
| 209 | // ----------------------------------
|
---|
[2316] | 210 | if (newTime <= _lastDumpSec) {
|
---|
[257] | 211 | if (firstObs) {
|
---|
[1535] | 212 | bncSettings settings;
|
---|
[257] | 213 | if ( !settings.value("outFile").toString().isEmpty() ||
|
---|
| 214 | !settings.value("outPort").toString().isEmpty() ) {
|
---|
[1810] | 215 |
|
---|
[2316] | 216 | QTime enomtime = QTime(0,0,0).addSecs(iSec);
|
---|
[1810] | 217 |
|
---|
| 218 | emit( newMessage(QString("%1: Old epoch %2 (%3) thrown away")
|
---|
[2316] | 219 | .arg(staID.data()).arg(iSec)
|
---|
[1810] | 220 | .arg(enomtime.toString("HH:mm:ss"))
|
---|
| 221 | .toAscii(), true) );
|
---|
[257] | 222 | }
|
---|
[181] | 223 | }
|
---|
[35] | 224 | delete obs;
|
---|
[350] | 225 | return;
|
---|
[35] | 226 | }
|
---|
| 227 |
|
---|
[160] | 228 | // Save the observation
|
---|
| 229 | // --------------------
|
---|
[2316] | 230 | _epochs->insert(newTime, obs);
|
---|
[393] | 231 |
|
---|
[462] | 232 | // Dump Epochs
|
---|
| 233 | // -----------
|
---|
[2316] | 234 | if (newTime - _waitTime > _lastDumpSec) {
|
---|
| 235 | dumpEpochs(_lastDumpSec + 1, newTime - _waitTime);
|
---|
| 236 | _lastDumpSec = newTime - _waitTime;
|
---|
[252] | 237 | }
|
---|
[35] | 238 | }
|
---|
| 239 |
|
---|
| 240 | // New Connection
|
---|
| 241 | ////////////////////////////////////////////////////////////////////////////
|
---|
| 242 | void bncCaster::slotNewConnection() {
|
---|
| 243 | _sockets->push_back( _server->nextPendingConnection() );
|
---|
[1450] | 244 | emit( newMessage(QString("New client connection on sync port: # %1")
|
---|
[1299] | 245 | .arg(_sockets->size()).toAscii(), true) );
|
---|
[35] | 246 | }
|
---|
| 247 |
|
---|
[1222] | 248 | void bncCaster::slotNewUConnection() {
|
---|
| 249 | _uSockets->push_back( _uServer->nextPendingConnection() );
|
---|
[1450] | 250 | emit( newMessage(QString("New client connection on usync port: # %1")
|
---|
[1299] | 251 | .arg(_uSockets->size()).toAscii(), true) );
|
---|
[1222] | 252 | }
|
---|
| 253 |
|
---|
[2183] | 254 | void bncCaster::slotNewNMEAConnection() {
|
---|
| 255 | _nmeaSockets->push_back( _nmeaServer->nextPendingConnection() );
|
---|
| 256 | emit( newMessage(QString("New PPP client on port: # %1")
|
---|
| 257 | .arg(_nmeaSockets->size()).toAscii(), true) );
|
---|
| 258 | }
|
---|
| 259 |
|
---|
[35] | 260 | // Add New Thread
|
---|
| 261 | ////////////////////////////////////////////////////////////////////////////
|
---|
[2528] | 262 | void bncCaster::addGetThread(bncGetThread* getThread, bool noNewThread) {
|
---|
[624] | 263 |
|
---|
| 264 | qRegisterMetaType<p_obs>("p_obs");
|
---|
[2585] | 265 | qRegisterMetaType<gpsephemeris>("gpsephemeris");
|
---|
| 266 | qRegisterMetaType<glonassephemeris>("glonassephemeris");
|
---|
[624] | 267 |
|
---|
[628] | 268 | connect(getThread, SIGNAL(newObs(QByteArray, bool, p_obs)),
|
---|
[2646] | 269 | this, SLOT(newObs(QByteArray, bool, p_obs)),
|
---|
| 270 | Qt::DirectConnection);
|
---|
[463] | 271 |
|
---|
[1556] | 272 | connect(getThread, SIGNAL(getThreadFinished(QByteArray)),
|
---|
| 273 | this, SLOT(slotGetThreadFinished(QByteArray)));
|
---|
[35] | 274 |
|
---|
[2182] | 275 | connect(getThread, SIGNAL(newNMEAstr(QByteArray)),
|
---|
| 276 | this, SLOT(slotNewNMEAstr(QByteArray)));
|
---|
| 277 |
|
---|
[1807] | 278 | connect(((bncApp*)qApp), SIGNAL(newEphGPS(gpsephemeris)),
|
---|
[2585] | 279 | getThread, SLOT(slotNewEphGPS(gpsephemeris)));
|
---|
[1807] | 280 |
|
---|
[88] | 281 | _staIDs.push_back(getThread->staID());
|
---|
[186] | 282 | _threads.push_back(getThread);
|
---|
[1170] | 283 |
|
---|
[2528] | 284 | if (noNewThread) {
|
---|
| 285 | getThread->run();
|
---|
| 286 | }
|
---|
| 287 | else {
|
---|
| 288 | getThread->start();
|
---|
| 289 | }
|
---|
[35] | 290 | }
|
---|
| 291 |
|
---|
[1556] | 292 | // Get Thread destroyed
|
---|
[35] | 293 | ////////////////////////////////////////////////////////////////////////////
|
---|
[1556] | 294 | void bncCaster::slotGetThreadFinished(QByteArray staID) {
|
---|
[243] | 295 | QMutexLocker locker(&_mutex);
|
---|
[1560] | 296 |
|
---|
| 297 | QListIterator<bncGetThread*> it(_threads);
|
---|
| 298 | while (it.hasNext()) {
|
---|
| 299 | bncGetThread* thread = it.next();
|
---|
| 300 | if (thread->staID() == staID) {
|
---|
| 301 | _threads.removeOne(thread);
|
---|
| 302 | }
|
---|
| 303 | }
|
---|
| 304 |
|
---|
[88] | 305 | _staIDs.removeAll(staID);
|
---|
[82] | 306 | emit( newMessage(
|
---|
[1986] | 307 | QString("Decoding %1 stream(s)").arg(_staIDs.size()).toAscii(), true) );
|
---|
[88] | 308 | if (_staIDs.size() == 0) {
|
---|
[1450] | 309 | emit(newMessage("bncCaster: Last get thread terminated", true));
|
---|
[1556] | 310 | emit getThreadsFinished();
|
---|
[35] | 311 | }
|
---|
| 312 | }
|
---|
| 313 |
|
---|
| 314 | // Dump Complete Epochs
|
---|
| 315 | ////////////////////////////////////////////////////////////////////////////
|
---|
[2316] | 316 | void bncCaster::dumpEpochs(long minTime, long maxTime) {
|
---|
[35] | 317 |
|
---|
[1182] | 318 | const char begEpoch[] = "BEGEPOCH";
|
---|
| 319 | const char endEpoch[] = "ENDEPOCH";
|
---|
[35] | 320 |
|
---|
[1182] | 321 | const int begEpochNBytes = sizeof(begEpoch) - 1;
|
---|
| 322 | const int endEpochNBytes = sizeof(endEpoch) - 1;
|
---|
| 323 |
|
---|
[2316] | 324 | for (long sec = minTime; sec <= maxTime; sec++) {
|
---|
[140] | 325 |
|
---|
[35] | 326 | bool first = true;
|
---|
[2316] | 327 | QList<p_obs> allObs = _epochs->values(sec);
|
---|
[1999] | 328 |
|
---|
[622] | 329 | QListIterator<p_obs> it(allObs);
|
---|
[35] | 330 | while (it.hasNext()) {
|
---|
[622] | 331 | p_obs obs = it.next();
|
---|
[35] | 332 |
|
---|
[2316] | 333 | if (_samplingRate == 0 || sec % _samplingRate == 0) {
|
---|
[1810] | 334 |
|
---|
| 335 | if (first) {
|
---|
| 336 | QTime enomtime = QTime(0,0,0).addSecs(static_cast<int>(floor(obs->_o.GPSWeeks+0.5)));
|
---|
[1821] | 337 | // emit( newMessage( QString("Epoch %1 dumped").arg(enomtime.toString("HH:mm:ss")).toAscii(), true) ); // weber
|
---|
[1810] | 338 | }
|
---|
[140] | 339 | // Output into the file
|
---|
| 340 | // --------------------
|
---|
| 341 | if (_out) {
|
---|
[35] | 342 | if (first) {
|
---|
[1810] | 343 | _out->setFieldWidth(1); *_out << begEpoch << endl;
|
---|
[35] | 344 | }
|
---|
[622] | 345 | _out->setFieldWidth(0); *_out << obs->_o.StatID;
|
---|
| 346 | _out->setFieldWidth(1); *_out << " " << obs->_o.satSys;
|
---|
[344] | 347 | _out->setPadChar('0');
|
---|
[622] | 348 | _out->setFieldWidth(2); *_out << obs->_o.satNum;
|
---|
[344] | 349 | _out->setPadChar(' ');
|
---|
[342] | 350 | _out->setFieldWidth(1); *_out << " ";
|
---|
[622] | 351 | _out->setFieldWidth(4); *_out << obs->_o.GPSWeek;
|
---|
[342] | 352 | _out->setFieldWidth(1); *_out << " ";
|
---|
[622] | 353 | _out->setFieldWidth(14); _out->setRealNumberPrecision(7); *_out << obs->_o.GPSWeeks;
|
---|
[342] | 354 | _out->setFieldWidth(1); *_out << " ";
|
---|
[622] | 355 | _out->setFieldWidth(14); _out->setRealNumberPrecision(3); *_out << obs->_o.C1;
|
---|
[342] | 356 | _out->setFieldWidth(1); *_out << " ";
|
---|
[622] | 357 | _out->setFieldWidth(14); _out->setRealNumberPrecision(3); *_out << obs->_o.C2;
|
---|
[366] | 358 | _out->setFieldWidth(1); *_out << " ";
|
---|
[622] | 359 | _out->setFieldWidth(14); _out->setRealNumberPrecision(3); *_out << obs->_o.P1;
|
---|
[342] | 360 | _out->setFieldWidth(1); *_out << " ";
|
---|
[622] | 361 | _out->setFieldWidth(14); _out->setRealNumberPrecision(3); *_out << obs->_o.P2;
|
---|
[342] | 362 | _out->setFieldWidth(1); *_out << " ";
|
---|
[622] | 363 | _out->setFieldWidth(14); _out->setRealNumberPrecision(3); *_out << obs->_o.L1;
|
---|
[342] | 364 | _out->setFieldWidth(1); *_out << " ";
|
---|
[622] | 365 | _out->setFieldWidth(14); _out->setRealNumberPrecision(3); *_out << obs->_o.L2;
|
---|
[367] | 366 | _out->setFieldWidth(1); *_out << " ";
|
---|
[622] | 367 | _out->setFieldWidth(14); _out->setRealNumberPrecision(3); *_out << obs->_o.S1;
|
---|
[367] | 368 | _out->setFieldWidth(1); *_out << " ";
|
---|
[622] | 369 | _out->setFieldWidth(14); _out->setRealNumberPrecision(3); *_out << obs->_o.S2;
|
---|
[342] | 370 | _out->setFieldWidth(1);
|
---|
[622] | 371 | *_out << " " << obs->_o.SNR1 << " " << obs->_o.SNR2 << endl;
|
---|
[35] | 372 | if (!it.hasNext()) {
|
---|
[341] | 373 | _out->setFieldWidth(1); *_out << endEpoch << endl;
|
---|
[35] | 374 | }
|
---|
[347] | 375 | _out->flush();
|
---|
[35] | 376 | }
|
---|
[140] | 377 |
|
---|
| 378 | // Output into the socket
|
---|
| 379 | // ----------------------
|
---|
| 380 | if (_sockets) {
|
---|
[637] | 381 | QMutableListIterator<QTcpSocket*> is(*_sockets);
|
---|
[140] | 382 | while (is.hasNext()) {
|
---|
| 383 | QTcpSocket* sock = is.next();
|
---|
[397] | 384 | if (sock->state() == QAbstractSocket::ConnectedState) {
|
---|
[637] | 385 | bool ok = true;
|
---|
[397] | 386 | if (first) {
|
---|
[1182] | 387 | if (myWrite(sock, begEpoch, begEpochNBytes) != begEpochNBytes) {
|
---|
[637] | 388 | ok = false;
|
---|
| 389 | }
|
---|
[397] | 390 | }
|
---|
[1182] | 391 | int numBytes = sizeof(obs->_o);
|
---|
| 392 | if (myWrite(sock, (const char*)(&obs->_o), numBytes) != numBytes) {
|
---|
[637] | 393 | ok = false;
|
---|
| 394 | }
|
---|
[397] | 395 | if (!it.hasNext()) {
|
---|
[1182] | 396 | if (myWrite(sock, endEpoch, endEpochNBytes) != endEpochNBytes) {
|
---|
[637] | 397 | ok = false;
|
---|
| 398 | }
|
---|
[397] | 399 | }
|
---|
[637] | 400 | if (!ok) {
|
---|
| 401 | delete sock;
|
---|
| 402 | is.remove();
|
---|
| 403 | }
|
---|
[140] | 404 | }
|
---|
[637] | 405 | else if (sock->state() != QAbstractSocket::ConnectingState) {
|
---|
| 406 | delete sock;
|
---|
| 407 | is.remove();
|
---|
| 408 | }
|
---|
[140] | 409 | }
|
---|
| 410 | }
|
---|
[73] | 411 | }
|
---|
| 412 |
|
---|
[35] | 413 | delete obs;
|
---|
[2316] | 414 | _epochs->remove(sec);
|
---|
[35] | 415 | first = false;
|
---|
| 416 | }
|
---|
| 417 | }
|
---|
| 418 | }
|
---|
[1170] | 419 |
|
---|
| 420 | // Reread configuration
|
---|
| 421 | ////////////////////////////////////////////////////////////////////////////
|
---|
[1179] | 422 | void bncCaster::slotReadMountPoints() {
|
---|
[1170] | 423 |
|
---|
[1535] | 424 | bncSettings settings;
|
---|
[1170] | 425 |
|
---|
| 426 | // Reread several options
|
---|
| 427 | // ----------------------
|
---|
[2316] | 428 | _samplingRate = settings.value("binSampl").toInt();
|
---|
| 429 | _waitTime = settings.value("waitTime").toInt();
|
---|
| 430 | if (_waitTime < 1) {
|
---|
| 431 | _waitTime = 1;
|
---|
[1170] | 432 | }
|
---|
| 433 |
|
---|
| 434 | // Add new mountpoints
|
---|
| 435 | // -------------------
|
---|
| 436 | int iMount = -1;
|
---|
| 437 | QListIterator<QString> it(settings.value("mountPoints").toStringList());
|
---|
| 438 | while (it.hasNext()) {
|
---|
| 439 | ++iMount;
|
---|
| 440 | QStringList hlp = it.next().split(" ");
|
---|
| 441 | if (hlp.size() <= 1) continue;
|
---|
| 442 | QUrl url(hlp[0]);
|
---|
| 443 |
|
---|
| 444 | // Does it already exist?
|
---|
| 445 | // ----------------------
|
---|
| 446 | bool existFlg = false;
|
---|
| 447 | QListIterator<bncGetThread*> iTh(_threads);
|
---|
| 448 | while (iTh.hasNext()) {
|
---|
| 449 | bncGetThread* thread = iTh.next();
|
---|
| 450 | if (thread->mountPoint() == url) {
|
---|
| 451 | existFlg = true;
|
---|
| 452 | break;
|
---|
| 453 | }
|
---|
| 454 | }
|
---|
| 455 |
|
---|
| 456 | // New bncGetThread
|
---|
| 457 | // ----------------
|
---|
| 458 | if (!existFlg) {
|
---|
| 459 | QByteArray format = hlp[1].toAscii();
|
---|
| 460 | QByteArray latitude = hlp[2].toAscii();
|
---|
| 461 | QByteArray longitude = hlp[3].toAscii();
|
---|
| 462 | QByteArray nmea = hlp[4].toAscii();
|
---|
[1353] | 463 | QByteArray ntripVersion = hlp[5].toAscii();
|
---|
[1170] | 464 |
|
---|
| 465 | bncGetThread* getThread = new bncGetThread(url, format, latitude,
|
---|
[1770] | 466 | longitude, nmea, ntripVersion, "");
|
---|
[1170] | 467 | addGetThread(getThread);
|
---|
| 468 | }
|
---|
| 469 | }
|
---|
| 470 |
|
---|
| 471 | // Remove mountpoints
|
---|
| 472 | // ------------------
|
---|
| 473 | QListIterator<bncGetThread*> iTh(_threads);
|
---|
| 474 | while (iTh.hasNext()) {
|
---|
| 475 | bncGetThread* thread = iTh.next();
|
---|
| 476 |
|
---|
| 477 | bool existFlg = false;
|
---|
| 478 | QListIterator<QString> it(settings.value("mountPoints").toStringList());
|
---|
| 479 | while (it.hasNext()) {
|
---|
| 480 | QStringList hlp = it.next().split(" ");
|
---|
| 481 | if (hlp.size() <= 1) continue;
|
---|
| 482 | QUrl url(hlp[0]);
|
---|
| 483 |
|
---|
| 484 | if (thread->mountPoint() == url) {
|
---|
| 485 | existFlg = true;
|
---|
| 486 | break;
|
---|
| 487 | }
|
---|
| 488 | }
|
---|
| 489 |
|
---|
| 490 | if (!existFlg) {
|
---|
| 491 | disconnect(thread, 0, 0, 0);
|
---|
| 492 | _staIDs.removeAll(thread->staID());
|
---|
| 493 | _threads.removeAll(thread);
|
---|
| 494 | thread->terminate();
|
---|
| 495 | }
|
---|
| 496 | }
|
---|
| 497 |
|
---|
[1179] | 498 | emit mountPointsRead(_threads);
|
---|
[1529] | 499 | emit( newMessage(QString("Configuration read: "
|
---|
[1542] | 500 | + ((bncApp*) qApp)->confFileName()
|
---|
[1529] | 501 | + ", %1 stream(s)")
|
---|
[1299] | 502 | .arg(_threads.count()).toAscii(), true) );
|
---|
[1176] | 503 |
|
---|
[1170] | 504 | // (Re-) Start the configuration timer
|
---|
| 505 | // -----------------------------------
|
---|
| 506 | int ms = 0;
|
---|
| 507 |
|
---|
[1705] | 508 | if (_confInterval != -1) {
|
---|
[1170] | 509 | ms = 1000 * _confInterval;
|
---|
| 510 | }
|
---|
| 511 | else {
|
---|
| 512 | QTime currTime = currentDateAndTimeGPS().time();
|
---|
| 513 | QTime nextShotTime;
|
---|
| 514 |
|
---|
| 515 | if (settings.value("onTheFlyInterval").toString() == "1 min") {
|
---|
| 516 | _confInterval = 60;
|
---|
| 517 | nextShotTime = QTime(currTime.hour(), currTime.minute()+1, 0);
|
---|
| 518 | }
|
---|
| 519 | else if (settings.value("onTheFlyInterval").toString() == "1 hour") {
|
---|
| 520 | _confInterval = 3600;
|
---|
| 521 | nextShotTime = QTime(currTime.hour()+1, 0, 0);
|
---|
| 522 | }
|
---|
| 523 | else {
|
---|
| 524 | _confInterval = 86400;
|
---|
| 525 | nextShotTime = QTime(23, 59, 59, 999);
|
---|
| 526 | }
|
---|
| 527 |
|
---|
| 528 | ms = currTime.msecsTo(nextShotTime);
|
---|
[1176] | 529 | if (ms < 30000) {
|
---|
| 530 | ms = 30000;
|
---|
| 531 | }
|
---|
[1170] | 532 | }
|
---|
| 533 |
|
---|
[1705] | 534 | QTimer::singleShot(ms, this, SLOT(slotReadMountPoints()));
|
---|
[1170] | 535 | }
|
---|
[1182] | 536 |
|
---|
| 537 | //
|
---|
| 538 | ////////////////////////////////////////////////////////////////////////////
|
---|
| 539 | int bncCaster::myWrite(QTcpSocket* sock, const char* buf, int bufLen) {
|
---|
[1229] | 540 | sock->write(buf, bufLen);
|
---|
| 541 | for (int ii = 1; ii <= 10; ii++) {
|
---|
| 542 | if (sock->waitForBytesWritten(10)) { // wait 10 ms
|
---|
| 543 | return bufLen;
|
---|
[1182] | 544 | }
|
---|
| 545 | }
|
---|
[1229] | 546 | return -1;
|
---|
[1182] | 547 | }
|
---|
[2182] | 548 |
|
---|
| 549 | //
|
---|
| 550 | ////////////////////////////////////////////////////////////////////////////
|
---|
| 551 | void bncCaster::slotNewNMEAstr(QByteArray str) {
|
---|
[2184] | 552 | if (_nmeaSockets) {
|
---|
| 553 | QMutableListIterator<QTcpSocket*> is(*_nmeaSockets);
|
---|
| 554 | while (is.hasNext()) {
|
---|
| 555 | QTcpSocket* sock = is.next();
|
---|
| 556 | if (sock->state() == QAbstractSocket::ConnectedState) {
|
---|
| 557 | sock->write(str);
|
---|
| 558 | }
|
---|
| 559 | else if (sock->state() != QAbstractSocket::ConnectingState) {
|
---|
| 560 | delete sock;
|
---|
| 561 | is.remove();
|
---|
| 562 | }
|
---|
| 563 | }
|
---|
| 564 | }
|
---|
[2182] | 565 | }
|
---|