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
RevLine 
[3528]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() {
[3529]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 }
[3528]64 bncSettings settings;
[3529]65 if ( !settings.value("rnxPath").toString().isEmpty() ) {
66 _rnx = new bncRinex(staID, mountPoint, latitude, longitude,
67 nmea, ntripVersion);
[3528]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}
[4392]91
92//
93//////////////////////////////////////////////////////////////////////////////
[4403]94void t_obs::setMeasdata(const QString& rnxStr, float rnxVers, double value) {
[4405]95 int ie = iEntry(rnxStr, rnxVers, false);
[4403]96 if (ie != -1) {
97 _measdata[ie] = value;
[4393]98 }
99}
[4392]100
101//
102//////////////////////////////////////////////////////////////////////////////
[4403]103double t_obs::measdata(const QString& rnxStr, float rnxVers) const {
[4405]104 int ie = iEntry(rnxStr, rnxVers, true);
[4403]105 if (ie != -1) {
106 return _measdata[ie];
107 }
108 else {
109 return 0.0;
110 }
111}
[4392]112
[4403]113//
114//////////////////////////////////////////////////////////////////////////////
[4405]115int t_obs::iEntry(const QString& rnxStr, float rnxVers, bool nonEmpty) const {
[4411]116
[4404]117 if (rnxVers >= 3.0) {
118 return iEntryV3(rnxStr);
119 }
[4394]120
[4412]121 if (satSys == 'E') {
122 return iEntryV3(rnxStr);
123 }
124 else {
[4411]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
[4413]130 const QString chars = "PWNCZI ";
[4411]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 }
[4405]137 }
[4404]138 }
139
140 return -1;
141}
142
143//
144//////////////////////////////////////////////////////////////////////////////
145int t_obs::iEntryV3(const QString& rnxStr) const {
146
[4403]147 int retVal = -1;
148
[4397]149 // GPS
150 // ---
[4395]151 if (satSys == 'G') {
[4409]152 if (rnxStr == "C1C") retVal = GNSSENTRY_C1DATA;
[4403]153 else if (rnxStr == "C1P" || rnxStr == "C1W") retVal = GNSSENTRY_P1DATA;
[4409]154 else if (rnxStr == "C1N") retVal = GNSSENTRY_C1NDATA;
[4403]155 else if (rnxStr == "L1C") retVal = GNSSENTRY_L1CDATA;
156 else if (rnxStr == "L1P" || rnxStr == "L1W") retVal = GNSSENTRY_L1PDATA;
[4409]157 else if (rnxStr == "L1N") retVal = GNSSENTRY_L1NDATA;
[4403]158 else if (rnxStr == "D1C") retVal = GNSSENTRY_D1CDATA;
159 else if (rnxStr == "D1P" || rnxStr == "D1W") retVal = GNSSENTRY_D1PDATA;
[4409]160 else if (rnxStr == "D1N") retVal = GNSSENTRY_D1NDATA;
[4403]161 else if (rnxStr == "S1C") retVal = GNSSENTRY_S1CDATA;
162 else if (rnxStr == "S1P" || rnxStr == "S1W") retVal = GNSSENTRY_S1PDATA;
[4409]163 else if (rnxStr == "S1N") retVal = GNSSENTRY_S1NDATA;
[4396]164
[4409]165 else if (rnxStr == "C2C" || rnxStr == "C2X") retVal = GNSSENTRY_C2DATA;
[4403]166 else if (rnxStr == "C2P" || rnxStr == "C2W") retVal = GNSSENTRY_P2DATA;
[4409]167 else if (rnxStr == "L2C" || rnxStr == "L2X") retVal = GNSSENTRY_L2CDATA;
[4403]168 else if (rnxStr == "L2P" || rnxStr == "L2W") retVal = GNSSENTRY_L2PDATA;
[4409]169 else if (rnxStr == "D2C" || rnxStr == "D2X") retVal = GNSSENTRY_D2CDATA;
[4403]170 else if (rnxStr == "D2P" || rnxStr == "D2W") retVal = GNSSENTRY_D2PDATA;
[4409]171 else if (rnxStr == "S2C" || rnxStr == "S2X") retVal = GNSSENTRY_S2CDATA;
[4403]172 else if (rnxStr == "S2P" || rnxStr == "S2W") retVal = GNSSENTRY_S2PDATA;
[4396]173
[4403]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;
[4393]178 }
179
[4397]180 // Glonass
181 // -------
182 else if (satSys == 'R') {
[4403]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;
[4397]191
[4403]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;
[4397]200 }
201
[4398]202 // Galileo
203 // -------
204 else if (satSys == 'E') {
[4403]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;
[4398]209
[4403]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;
[4398]215
[4403]216 else if (rnxStr == "L6") retVal = GNSSENTRY_L6DATA;
217 else if (rnxStr == "D6") retVal = GNSSENTRY_D6DATA;
218 else if (rnxStr == "S6") retVal = GNSSENTRY_S6DATA;
[4398]219
[4403]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;
[4398]224
[4403]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;
[4398]229 }
230
[4399]231 // QZSS
232 // ----
233 else if (satSys == 'J') {
[4409]234 if (rnxStr == "C1N") retVal = GNSSENTRY_C1NDATA;
[4403]235 else if (rnxStr == "C1C") retVal = GNSSENTRY_C1DATA;
236 else if (rnxStr == "C1Z") retVal = GNSSENTRY_CSAIFDATA;
[4409]237 else if (rnxStr == "L1N") retVal = GNSSENTRY_L1NDATA;
[4403]238 else if (rnxStr == "L1C") retVal = GNSSENTRY_L1CDATA;
239 else if (rnxStr == "L1Z") retVal = GNSSENTRY_LSAIFDATA;
[4409]240 else if (rnxStr == "D1N") retVal = GNSSENTRY_D1NDATA;
[4403]241 else if (rnxStr == "D1C") retVal = GNSSENTRY_D1CDATA;
242 else if (rnxStr == "D1Z") retVal = GNSSENTRY_DSAIFDATA;
[4409]243 else if (rnxStr == "S1N") retVal = GNSSENTRY_S1NDATA;
[4403]244 else if (rnxStr == "S1C") retVal = GNSSENTRY_S1CDATA;
245 else if (rnxStr == "S1Z") retVal = GNSSENTRY_SSAIFDATA;
[4399]246
[4403]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;
[4399]251
[4403]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;
[4399]256
[4403]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;
[4399]261 }
262
[4400]263 // SBAS
[4401]264 // ----
[4400]265 else if (satSys == 'S') {
[4403]266 if (rnxStr == "C1C") retVal = GNSSENTRY_C1DATA;
[4410]267 else if (rnxStr == "C1P") retVal = GNSSENTRY_P1DATA;
[4403]268 else if (rnxStr == "L1C") retVal = GNSSENTRY_L1CDATA;
[4410]269 else if (rnxStr == "L1P") retVal = GNSSENTRY_L1PDATA;
[4403]270 else if (rnxStr == "D1C") retVal = GNSSENTRY_D1CDATA;
[4410]271 else if (rnxStr == "D1P") retVal = GNSSENTRY_D1PDATA;
[4403]272 else if (rnxStr == "S1C") retVal = GNSSENTRY_S1CDATA;
[4410]273 else if (rnxStr == "S1P") retVal = GNSSENTRY_S1PDATA;
[4400]274
[4403]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;
[4400]279 }
280
[4401]281 // Compass
282 // -------
283 else if (satSys == 'C') {
[4403]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;
[4401]288
[4403]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;
[4401]293
[4403]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;
[4401]298 }
299
[4403]300 return retVal;
[4392]301}
[4396]302
Note: See TracBrowser for help on using the repository browser.