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

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