source: ntrip/branches/BNC_2.11.0/src/bncrinex.cpp@ 6214

Last change on this file since 6214 was 5530, checked in by mervart, 10 years ago
File size: 19.3 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#include "rtcm3torinex.h"
62
63using namespace std;
64
65// Constructor
66////////////////////////////////////////////////////////////////////////////
67bncRinex::bncRinex(const QByteArray& statID, const QUrl& mountPoint,
68 const QByteArray& latitude, const QByteArray& longitude,
69 const QByteArray& nmea, const QByteArray& ntripVersion) {
70
71 _statID = statID;
72 _mountPoint = mountPoint;
73 _latitude = latitude;
74 _longitude = longitude;
75 _nmea = nmea;
76 _ntripVersion = ntripVersion;
77 _headerWritten = false;
78 _reconnectFlag = false;
79
80 bncSettings settings;
81 _rnxScriptName = settings.value("rnxScript").toString();
82 expandEnvVar(_rnxScriptName);
83
84 _pgmName = QString(BNCPGMNAME).leftJustified(20, ' ', true);
85#ifdef WIN32
86 _userName = QString("${USERNAME}");
87#else
88 _userName = QString("${USER}");
89#endif
90 expandEnvVar(_userName);
91 _userName = _userName.leftJustified(20, ' ', true);
92
93 _samplingRate = settings.value("rnxSampl").toInt();
94}
95
96// Destructor
97////////////////////////////////////////////////////////////////////////////
98bncRinex::~bncRinex() {
99 bncSettings settings;
100 if ((_header._version >= 3.0) && ( Qt::CheckState(settings.value("rnxAppend").toInt()) != Qt::Checked) ) {
101 _out << "> 4 1" << endl;
102 _out << "END OF FILE" << endl;
103 }
104 _out.close();
105}
106
107// Download Skeleton Header File
108////////////////////////////////////////////////////////////////////////////
109t_irc bncRinex::downloadSkeleton() {
110
111 t_irc irc = failure;
112
113 QStringList table;
114 bncTableDlg::getFullTable(_ntripVersion, _mountPoint.host(),
115 _mountPoint.port(), table, true);
116 QString net;
117 QStringListIterator it(table);
118 while (it.hasNext()) {
119 QString line = it.next();
120 if (line.indexOf("STR") == 0) {
121 QStringList tags = line.split(";");
122 if (tags.size() > 7) {
123 if (tags.at(1) == _mountPoint.path().mid(1).toAscii()) {
124 net = tags.at(7);
125 break;
126 }
127 }
128 }
129 }
130 QString sklDir;
131 if (!net.isEmpty()) {
132 it.toFront();
133 while (it.hasNext()) {
134 QString line = it.next();
135 if (line.indexOf("NET") == 0) {
136 QStringList tags = line.split(";");
137 if (tags.size() > 6) {
138 if (tags.at(1) == net) {
139 sklDir = tags.at(6).trimmed();
140 break;
141 }
142 }
143 }
144 }
145 }
146 if (!sklDir.isEmpty() && sklDir != "none") {
147 QUrl url(sklDir + "/" + _mountPoint.path().mid(1,4).toLower() + ".skl");
148 if (url.port() == -1) {
149 url.setPort(80);
150 }
151
152 bncNetQuery* query;
153 if (_ntripVersion == "2s") {
154 query = new bncNetQueryV2(true);
155 }
156 else if (_ntripVersion == "2") {
157 query = new bncNetQueryV2(false);
158 }
159 else {
160 query = new bncNetQueryV1;
161 }
162
163 QByteArray outData;
164 query->waitForRequestResult(url, outData);
165 if (query->status() == bncNetQuery::finished) {
166 irc = success;
167 _header._obsTypesV2.clear();
168 _header._obsTypesV3.clear();
169 QTextStream in(outData);
170 _header.read(&in);
171 }
172
173 delete query;
174 }
175
176 return irc;
177}
178
179// Read Skeleton Header File
180////////////////////////////////////////////////////////////////////////////
181bool bncRinex::readSkeleton() {
182
183 bool readDone = false;
184
185 // Read the local file
186 // -------------------
187 QFile skl(_sklName);
188 if ( skl.exists() && skl.open(QIODevice::ReadOnly) ) {
189 readDone = true;
190 _header._obsTypesV2.clear();
191 _header._obsTypesV3.clear();
192 QTextStream in(&skl);
193 _header.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,
322 const QDateTime& datTimNom) {
323
324 bncSettings settings;
325
326 // Open the Output File
327 // --------------------
328 resolveFileName(datTimNom);
329
330 // Append to existing file and return
331 // ----------------------------------
332 if ( QFile::exists(_fName) &&
333 (_reconnectFlag || Qt::CheckState(settings.value("rnxAppend").toInt()) == Qt::Checked) ) {
334 _out.open(_fName.data(), ios::app);
335 _out.setf(ios::showpoint | ios::fixed);
336 _headerWritten = true;
337 _reconnectFlag = false;
338 }
339 else {
340 _out.open(_fName.data());
341 }
342
343 _out.setf(ios::showpoint | ios::fixed);
344
345 // Read Skeleton Header
346 // --------------------
347 bool skelRead = readSkeleton();
348
349 // Set RINEX Version
350 // -----------------
351 if ( Qt::CheckState(settings.value("rnxV3").toInt()) == Qt::Checked) {
352 _header._version = t_rnxObsHeader::defaultRnxObsVersion3;
353 }
354 else {
355 _header._version = t_rnxObsHeader::defaultRnxObsVersion2;
356 }
357
358 // A Few Additional Comments
359 // -------------------------
360 if (skelRead || _addComments.size() == 0) {
361 _addComments.clear();
362 _addComments << format.left(6) + " "
363 + _mountPoint.host() + _mountPoint.path();
364 if (_header._obsTypesV3.size() == 0 && _header._version >= 3.0) {
365 _addComments << "Default set of observation types used";
366 }
367 if (_nmea == "yes") {
368 _addComments << "NMEA LAT=" + _latitude + " " + "LONG=" + _longitude;
369 }
370 }
371
372 // Set Marker Name
373 // ---------------
374 if (_header._markerName.isEmpty()) {
375 _header._markerName = _statID;
376 }
377
378 // Set Default RINEX v2 Types
379 // --------------------------
380 if (_header._obsTypesV2.size() == 0) {
381 _header._obsTypesV2 << "C1" << "P1" << "L1" << "S1"
382 << "C2" << "P2" << "L2" << "S2";
383 }
384
385 // Set Default RINEX v3 Types
386 // ---------------------------
387 if (_header._obsTypesV3.size() == 0) {
388 _header._obsTypesV3['G'] << "C1C" << "L1C" << "D1C" << "S1C"
389 << "C1P" << "L1P" << "D1P" << "S1P"
390 << "C2C" << "L2C" << "D2C" << "S2C"
391 << "C2P" << "L2P" << "D2P" << "S2P"
392 << "C5" << "D5" << "L5" << "S5";
393
394 _header._obsTypesV3['R'] << "C1C" << "L1C" << "D1C" << "S1C"
395 << "C1P" << "L1P" << "D1P" << "S1P"
396 << "C2C" << "L2C" << "D2C" << "S2C"
397 << "C2P" << "L2P" << "D2P" << "S2P";
398
399 _header._obsTypesV3['E'] << "C1" << "L1" << "D1" << "S1"
400 << "C5" << "L5" << "D5" << "S5"
401 << "C6" << "L6" << "D6" << "S6"
402 << "C7" << "L7" << "D7" << "S7"
403 << "C8" << "L8" << "D8" << "S8";
404
405 _header._obsTypesV3['J'] << "C1" << "L1" << "D1" << "S1"
406 << "C2" << "L2" << "D2" << "S2"
407 << "C5" << "L5" << "D5" << "S5"
408 << "C6" << "D6" << "L6" << "S6";
409
410 _header._obsTypesV3['S'] << "C1" << "L1" << "D1" << "S1"
411 << "C5" << "L5" << "D5" << "S5";
412
413 _header._obsTypesV3['C'] << "C1" << "L1" << "D1" << "S1"
414 << "C6" << "L6" << "D6" << "S6"
415 << "C7" << "L7" << "D7" << "S7";
416 }
417
418 // Write the Header
419 // ----------------
420 QByteArray headerLines;
421 QTextStream outHlp(&headerLines);
422
423 QMap<QString, QString> txtMap;
424 txtMap["COMMENT"] = _addComments.join("\\n");
425
426 _header.write(&outHlp, &txtMap);
427
428 outHlp.flush();
429
430 if (!_headerWritten) {
431 _out << headerLines.data();
432 }
433
434 _headerWritten = true;
435}
436
437// Stores Observation into Internal Array
438////////////////////////////////////////////////////////////////////////////
439void bncRinex::deepCopy(t_obs obs) {
440 _obs.push_back(obs);
441}
442
443// Write One Epoch into the RINEX File
444////////////////////////////////////////////////////////////////////////////
445void bncRinex::dumpEpoch(const QByteArray& format, long maxTime) {
446
447 // Select observations older than maxTime
448 // --------------------------------------
449 QList<t_obs> dumpList;
450 QMutableListIterator<t_obs> mIt(_obs);
451 while (mIt.hasNext()) {
452 t_obs obs = mIt.next();
453 if (obs.GPSWeek * 7*24*3600 + obs.GPSWeeks < maxTime - 0.05) {
454 dumpList.push_back(obs);
455 mIt.remove();
456 }
457 }
458
459 // Easy Return
460 // -----------
461 if (dumpList.isEmpty()) {
462 return;
463 }
464
465 // Time of Epoch
466 // -------------
467 const t_obs& fObs = dumpList.first();
468 QDateTime datTim = dateAndTimeFromGPSweek(fObs.GPSWeek, fObs.GPSWeeks);
469 QDateTime datTimNom = dateAndTimeFromGPSweek(fObs.GPSWeek,
470 floor(fObs.GPSWeeks+0.5));
471
472 // Close the file
473 // --------------
474 if (_nextCloseEpoch.isValid() && datTimNom >= _nextCloseEpoch) {
475 closeFile();
476 _headerWritten = false;
477 }
478
479 // Write RINEX Header
480 // ------------------
481 if (!_headerWritten) {
482 _header._startTime.set(fObs.GPSWeek, fObs.GPSWeeks);
483 writeHeader(format, datTimNom);
484 }
485
486 // Check whether observation types available
487 // -----------------------------------------
488 QMutableListIterator<t_obs> mItDump(dumpList);
489 while (mItDump.hasNext()) {
490 t_obs& obs = mItDump.next();
491 if (!_header._obsTypesV3.contains(obs.satSys) && !_header._obsTypesV3.contains(obs.satSys)) {
492 mItDump.remove();
493 }
494 }
495 if (dumpList.isEmpty()) {
496 return;
497 }
498
499 double sec = double(datTim.time().second()) + fmod(fObs.GPSWeeks,1.0);
500
501 // Epoch header line: RINEX Version 3
502 // ----------------------------------
503 if (_header._version >= 3.0) {
504 _out << datTim.toString("> yyyy MM dd hh mm ").toAscii().data()
505 << setw(10) << setprecision(7) << sec
506 << " " << 0 << setw(3) << dumpList.size() << endl;
507 }
508 // Epoch header line: RINEX Version 2
509 // ----------------------------------
510 else {
511 _out << datTim.toString(" yy MM dd hh mm ").toAscii().data()
512 << setw(10) << setprecision(7) << sec
513 << " " << 0 << setw(3) << dumpList.size();
514
515 QListIterator<t_obs> it(dumpList); int iSat = 0;
516 while (it.hasNext()) {
517 iSat++;
518 const t_obs& obs = it.next();
519 _out << obs.satSys << setw(2) << obs.satNum;
520 if (iSat == 12 && it.hasNext()) {
521 _out << endl << " ";
522 iSat = 0;
523 }
524 }
525 _out << endl;
526 }
527
528 QListIterator<t_obs> it(dumpList);
529 while (it.hasNext()) {
530 const t_obs& obs = it.next();
531
532 // Cycle slips detection
533 // ---------------------
534 QString prn = QString("%1%2").arg(obs.satSys)
535 .arg(obs.satNum, 2, 10, QChar('0'));
536
537 char lli1 = ' ';
538 char lli2 = ' ';
539 char lli5 = ' ';
540 if ( obs.slip_cnt_L1 >= 0 ) {
541 if ( _slip_cnt_L1.find(prn) != _slip_cnt_L1.end() &&
542 _slip_cnt_L1.find(prn).value() != obs.slip_cnt_L1 ) {
543 lli1 = '1';
544 }
545 }
546
547 if ( obs.slip_cnt_L2 >= 0 ) {
548 if ( _slip_cnt_L2.find(prn) != _slip_cnt_L2.end() &&
549 _slip_cnt_L2.find(prn).value() != obs.slip_cnt_L2 ) {
550 lli2 = '1';
551 }
552 }
553
554 if ( obs.slip_cnt_L5 >= 0 ) {
555 if ( _slip_cnt_L5.find(prn) != _slip_cnt_L5.end() &&
556 _slip_cnt_L5.find(prn).value() != obs.slip_cnt_L5 ) {
557 lli5 = '1';
558 }
559 }
560
561 _slip_cnt_L1[prn] = obs.slip_cnt_L1;
562 _slip_cnt_L2[prn] = obs.slip_cnt_L2;
563 _slip_cnt_L5[prn] = obs.slip_cnt_L5;
564
565 // Write the data
566 // --------------
567 _out << rinexSatLine(obs, lli1, lli2, lli5) << endl;
568 }
569
570 _out.flush();
571}
572
573// Close the Old RINEX File
574////////////////////////////////////////////////////////////////////////////
575void bncRinex::closeFile() {
576 if (_header._version == 3) {
577 _out << "> 4 1" << endl;
578 _out << "END OF FILE" << endl;
579 }
580 _out.close();
581 if (!_rnxScriptName.isEmpty()) {
582 qApp->thread()->wait(100);
583#ifdef WIN32
584 QProcess::startDetached(_rnxScriptName, QStringList() << _fName) ;
585#else
586 QProcess::startDetached("nohup", QStringList() << _rnxScriptName << _fName) ;
587#endif
588
589 }
590}
591
592// One Line in RINEX v2 or v3
593////////////////////////////////////////////////////////////////////////////
594string bncRinex::rinexSatLine(const t_obs& obs, char lli1, char lli2,
595 char lli5) {
596 ostringstream str;
597 str.setf(ios::showpoint | ios::fixed);
598
599 if (_header._version >= 3.0) {
600 str << obs.satSys
601 << setw(2) << setfill('0') << obs.satNum << setfill(' ');
602 }
603
604 const QVector<QString>& types = (_header._version > 3.0) ?
605 _header._obsTypesV3[obs.satSys] : _header._obsTypesV2;
606 for (int ii = 0; ii < types.size(); ii++) {
607 if (_header._version < 3.0 && ii > 0 && ii % 5 == 0) {
608 str << endl;
609 }
610 double value = obs.measdata(types[ii], _header._version);
611 str << setw(14) << setprecision(3) << value;
612 if (value != 0.0 && types[ii].indexOf("L1") == 0) {
613 str << lli1 << ' ';
614 }
615 else if (value != 0.0 && types[ii].indexOf("L2") == 0) {
616 str << lli2 << ' ';
617 }
618 else if (value != 0.0 && types[ii].indexOf("L5") == 0) {
619 str << lli5 << ' ';
620 }
621 else {
622 str << " ";
623 }
624 }
625
626 return str.str();
627}
628
629//
630////////////////////////////////////////////////////////////////////////////
631string bncRinex::obsToStr(double val, int width, int precision) {
632 if (val != 0.0) {
633 ostringstream str;
634 str.setf(ios::showpoint | ios::fixed);
635 str << setw(width) << setprecision(precision) << val;
636 return str.str();
637 }
638 else {
639 return "0.0";
640 }
641}
642
643// One Line in ASCII (Internal) Format
644////////////////////////////////////////////////////////////////////////////
645string bncRinex::asciiSatLine(const t_obs& obs) {
646
647 ostringstream str;
648 str.setf(ios::showpoint | ios::fixed);
649
650 str << obs.satSys << setw(2) << setfill('0') << obs.satNum << setfill(' ');
651
652 if (obs.satSys == 'R') { // Glonass
653 str << ' ' << setw(2) << obs.slotNum << ' ';
654 }
655 else {
656 str << " ";
657 }
658
659 float rnxVers = 3.0;
660
661 for (int ie = 0; ie < GNSSENTRY_NUMBER; ie++) {
662 QString rnxStr = obs.rnxStr(ie);
663 if (rnxStr.length() >= 2) {
664 double data = obs.measdata(rnxStr, rnxVers);
665 if (data != 0.0) {
666 int width = (rnxStr[0] == 'S') ? 8 : 14;
667 int prec = 3;
668 str << ' ' << rnxStr.toAscii().data()
669 << ' ' << obsToStr(data, width, prec);
670 if (rnxStr[0] == 'L') {
671 int slipCnt = 0;
672 if (rnxStr[1] == '1') {
673 slipCnt = obs.slip_cnt_L1;
674 }
675 else if (rnxStr[1] == '2') {
676 slipCnt = obs.slip_cnt_L2;
677 }
678 else if (rnxStr[1] == '5') {
679 slipCnt = obs.slip_cnt_L5;
680 }
681 str << ' ' << setw(3) << slipCnt;
682 }
683 }
684 }
685 }
686
687 return str.str();
688}
Note: See TracBrowser for help on using the repository browser.