source: ntrip/trunk/BNC/src/RTCM/GPSDecoder.cpp@ 4414

Last change on this file since 4414 was 4414, checked in by mervart, 12 years ago
File size: 11.5 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: GPSDecoder
30 *
31 * Purpose: Decoder Base Class
32 *
33 * Author: L. Mervart
34 *
35 * Created: 16-Dec-2011
36 *
37 * Changes:
38 *
39 * -----------------------------------------------------------------------*/
40
41#include <iomanip>
42#include <cmath>
43
44#include "GPSDecoder.h"
45#include "bncsettings.h"
46
47using namespace std;
48
49// Constructor
50//////////////////////////////////////////////////////////////////////////////
51GPSDecoder::GPSDecoder() {
52 _rnx = 0;
53}
54
55// Initialize RINEX Writer
56//////////////////////////////////////////////////////////////////////////////
57void GPSDecoder::initRinex(const QByteArray& staID, const QUrl& mountPoint,
58 const QByteArray& latitude,
59 const QByteArray& longitude, const QByteArray& nmea,
60 const QByteArray& ntripVersion) {
61 if (_rnx) {
62 return;
63 }
64 bncSettings settings;
65 if ( !settings.value("rnxPath").toString().isEmpty() ) {
66 _rnx = new bncRinex(staID, mountPoint, latitude, longitude,
67 nmea, ntripVersion);
68 }
69}
70
71// Write RINEX Epoch
72//////////////////////////////////////////////////////////////////////////////
73void GPSDecoder::dumpRinexEpoch(const t_obs& obs, const QByteArray& format) {
74 if (_rnx) {
75 long iSec = long(floor(obs.GPSWeeks+0.5));
76 long obsTime = obs.GPSWeek * 7*24*3600 + iSec;
77 if (_rnx->samplingRate() == 0 || iSec % _rnx->samplingRate() == 0) {
78 _rnx->deepCopy(obs);
79 }
80 _rnx->dumpEpoch(format, obsTime);
81 }
82}
83
84// Set RINEX Reconnect Flag
85//////////////////////////////////////////////////////////////////////////////
86void GPSDecoder::setRinexReconnectFlag(bool flag) {
87 if (_rnx) {
88 _rnx->setReconnectFlag(flag);
89 }
90}
91
92//
93//////////////////////////////////////////////////////////////////////////////
94void t_obs::setMeasdata(const QString& rnxStr, float rnxVers, double value) {
95 int ie = iEntry(rnxStr, rnxVers, false);
96 if (ie != -1) {
97 _measdata[ie] = value;
98 }
99}
100
101//
102//////////////////////////////////////////////////////////////////////////////
103double t_obs::measdata(const QString& rnxStr, float rnxVers) const {
104 int ie = iEntry(rnxStr, rnxVers, true);
105 if (ie != -1) {
106 return _measdata[ie];
107 }
108 else {
109 return 0.0;
110 }
111}
112
113//
114//////////////////////////////////////////////////////////////////////////////
115int t_obs::iEntry(const QString& rnxStr, float rnxVers, bool nonEmpty) const {
116
117 if (rnxVers >= 3.0) {
118 return iEntryV3(rnxStr);
119 }
120
121 if (satSys == 'E') {
122 return iEntryV3(rnxStr);
123 }
124 else {
125 if (rnxStr == "C1") return iEntryV3("C1C");
126 else if (rnxStr == "P1") return iEntryV3("C1P");
127 else if (rnxStr == "C2") return iEntryV3("C2C");
128 else if (rnxStr == "P2") return iEntryV3("C2P");
129
130 const QString chars = "PWNCZI ";
131 for (int ii = 0; ii < chars.length(); ii++) {
132 QString hlpStr = rnxStr + chars[ii];
133 int ie = iEntryV3(hlpStr.trimmed());
134 if (ie != -1 && (!nonEmpty || _measdata[ie] != 0.0)) {
135 return ie;
136 }
137 }
138 }
139
140 return -1;
141}
142
143//
144//////////////////////////////////////////////////////////////////////////////
145int t_obs::iEntryV3(const QString& rnxStr) const {
146
147 int retVal = -1;
148
149 // GPS
150 // ---
151 if (satSys == 'G') {
152 if (rnxStr.indexOf(QRegExp("C1[CSLX]")) == 0) retVal = GNSSENTRY_C1DATA;
153 else if (rnxStr.indexOf("C1") == 0) retVal = GNSSENTRY_P1DATA;
154 else if (rnxStr.indexOf(QRegExp("L1[CSLX]")) == 0) retVal = GNSSENTRY_L1CDATA;
155 else if (rnxStr.indexOf("L1") == 0) retVal = GNSSENTRY_L1PDATA;
156 else if (rnxStr.indexOf(QRegExp("D1[CSLX]")) == 0) retVal = GNSSENTRY_D1CDATA;
157 else if (rnxStr.indexOf("D1") == 0) retVal = GNSSENTRY_D1PDATA;
158 else if (rnxStr.indexOf(QRegExp("S1[CSLX]")) == 0) retVal = GNSSENTRY_S1CDATA;
159 else if (rnxStr.indexOf("S1") == 0) retVal = GNSSENTRY_S1PDATA;
160
161 else if (rnxStr.indexOf(QRegExp("C2[CSLX]")) == 0) retVal = GNSSENTRY_C2DATA;
162 else if (rnxStr.indexOf("C2") == 0) retVal = GNSSENTRY_P2DATA;
163 else if (rnxStr.indexOf(QRegExp("L2[CSLX]")) == 0) retVal = GNSSENTRY_L2CDATA;
164 else if (rnxStr.indexOf("L2") == 0) retVal = GNSSENTRY_L2PDATA;
165 else if (rnxStr.indexOf(QRegExp("D2[CSLX]")) == 0) retVal = GNSSENTRY_D2CDATA;
166 else if (rnxStr.indexOf("D2") == 0) retVal = GNSSENTRY_D2PDATA;
167 else if (rnxStr.indexOf(QRegExp("S2[CSLX]")) == 0) retVal = GNSSENTRY_S2CDATA;
168 else if (rnxStr.indexOf("S2") == 0) retVal = GNSSENTRY_S2PDATA;
169
170 else if (rnxStr.indexOf("C5") == 0) retVal = GNSSENTRY_C5DATA;
171 else if (rnxStr.indexOf("D5") == 0) retVal = GNSSENTRY_D5DATA;
172 else if (rnxStr.indexOf("L5") == 0) retVal = GNSSENTRY_L5DATA;
173 else if (rnxStr.indexOf("S5") == 0) retVal = GNSSENTRY_S5DATA;
174 }
175
176 // Glonass
177 // -------
178 else if (satSys == 'R') {
179 if (rnxStr == "C1C") retVal = GNSSENTRY_C1DATA;
180 else if (rnxStr.indexOf("C1") == 0) retVal = GNSSENTRY_P1DATA;
181 else if (rnxStr == "L1C") retVal = GNSSENTRY_L1CDATA;
182 else if (rnxStr.indexOf("L1") == 0) retVal = GNSSENTRY_L1PDATA;
183 else if (rnxStr == "D1C") retVal = GNSSENTRY_D1CDATA;
184 else if (rnxStr.indexOf("D1") == 0) retVal = GNSSENTRY_D1PDATA;
185 else if (rnxStr == "S1C") retVal = GNSSENTRY_S1CDATA;
186 else if (rnxStr.indexOf("S1") == 0) retVal = GNSSENTRY_S1PDATA;
187
188 else if (rnxStr == "C2C") retVal = GNSSENTRY_C2DATA;
189 else if (rnxStr.indexOf("C2") == 0) retVal = GNSSENTRY_P2DATA;
190 else if (rnxStr == "L2C") retVal = GNSSENTRY_L2CDATA;
191 else if (rnxStr.indexOf("L2") == 0) retVal = GNSSENTRY_L2PDATA;
192 else if (rnxStr == "D2C") retVal = GNSSENTRY_D2CDATA;
193 else if (rnxStr.indexOf("D2") == 0) retVal = GNSSENTRY_D2PDATA;
194 else if (rnxStr == "S2C") retVal = GNSSENTRY_S2CDATA;
195 else if (rnxStr.indexOf("S2") == 0) retVal = GNSSENTRY_S2PDATA;
196 }
197
198 // Galileo
199 // -------
200 else if (satSys == 'E') {
201 if (rnxStr.indexOf("C1") == 0) retVal = GNSSENTRY_C1DATA;
202 else if (rnxStr.indexOf("L1") == 0) retVal = GNSSENTRY_L1CDATA;
203 else if (rnxStr.indexOf("D1") == 0) retVal = GNSSENTRY_D1CDATA;
204 else if (rnxStr.indexOf("S1") == 0) retVal = GNSSENTRY_S1CDATA;
205
206 else if (rnxStr.indexOf("C5") == 0) retVal = GNSSENTRY_C5DATA;
207 else if (rnxStr.indexOf("L5") == 0) retVal = GNSSENTRY_L5DATA;
208 else if (rnxStr.indexOf("D5") == 0) retVal = GNSSENTRY_D5DATA;
209 else if (rnxStr.indexOf("S5") == 0) retVal = GNSSENTRY_S5DATA;
210
211 else if (rnxStr.indexOf("C6") == 0) retVal = GNSSENTRY_C6DATA;
212 else if (rnxStr.indexOf("L6") == 0) retVal = GNSSENTRY_L6DATA;
213 else if (rnxStr.indexOf("D6") == 0) retVal = GNSSENTRY_D6DATA;
214 else if (rnxStr.indexOf("S6") == 0) retVal = GNSSENTRY_S6DATA;
215
216 else if (rnxStr.indexOf("C7") == 0) retVal = GNSSENTRY_C5BDATA;
217 else if (rnxStr.indexOf("L7") == 0) retVal = GNSSENTRY_L5BDATA;
218 else if (rnxStr.indexOf("D7") == 0) retVal = GNSSENTRY_D5BDATA;
219 else if (rnxStr.indexOf("S7") == 0) retVal = GNSSENTRY_S5BDATA;
220
221 else if (rnxStr.indexOf("C8") == 0) retVal = GNSSENTRY_C5ABDATA;
222 else if (rnxStr.indexOf("L8") == 0) retVal = GNSSENTRY_L5ABDATA;
223 else if (rnxStr.indexOf("D8") == 0) retVal = GNSSENTRY_D5ABDATA;
224 else if (rnxStr.indexOf("S8") == 0) retVal = GNSSENTRY_S5ABDATA;
225 }
226
227 // QZSS
228 // ----
229 else if (satSys == 'J') {
230 if (rnxStr.indexOf("C1") == 0) retVal = GNSSENTRY_C1DATA;
231 else if (rnxStr.indexOf("L1") == 0) retVal = GNSSENTRY_L1CDATA;
232 else if (rnxStr.indexOf("D1") == 0) retVal = GNSSENTRY_D1CDATA;
233 else if (rnxStr.indexOf("S1") == 0) retVal = GNSSENTRY_S1CDATA;
234
235 else if (rnxStr.indexOf("C2") == 0) retVal = GNSSENTRY_C5BDATA;
236 else if (rnxStr.indexOf("L2") == 0) retVal = GNSSENTRY_L5BDATA;
237 else if (rnxStr.indexOf("D2") == 0) retVal = GNSSENTRY_D5BDATA;
238 else if (rnxStr.indexOf("S2") == 0) retVal = GNSSENTRY_S5BDATA;
239
240 else if (rnxStr.indexOf("C5") == 0) retVal = GNSSENTRY_C5DATA;
241 else if (rnxStr.indexOf("L5") == 0) retVal = GNSSENTRY_L5DATA;
242 else if (rnxStr.indexOf("D5") == 0) retVal = GNSSENTRY_D5DATA;
243 else if (rnxStr.indexOf("S5") == 0) retVal = GNSSENTRY_S5DATA;
244
245 else if (rnxStr.indexOf("C6") == 0) retVal = GNSSENTRY_C6DATA;
246 else if (rnxStr.indexOf("L6") == 0) retVal = GNSSENTRY_L6DATA;
247 else if (rnxStr.indexOf("D6") == 0) retVal = GNSSENTRY_D6DATA;
248 else if (rnxStr.indexOf("S6") == 0) retVal = GNSSENTRY_S6DATA;
249 }
250
251 // SBAS
252 // ----
253 else if (satSys == 'S') {
254 if (rnxStr == "C1C") retVal = GNSSENTRY_C1DATA;
255 else if (rnxStr.indexOf("C1") == 0) retVal = GNSSENTRY_P1DATA;
256 else if (rnxStr == "L1C") retVal = GNSSENTRY_L1CDATA;
257 else if (rnxStr.indexOf("L1") == 0) retVal = GNSSENTRY_L1PDATA;
258 else if (rnxStr == "D1C") retVal = GNSSENTRY_D1CDATA;
259 else if (rnxStr.indexOf("D1") == 0) retVal = GNSSENTRY_D1PDATA;
260 else if (rnxStr == "S1C") retVal = GNSSENTRY_S1CDATA;
261 else if (rnxStr.indexOf("S1") == 0) retVal = GNSSENTRY_S1PDATA;
262
263 else if (rnxStr.indexOf("C5") == 0) retVal = GNSSENTRY_C5DATA;
264 else if (rnxStr.indexOf("L5") == 0) retVal = GNSSENTRY_L5DATA;
265 else if (rnxStr.indexOf("D5") == 0) retVal = GNSSENTRY_D5DATA;
266 else if (rnxStr.indexOf("S5") == 0) retVal = GNSSENTRY_S5DATA;
267 }
268
269 // Compass
270 // -------
271 else if (satSys == 'C') {
272 if (rnxStr.indexOf("C2") == 0) retVal = GNSSENTRY_CB1DATA;
273 else if (rnxStr.indexOf("L2") == 0) retVal = GNSSENTRY_LB1DATA;
274 else if (rnxStr.indexOf("D2") == 0) retVal = GNSSENTRY_DB1DATA;
275 else if (rnxStr.indexOf("S2") == 0) retVal = GNSSENTRY_SB1DATA;
276
277 else if (rnxStr.indexOf("C6") == 0) retVal = GNSSENTRY_CB3DATA;
278 else if (rnxStr.indexOf("L6") == 0) retVal = GNSSENTRY_LB3DATA;
279 else if (rnxStr.indexOf("D6") == 0) retVal = GNSSENTRY_DB3DATA;
280 else if (rnxStr.indexOf("S6") == 0) retVal = GNSSENTRY_SB3DATA;
281
282 else if (rnxStr.indexOf("C7") == 0) retVal = GNSSENTRY_CB2DATA;
283 else if (rnxStr.indexOf("L7") == 0) retVal = GNSSENTRY_LB2DATA;
284 else if (rnxStr.indexOf("D7") == 0) retVal = GNSSENTRY_DB2DATA;
285 else if (rnxStr.indexOf("S7") == 0) retVal = GNSSENTRY_SB2DATA;
286 }
287
288 return retVal;
289}
290
Note: See TracBrowser for help on using the repository browser.