source: ntrip/trunk/BNC/src/rinex/rnxnavfile.cpp@ 5776

Last change on this file since 5776 was 5776, checked in by mervart, 10 years ago
File size: 8.1 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: t_rnxNavFile
30 *
31 * Purpose: Reads RINEX Navigation File
32 *
33 * Author: L. Mervart
34 *
35 * Created: 24-Jan-2012
36 *
37 * Changes:
38 *
39 * -----------------------------------------------------------------------*/
40
41#include <iostream>
42#include <newmatio.h>
43#include "rnxnavfile.h"
44#include "bnccore.h"
45#include "bncutils.h"
46#include "ephemeris.h"
47
48using namespace std;
49
50// Constructor
51////////////////////////////////////////////////////////////////////////////
52t_rnxNavFile::t_rnxNavHeader::t_rnxNavHeader() {
53 _version = 0.0;
54 _glonass = false;
55}
56
57// Destructor
58////////////////////////////////////////////////////////////////////////////
59t_rnxNavFile::t_rnxNavHeader::~t_rnxNavHeader() {
60}
61
62// Read Header
63////////////////////////////////////////////////////////////////////////////
64t_irc t_rnxNavFile::t_rnxNavHeader::read(QTextStream* stream) {
65 while (stream->status() == QTextStream::Ok && !stream->atEnd()) {
66 QString line = stream->readLine();
67 if (line.isEmpty()) {
68 continue;
69 }
70 QString value = line.left(60).trimmed();
71 QString key = line.mid(60).trimmed();
72 if (key == "END OF HEADER") {
73 break;
74 }
75 else if (key == "RINEX VERSION / TYPE") {
76 QTextStream in(value.toAscii(), QIODevice::ReadOnly);
77 in >> _version;
78 if (value.indexOf("GLONASS") != -1) {
79 _glonass = true;
80 }
81 }
82 }
83
84 return success;
85}
86
87// Constructor
88////////////////////////////////////////////////////////////////////////////
89t_rnxNavFile::t_rnxNavFile(const QString& fileName, e_inpOut inpOut) {
90 _inpOut = inpOut;
91 _stream = 0;
92 _file = 0;
93 if (_inpOut == input) {
94 openRead(fileName);
95 }
96 else {
97 openWrite(fileName);
98 }
99}
100
101// Open for input
102////////////////////////////////////////////////////////////////////////////
103void t_rnxNavFile::openRead(const QString& fileName) {
104
105 _fileName = fileName; expandEnvVar(_fileName);
106 _file = new QFile(_fileName);
107 _file->open(QIODevice::ReadOnly | QIODevice::Text);
108 _stream = new QTextStream();
109 _stream->setDevice(_file);
110
111 _header.read(_stream);
112 this->read(_stream);
113}
114
115// Open for output
116////////////////////////////////////////////////////////////////////////////
117void t_rnxNavFile::openWrite(const QString& fileName) {
118
119 _fileName = fileName; expandEnvVar(_fileName);
120 _file = new QFile(_fileName);
121 _file->open(QIODevice::WriteOnly | QIODevice::Text);
122 _stream = new QTextStream();
123 _stream->setDevice(_file);
124}
125
126// Destructor
127////////////////////////////////////////////////////////////////////////////
128t_rnxNavFile::~t_rnxNavFile() {
129 close();
130 for (unsigned ii = 0; ii < _ephs.size(); ii++) {
131 delete _ephs[ii];
132 }
133}
134
135// Close
136////////////////////////////////////////////////////////////////////////////
137void t_rnxNavFile::close() {
138 delete _stream; _stream = 0;
139 delete _file; _file = 0;
140}
141
142// Read File Content
143////////////////////////////////////////////////////////////////////////////
144void t_rnxNavFile::read(QTextStream* stream) {
145
146 while (stream->status() == QTextStream::Ok && !stream->atEnd()) {
147 QString line = stream->readLine();
148 if (line.isEmpty()) {
149 continue;
150 }
151 QStringList hlp = line.split(QRegExp("\\s+"), QString::SkipEmptyParts);
152 QString prn;
153 if (version() >= 3.0) {
154 prn = hlp.at(0);
155 }
156 else {
157 if (glonass()) {
158 prn = QString("R%1").arg(hlp.at(0).toInt(), 2, 10, QChar('0'));
159 }
160 else {
161 prn = QString("G%1").arg(hlp.at(0).toInt(), 2, 10, QChar('0'));
162 }
163 }
164 t_eph* eph = 0;
165 QStringList lines; lines << line;
166 if (prn[0] == 'G') {
167 for (int ii = 1; ii < 8; ii++) {
168 lines << stream->readLine();
169 }
170 eph = new t_ephGPS(version(), lines);
171 }
172 else if (prn[0] == 'R') {
173 for (int ii = 1; ii < 4; ii++) {
174 lines << stream->readLine();
175 }
176 eph = new t_ephGlo(version(), lines);
177 }
178 else if (prn[0] == 'E') {
179 for (int ii = 1; ii < 8; ii++) {
180 lines << stream->readLine();
181 }
182 eph = new t_ephGal(version(), lines);
183 }
184 if (eph && eph->ok()) {
185 _ephs.push_back(eph);
186 }
187 else {
188 delete eph;
189 }
190 }
191}
192
193// Read Next Ephemeris
194////////////////////////////////////////////////////////////////////////////
195t_eph* t_rnxNavFile::getNextEph(const bncTime& tt,
196 const QMap<QString, int>* corrIODs) {
197
198 // Get Ephemeris according to IOD
199 // ------------------------------
200 if (corrIODs) {
201 QMapIterator<QString, int> itIOD(*corrIODs);
202 while (itIOD.hasNext()) {
203 itIOD.next();
204 QString prn = itIOD.key();
205 int iod = itIOD.value();
206 vector<t_eph*>::iterator it = _ephs.begin();
207 while (it != _ephs.end()) {
208 t_eph* eph = *it;
209 double dt = eph->TOC() - tt;
210 if (dt < 8*3600.0 && QString(eph->prn().toString().c_str()) == prn && eph->IOD() == iod) {
211 it = _ephs.erase(it);
212 return eph;
213 }
214 ++it;
215 }
216 }
217 }
218
219 // Get Ephemeris according to time
220 // -------------------------------
221 else {
222 vector<t_eph*>::iterator it = _ephs.begin();
223 while (it != _ephs.end()) {
224 t_eph* eph = *it;
225
226 double dt = eph->TOC() - tt;
227
228 if (dt < 2*3600.0) {
229 it = _ephs.erase(it);
230 return eph;
231 }
232 ++it;
233 }
234 }
235
236 return 0;
237}
238
239//
240////////////////////////////////////////////////////////////////////////////
241void t_rnxNavFile::writeHeader(const QMap<QString, QString>* txtMap) {
242
243 QString runBy = BNC_CORE->userName();
244 QStringList comments;
245
246 if (txtMap) {
247 QMapIterator<QString, QString> it(*txtMap);
248 while (it.hasNext()) {
249 it.next();
250 if (it.key() == "RUN BY") {
251 runBy = it.value();
252 }
253 else if (it.key() == "COMMENT") {
254 comments = it.value().split("\\n", QString::SkipEmptyParts);
255 }
256 }
257 }
258
259 if (version() < 3.0) {
260 const QString fmt = glonass() ? "%1 GLONASS navigation data"
261 : "%1 Navigation data";
262 *_stream << QString(fmt)
263 .arg(_header._version, 9, 'f', 2)
264 .leftJustified(60)
265 << "RINEX VERSION / TYPE\n";
266 }
267 else {
268 *_stream << QString("%1 Navigation data Mixed")
269 .arg(_header._version, 9, 'f', 2)
270 .leftJustified(60)
271 << "RINEX VERSION / TYPE\n";
272 }
273
274 const QString fmtDate = (version() < 3.0) ? "dd-MMM-yy hh:mm"
275 : "yyyyMMdd hhmmss UTC";
276 *_stream << QString("%1%2%3")
277 .arg(BNC_CORE->pgmName(), -20)
278 .arg(runBy.trimmed().left(20), -20)
279 .arg(QDateTime::currentDateTime().toUTC().toString(fmtDate), -20)
280 .leftJustified(60)
281 << "PGM / RUN BY / DATE\n";
282
283 QStringListIterator itCmnt(comments);
284 while (itCmnt.hasNext()) {
285 *_stream << itCmnt.next().trimmed().left(60).leftJustified(60) << "COMMENT\n";
286 }
287
288 *_stream << QString()
289 .leftJustified(60)
290 << "END OF HEADER\n";
291}
292
293//
294////////////////////////////////////////////////////////////////////////////
295void t_rnxNavFile::writeEph(const t_eph* eph) {
296 *_stream << eph->toString(version());
297}
Note: See TracBrowser for help on using the repository browser.