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

Last change on this file since 4413 was 4413, checked in by mervart, 12 years ago
File size: 11.4 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 == "C1C") retVal = GNSSENTRY_C1DATA;
153 else if (rnxStr == "C1P" || rnxStr == "C1W") retVal = GNSSENTRY_P1DATA;
154 else if (rnxStr == "C1N") retVal = GNSSENTRY_C1NDATA;
155 else if (rnxStr == "L1C") retVal = GNSSENTRY_L1CDATA;
156 else if (rnxStr == "L1P" || rnxStr == "L1W") retVal = GNSSENTRY_L1PDATA;
157 else if (rnxStr == "L1N") retVal = GNSSENTRY_L1NDATA;
158 else if (rnxStr == "D1C") retVal = GNSSENTRY_D1CDATA;
159 else if (rnxStr == "D1P" || rnxStr == "D1W") retVal = GNSSENTRY_D1PDATA;
160 else if (rnxStr == "D1N") retVal = GNSSENTRY_D1NDATA;
161 else if (rnxStr == "S1C") retVal = GNSSENTRY_S1CDATA;
162 else if (rnxStr == "S1P" || rnxStr == "S1W") retVal = GNSSENTRY_S1PDATA;
163 else if (rnxStr == "S1N") retVal = GNSSENTRY_S1NDATA;
164
165 else if (rnxStr == "C2C" || rnxStr == "C2X") retVal = GNSSENTRY_C2DATA;
166 else if (rnxStr == "C2P" || rnxStr == "C2W") retVal = GNSSENTRY_P2DATA;
167 else if (rnxStr == "L2C" || rnxStr == "L2X") retVal = GNSSENTRY_L2CDATA;
168 else if (rnxStr == "L2P" || rnxStr == "L2W") retVal = GNSSENTRY_L2PDATA;
169 else if (rnxStr == "D2C" || rnxStr == "D2X") retVal = GNSSENTRY_D2CDATA;
170 else if (rnxStr == "D2P" || rnxStr == "D2W") retVal = GNSSENTRY_D2PDATA;
171 else if (rnxStr == "S2C" || rnxStr == "S2X") retVal = GNSSENTRY_S2CDATA;
172 else if (rnxStr == "S2P" || rnxStr == "S2W") retVal = GNSSENTRY_S2PDATA;
173
174 else if (rnxStr == "C5") retVal = GNSSENTRY_C5DATA;
175 else if (rnxStr == "D5") retVal = GNSSENTRY_D5DATA;
176 else if (rnxStr == "L5") retVal = GNSSENTRY_L5DATA;
177 else if (rnxStr == "S5") retVal = GNSSENTRY_S5DATA;
178 }
179
180 // Glonass
181 // -------
182 else if (satSys == 'R') {
183 if (rnxStr == "C1C") retVal = GNSSENTRY_C1DATA;
184 else if (rnxStr == "C1P") retVal = GNSSENTRY_P1DATA;
185 else if (rnxStr == "L1C") retVal = GNSSENTRY_L1CDATA;
186 else if (rnxStr == "L1P") retVal = GNSSENTRY_L1PDATA;
187 else if (rnxStr == "D1C") retVal = GNSSENTRY_D1CDATA;
188 else if (rnxStr == "D1P") retVal = GNSSENTRY_D1PDATA;
189 else if (rnxStr == "S1C") retVal = GNSSENTRY_S1CDATA;
190 else if (rnxStr == "S1P") retVal = GNSSENTRY_S1PDATA;
191
192 else if (rnxStr == "C2C") retVal = GNSSENTRY_C2DATA;
193 else if (rnxStr == "C2P") retVal = GNSSENTRY_P2DATA;
194 else if (rnxStr == "L2C") retVal = GNSSENTRY_L2CDATA;
195 else if (rnxStr == "L2P") retVal = GNSSENTRY_L2PDATA;
196 else if (rnxStr == "D2C") retVal = GNSSENTRY_D2CDATA;
197 else if (rnxStr == "D2P") retVal = GNSSENTRY_D2PDATA;
198 else if (rnxStr == "S2C") retVal = GNSSENTRY_S2CDATA;
199 else if (rnxStr == "S2P") retVal = GNSSENTRY_S2PDATA;
200 }
201
202 // Galileo
203 // -------
204 else if (satSys == 'E') {
205 if (rnxStr == "C1") retVal = GNSSENTRY_C1DATA;
206 else if (rnxStr == "L1") retVal = GNSSENTRY_L1CDATA;
207 else if (rnxStr == "D1") retVal = GNSSENTRY_D1CDATA;
208 else if (rnxStr == "S1") retVal = GNSSENTRY_S1CDATA;
209
210 else if (rnxStr == "C5") retVal = GNSSENTRY_C5DATA;
211 else if (rnxStr == "L5") retVal = GNSSENTRY_L5DATA;
212 else if (rnxStr == "D5") retVal = GNSSENTRY_D5DATA;
213 else if (rnxStr == "S5") retVal = GNSSENTRY_S5DATA;
214 else if (rnxStr == "C6") retVal = GNSSENTRY_C6DATA;
215
216 else if (rnxStr == "L6") retVal = GNSSENTRY_L6DATA;
217 else if (rnxStr == "D6") retVal = GNSSENTRY_D6DATA;
218 else if (rnxStr == "S6") retVal = GNSSENTRY_S6DATA;
219
220 else if (rnxStr == "C7") retVal = GNSSENTRY_C5BDATA;
221 else if (rnxStr == "L7") retVal = GNSSENTRY_L5BDATA;
222 else if (rnxStr == "D7") retVal = GNSSENTRY_D5BDATA;
223 else if (rnxStr == "S7") retVal = GNSSENTRY_S5BDATA;
224
225 else if (rnxStr == "C8") retVal = GNSSENTRY_C5ABDATA;
226 else if (rnxStr == "L8") retVal = GNSSENTRY_L5ABDATA;
227 else if (rnxStr == "D8") retVal = GNSSENTRY_D5ABDATA;
228 else if (rnxStr == "S8") retVal = GNSSENTRY_S5ABDATA;
229 }
230
231 // QZSS
232 // ----
233 else if (satSys == 'J') {
234 if (rnxStr == "C1N") retVal = GNSSENTRY_C1NDATA;
235 else if (rnxStr == "C1C") retVal = GNSSENTRY_C1DATA;
236 else if (rnxStr == "C1Z") retVal = GNSSENTRY_CSAIFDATA;
237 else if (rnxStr == "L1N") retVal = GNSSENTRY_L1NDATA;
238 else if (rnxStr == "L1C") retVal = GNSSENTRY_L1CDATA;
239 else if (rnxStr == "L1Z") retVal = GNSSENTRY_LSAIFDATA;
240 else if (rnxStr == "D1N") retVal = GNSSENTRY_D1NDATA;
241 else if (rnxStr == "D1C") retVal = GNSSENTRY_D1CDATA;
242 else if (rnxStr == "D1Z") retVal = GNSSENTRY_DSAIFDATA;
243 else if (rnxStr == "S1N") retVal = GNSSENTRY_S1NDATA;
244 else if (rnxStr == "S1C") retVal = GNSSENTRY_S1CDATA;
245 else if (rnxStr == "S1Z") retVal = GNSSENTRY_SSAIFDATA;
246
247 else if (rnxStr == "C2" ) retVal = GNSSENTRY_C2DATA;
248 else if (rnxStr == "L2" ) retVal = GNSSENTRY_L2CDATA;
249 else if (rnxStr == "D2" ) retVal = GNSSENTRY_D2CDATA;
250 else if (rnxStr == "S2" ) retVal = GNSSENTRY_S2CDATA;
251
252 else if (rnxStr == "C5" ) retVal = GNSSENTRY_C5DATA;
253 else if (rnxStr == "L5" ) retVal = GNSSENTRY_L5DATA;
254 else if (rnxStr == "D5" ) retVal = GNSSENTRY_D5DATA;
255 else if (rnxStr == "S5" ) retVal = GNSSENTRY_S5DATA;
256
257 else if (rnxStr == "C6" ) retVal = GNSSENTRY_C6DATA;
258 else if (rnxStr == "D6" ) retVal = GNSSENTRY_D6DATA;
259 else if (rnxStr == "L6" ) retVal = GNSSENTRY_L6DATA;
260 else if (rnxStr == "S6" ) retVal = GNSSENTRY_S6DATA;
261 }
262
263 // SBAS
264 // ----
265 else if (satSys == 'S') {
266 if (rnxStr == "C1C") retVal = GNSSENTRY_C1DATA;
267 else if (rnxStr == "C1P") retVal = GNSSENTRY_P1DATA;
268 else if (rnxStr == "L1C") retVal = GNSSENTRY_L1CDATA;
269 else if (rnxStr == "L1P") retVal = GNSSENTRY_L1PDATA;
270 else if (rnxStr == "D1C") retVal = GNSSENTRY_D1CDATA;
271 else if (rnxStr == "D1P") retVal = GNSSENTRY_D1PDATA;
272 else if (rnxStr == "S1C") retVal = GNSSENTRY_S1CDATA;
273 else if (rnxStr == "S1P") retVal = GNSSENTRY_S1PDATA;
274
275 else if (rnxStr == "C5" ) retVal = GNSSENTRY_C5DATA;
276 else if (rnxStr == "L5" ) retVal = GNSSENTRY_L5DATA;
277 else if (rnxStr == "D5" ) retVal = GNSSENTRY_D5DATA;
278 else if (rnxStr == "S5" ) retVal = GNSSENTRY_S5DATA;
279 }
280
281 // Compass
282 // -------
283 else if (satSys == 'C') {
284 if (rnxStr == "C2I") retVal = GNSSENTRY_CB1DATA;
285 else if (rnxStr == "L2I") retVal = GNSSENTRY_LB1DATA;
286 else if (rnxStr == "D2I") retVal = GNSSENTRY_DB1DATA;
287 else if (rnxStr == "S2I") retVal = GNSSENTRY_SB1DATA;
288
289 else if (rnxStr == "C6I") retVal = GNSSENTRY_CB3DATA;
290 else if (rnxStr == "L6I") retVal = GNSSENTRY_LB3DATA;
291 else if (rnxStr == "D6I") retVal = GNSSENTRY_DB3DATA;
292 else if (rnxStr == "S6I") retVal = GNSSENTRY_SB3DATA;
293
294 else if (rnxStr == "C7I") retVal = GNSSENTRY_CB2DATA;
295 else if (rnxStr == "L7I") retVal = GNSSENTRY_LB2DATA;
296 else if (rnxStr == "D7I") retVal = GNSSENTRY_DB2DATA;
297 else if (rnxStr == "S7I") retVal = GNSSENTRY_SB2DATA;
298 }
299
300 return retVal;
301}
302
Note: See TracBrowser for help on using the repository browser.