source: ntrip/trunk/BNC/src/bncrinex.cpp@ 6781

Last change on this file since 6781 was 6781, checked in by stuerze, 7 years ago

minor changes

File size: 14.9 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: bncRinex
30 *
31 * Purpose: writes RINEX files
32 *
33 * Author: L. Mervart
34 *
35 * Created: 27-Aug-2006
36 *
37 * Changes:
38 *
39 * -----------------------------------------------------------------------*/
40
41#include <stdlib.h>
42#include <iostream>
43#include <iomanip>
44#include <math.h>
45#include <sstream>
46
47#include <QtCore>
48#include <QUrl>
49#include <QString>
50
51#include "bncrinex.h"
52#include "bnccore.h"
53#include "bncutils.h"
54#include "bncconst.h"
55#include "bnctabledlg.h"
56#include "bncgetthread.h"
57#include "bncnetqueryv1.h"
58#include "bncnetqueryv2.h"
59#include "bncsettings.h"
60#include "bncversion.h"
61
62using namespace std;
63
64// Constructor
65////////////////////////////////////////////////////////////////////////////
66bncRinex::bncRinex(const QByteArray& statID, const QUrl& mountPoint,
67 const QByteArray& latitude, const QByteArray& longitude,
68 const QByteArray& nmea, const QByteArray& ntripVersion) {
69
70 _statID = statID;
71 _mountPoint = mountPoint;
72 _latitude = latitude;
73 _longitude = longitude;
74 _nmea = nmea;
75 _ntripVersion = ntripVersion;
76 _headerWritten = false;
77 _reconnectFlag = false;
78
79 bncSettings settings;
80 _rnxScriptName = settings.value("rnxScript").toString();
81 expandEnvVar(_rnxScriptName);
82
83 _pgmName = QString(BNCPGMNAME).leftJustified(20, ' ', true);
84#ifdef WIN32
85 _userName = QString("${USERNAME}");
86#else
87 _userName = QString("${USER}");
88#endif
89 expandEnvVar(_userName);
90 _userName = _userName.leftJustified(20, ' ', true);
91
92 _samplingRate = settings.value("rnxSampl").toInt();
93}
94
95// Destructor
96////////////////////////////////////////////////////////////////////////////
97bncRinex::~bncRinex() {
98 bncSettings settings;
99 if ((_header.version() >= 3.0) && ( Qt::CheckState(settings.value("rnxAppend").toInt()) != Qt::Checked) ) {
100 _out << "> 4 1" << endl;
101 _out << "END OF FILE" << endl;
102 }
103 _out.close();
104}
105
106// Download Skeleton Header File
107////////////////////////////////////////////////////////////////////////////
108t_irc bncRinex::downloadSkeleton() {
109
110 t_irc irc = failure;
111
112 QStringList table;
113 bncTableDlg::getFullTable(_ntripVersion, _mountPoint.host(),
114 _mountPoint.port(), table, true);
115 QString net;
116 QStringListIterator it(table);
117 while (it.hasNext()) {
118 QString line = it.next();
119 if (line.indexOf("STR") == 0) {
120 QStringList tags = line.split(";");
121 if (tags.size() > 7) {
122 if (tags.at(1) == _mountPoint.path().mid(1).toAscii()) {
123 net = tags.at(7);
124 break;
125 }
126 }
127 }
128 }
129 QString sklDir;
130 if (!net.isEmpty()) {
131 it.toFront();
132 while (it.hasNext()) {
133 QString line = it.next();
134 if (line.indexOf("NET") == 0) {
135 QStringList tags = line.split(";");
136 if (tags.size() > 6) {
137 if (tags.at(1) == net) {
138 sklDir = tags.at(6).trimmed();
139 break;
140 }
141 }
142 }
143 }
144 }
145 if (!sklDir.isEmpty() && sklDir != "none") {
146 QUrl url(sklDir + "/" + _mountPoint.path().mid(1,4).toLower() + ".skl");
147 if (url.port() == -1) {
148 if (sklDir.contains("https", Qt::CaseInsensitive)) {
149 url.setPort(443);
150 }
151 else {
152 url.setPort(80);
153 }
154 }
155
156 bncNetQuery* query;
157 if (_ntripVersion == "2s") {
158 query = new bncNetQueryV2(true);
159 }
160 else if (_ntripVersion == "2") {
161 query = new bncNetQueryV2(false);
162 }
163 else {
164 query = new bncNetQueryV1;
165 }
166
167 QByteArray outData;
168 query->waitForRequestResult(url, outData);
169 if (query->status() == bncNetQuery::finished) {
170 irc = success;
171 QTextStream in(outData);
172 _sklHeader.read(&in);
173 }
174
175 delete query;
176 }
177
178 return irc;
179}
180
181// Read Skeleton Header File
182////////////////////////////////////////////////////////////////////////////
183bool bncRinex::readSkeleton() {
184
185 bool readDone = false;
186
187 // Read the local file
188 // -------------------
189 QFile skl(_sklName);
190 if ( skl.exists() && skl.open(QIODevice::ReadOnly) ) {
191 readDone = true;
192 QTextStream in(&skl);
193 _sklHeader.read(&in);
194 }
195
196 // Read downloaded file
197 // --------------------
198 else if ( _ntripVersion != "N" && _ntripVersion != "UN" &&
199 _ntripVersion != "S" ) {
200 QDate currDate = currentDateAndTimeGPS().date();
201 if ( !_skeletonDate.isValid() || _skeletonDate != currDate ) {
202 if (downloadSkeleton() == success) {
203 readDone = true;
204 }
205 _skeletonDate = currDate;
206 }
207 }
208
209 return readDone;
210}
211
212// Next File Epoch (static)
213////////////////////////////////////////////////////////////////////////////
214QString bncRinex::nextEpochStr(const QDateTime& datTim,
215 const QString& intStr, QDateTime* nextEpoch) {
216
217 QString epoStr;
218
219 QTime nextTime;
220 QDate nextDate;
221
222 int indHlp = intStr.indexOf("min");
223
224 if ( indHlp != -1) {
225 int step = intStr.left(indHlp-1).toInt();
226 char ch = 'A' + datTim.time().hour();
227 epoStr = ch;
228 if (datTim.time().minute() >= 60-step) {
229 epoStr += QString("%1").arg(60-step, 2, 10, QChar('0'));
230 if (datTim.time().hour() < 23) {
231 nextTime.setHMS(datTim.time().hour() + 1 , 0, 0);
232 nextDate = datTim.date();
233 }
234 else {
235 nextTime.setHMS(0, 0, 0);
236 nextDate = datTim.date().addDays(1);
237 }
238 }
239 else {
240 for (int limit = step; limit <= 60-step; limit += step) {
241 if (datTim.time().minute() < limit) {
242 epoStr += QString("%1").arg(limit-step, 2, 10, QChar('0'));
243 nextTime.setHMS(datTim.time().hour(), limit, 0);
244 nextDate = datTim.date();
245 break;
246 }
247 }
248 }
249 }
250 else if (intStr == "1 hour") {
251 char ch = 'A' + datTim.time().hour();
252 epoStr = ch;
253 if (datTim.time().hour() < 23) {
254 nextTime.setHMS(datTim.time().hour() + 1 , 0, 0);
255 nextDate = datTim.date();
256 }
257 else {
258 nextTime.setHMS(0, 0, 0);
259 nextDate = datTim.date().addDays(1);
260 }
261 }
262 else {
263 epoStr = "0";
264 nextTime.setHMS(0, 0, 0);
265 nextDate = datTim.date().addDays(1);
266 }
267
268 if (nextEpoch) {
269 *nextEpoch = QDateTime(nextDate, nextTime);
270 }
271
272 return epoStr;
273}
274
275// File Name according to RINEX Standards
276////////////////////////////////////////////////////////////////////////////
277void bncRinex::resolveFileName(const QDateTime& datTim) {
278
279 bncSettings settings;
280 QString path = settings.value("rnxPath").toString();
281 expandEnvVar(path);
282
283 if ( path.length() > 0 && path[path.length()-1] != QDir::separator() ) {
284 path += QDir::separator();
285 }
286
287 QString hlpStr = nextEpochStr(datTim, settings.value("rnxIntr").toString(),
288 &_nextCloseEpoch);
289
290 QString ID4 = _statID.left(4);
291
292 // Check name conflict
293 // -------------------
294 QString distStr;
295 int num = 0;
296 QListIterator<QString> it(settings.value("mountPoints").toStringList());
297 while (it.hasNext()) {
298 QString mp = it.next();
299 if (mp.indexOf(ID4) != -1) {
300 ++num;
301 }
302 }
303 if (num > 1) {
304 distStr = "_" + _statID.mid(4);
305 }
306
307 QString sklExt = settings.value("rnxSkel").toString();
308 if (!sklExt.isEmpty()) {
309 _sklName = path + ID4 + distStr + "." + sklExt;
310 }
311
312 path += ID4 +
313 QString("%1").arg(datTim.date().dayOfYear(), 3, 10, QChar('0')) +
314 hlpStr + distStr + datTim.toString(".yyO");
315
316 _fName = path.toAscii();
317}
318
319// Write RINEX Header
320////////////////////////////////////////////////////////////////////////////
321void bncRinex::writeHeader(const QByteArray& format, const bncTime& firstObsTime) {
322
323 bncSettings settings;
324
325 // Open the Output File
326 // --------------------
327 QDateTime datTimNom = dateAndTimeFromGPSweek(firstObsTime.gpsw(),
328 floor(firstObsTime.gpssec()+0.5));
329 resolveFileName(datTimNom);
330
331 // Append to existing file and return
332 // ----------------------------------
333 if ( QFile::exists(_fName) &&
334 (_reconnectFlag || Qt::CheckState(settings.value("rnxAppend").toInt()) == Qt::Checked) ) {
335 _out.open(_fName.data(), ios::app);
336 _out.setf(ios::showpoint | ios::fixed);
337 _headerWritten = true;
338 _reconnectFlag = false;
339 }
340 else {
341 _out.open(_fName.data());
342 }
343
344 _out.setf(ios::showpoint | ios::fixed);
345
346 // Set RINEX Version
347 // -----------------
348 int intHeaderVers = (Qt::CheckState(settings.value("rnxV3").toInt()) == Qt::Checked ? 3 : 2);
349
350 // Read Skeleton Header
351 // --------------------
352 if (readSkeleton()) {
353 _header.set(_sklHeader, intHeaderVers);
354 }
355 else {
356 _header.setDefault(_statID, intHeaderVers);
357 }
358
359 // A Few Additional Comments
360 // -------------------------
361 _addComments << format.left(6) + " " + _mountPoint.host() + _mountPoint.path();
362 if (_nmea == "yes") {
363 _addComments << "NMEA LAT=" + _latitude + " " + "LONG=" + _longitude;
364 }
365
366 // Write the Header
367 // ----------------
368 QByteArray headerLines;
369 QTextStream outHlp(&headerLines);
370
371 QMap<QString, QString> txtMap;
372 txtMap["COMMENT"] = _addComments.join("\\n");
373
374 _header.setStartTime(firstObsTime);
375 _header.write(&outHlp, &txtMap);
376
377 outHlp.flush();
378
379 if (!_headerWritten) {
380 _out << headerLines.data();
381 }
382
383 _headerWritten = true;
384}
385
386// Stores Observation into Internal Array
387////////////////////////////////////////////////////////////////////////////
388void bncRinex::deepCopy(t_satObs obs) {
389 _obs.push_back(obs);
390}
391
392// Write One Epoch into the RINEX File
393////////////////////////////////////////////////////////////////////////////
394void bncRinex::dumpEpoch(const QByteArray& format, const bncTime& maxTime) {
395
396 // Select observations older than maxTime
397 // --------------------------------------
398 QList<t_satObs> obsList;
399 QMutableListIterator<t_satObs> mIt(_obs);
400 while (mIt.hasNext()) {
401 t_satObs obs = mIt.next();
402 if (obs._time < maxTime) {
403 obsList.push_back(obs);
404 mIt.remove();
405 }
406 }
407
408 // Easy Return
409 // -----------
410 if (obsList.isEmpty()) {
411 return;
412 }
413
414 // Time of Epoch
415 // -------------
416 const t_satObs& fObs = obsList.first();
417 QDateTime datTimNom = dateAndTimeFromGPSweek(fObs._time.gpsw(), floor(fObs._time.gpssec()+0.5));
418
419 // Close the file
420 // --------------
421 if (_nextCloseEpoch.isValid() && datTimNom >= _nextCloseEpoch) {
422 closeFile();
423 _headerWritten = false;
424 }
425
426 // Write RINEX Header
427 // ------------------
428 if (!_headerWritten) {
429 writeHeader(format, fObs._time);
430 }
431
432 // Prepare structure t_rnxEpo
433 // --------------------------
434 t_rnxObsFile::t_rnxEpo rnxEpo;
435 rnxEpo.tt = fObs._time;
436
437 QListIterator<t_satObs> it(obsList);
438 while (it.hasNext()) {
439 const t_satObs& satObs = it.next();
440 t_rnxObsFile::t_rnxSat rnxSat;
441 rnxSat.prn = satObs._prn;
442
443 // Initialize all observations mentioned in skeleton header
444 // --------------------------------------------------------
445 char sys = rnxSat.prn.system();
446 for (int iType = 0; iType < _sklHeader.nTypes(sys); iType++) {
447 QString type = _sklHeader.obsType(sys, iType);
448 t_rnxObsFile::t_rnxObs rnxObs; // create an empty observation
449 rnxSat.obs[type] = rnxObs;
450 }
451
452 for (unsigned ii = 0; ii < satObs._obs.size(); ii++) {
453 const t_frqObs* frqObs = satObs._obs[ii];
454 if (frqObs->_codeValid) {
455 QString type = 'C' + QString(frqObs->_rnxType2ch.c_str());
456 t_rnxObsFile::t_rnxObs rnxObs;
457 rnxObs.value = frqObs->_code;
458 rnxSat.obs[type] = rnxObs;
459 }
460 if (frqObs->_phaseValid) {
461 QString type = 'L' + QString(frqObs->_rnxType2ch.c_str());
462 t_rnxObsFile::t_rnxObs rnxObs;
463 rnxObs.value = frqObs->_phase;
464 if (frqObs->_slip) {
465 rnxObs.lli |= 1;
466 }
467 rnxSat.obs[type] = rnxObs;
468 }
469 if (frqObs->_dopplerValid) {
470 QString type = 'D' + QString(frqObs->_rnxType2ch.c_str());
471 t_rnxObsFile::t_rnxObs rnxObs;
472 rnxObs.value = frqObs->_doppler;
473 rnxSat.obs[type] = rnxObs;
474 }
475 if (frqObs->_snrValid) {
476 QString type = 'S' + QString(frqObs->_rnxType2ch.c_str());
477 t_rnxObsFile::t_rnxObs rnxObs;
478 rnxObs.value = frqObs->_snr;
479 rnxSat.obs[type] = rnxObs;
480 }
481 }
482
483
484 rnxEpo.rnxSat.push_back(rnxSat);
485 }
486
487 // Write the epoch
488 // ---------------
489 QByteArray outLines;
490 QTextStream outStream(&outLines);
491 t_rnxObsFile::writeEpoch(&outStream, _header, &rnxEpo);
492
493 _out << outLines.data();
494 _out.flush();
495}
496
497// Close the Old RINEX File
498////////////////////////////////////////////////////////////////////////////
499void bncRinex::closeFile() {
500 if (_header.version() == 3) {
501 _out << "> 4 1" << endl;
502 _out << "END OF FILE" << endl;
503 }
504 _out.close();
505 if (!_rnxScriptName.isEmpty()) {
506 qApp->thread()->wait(100);
507#ifdef WIN32
508 QProcess::startDetached(_rnxScriptName, QStringList() << _fName) ;
509#else
510 QProcess::startDetached("nohup", QStringList() << _rnxScriptName << _fName) ;
511#endif
512
513 }
514}
515
516// One Line in ASCII (Internal) Format
517////////////////////////////////////////////////////////////////////////////
518string bncRinex::asciiSatLine(const t_satObs& obs) {
519
520 ostringstream str;
521 str.setf(ios::showpoint | ios::fixed);
522
523 str << obs._prn.toString() << ' ';
524
525 for (unsigned ii = 0; ii < obs._obs.size(); ii++) {
526 const t_frqObs* frqObs = obs._obs[ii];
527 if (frqObs->_codeValid) {
528 str << " C" << frqObs->_rnxType2ch << ' '
529 << setw(14) << setprecision(3) << frqObs->_code;
530 }
531 if (frqObs->_phaseValid) {
532 str << " L" << frqObs->_rnxType2ch << ' '
533 << setw(14) << setprecision(3) << frqObs->_phase
534 << ' ' << setw(3) << frqObs->_slipCounter;
535 }
536 if (frqObs->_dopplerValid) {
537 str << " D" << frqObs->_rnxType2ch << ' '
538 << setw(14) << setprecision(3) << frqObs->_doppler;
539 }
540 if (frqObs->_snrValid) {
541 str << " S" << frqObs->_rnxType2ch << ' '
542 << setw(8) << setprecision(3) << frqObs->_snr;
543 }
544 }
545
546 return str.str();
547}
Note: See TracBrowser for help on using the repository browser.