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

Last change on this file since 5368 was 5368, checked in by mervart, 9 years ago
File size: 5.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
47extern "C" {
48#include "rtcm3torinex.h"
49}
50
51using namespace std;
52
53// Constructor
54//////////////////////////////////////////////////////////////////////////////
55GPSDecoder::GPSDecoder() {
56 _rnx = 0;
57}
58
59// Initialize RINEX Writer
60//////////////////////////////////////////////////////////////////////////////
61void GPSDecoder::initRinex(const QByteArray& staID, const QUrl& mountPoint,
62 const QByteArray& latitude,
63 const QByteArray& longitude, const QByteArray& nmea,
64 const QByteArray& ntripVersion) {
65 if (_rnx) {
66 return;
67 }
68 bncSettings settings;
69 if ( !settings.value("rnxPath").toString().isEmpty() ) {
70 _rnx = new bncRinex(staID, mountPoint, latitude, longitude,
71 nmea, ntripVersion);
72 }
73}
74
75// Write RINEX Epoch
76//////////////////////////////////////////////////////////////////////////////
77void GPSDecoder::dumpRinexEpoch(const t_obs& obs, const QByteArray& format) {
78 if (_rnx) {
79 long iSec = long(floor(obs.GPSWeeks+0.5));
80 long obsTime = obs.GPSWeek * 7*24*3600 + iSec;
81 if (_rnx->samplingRate() == 0 || iSec % _rnx->samplingRate() == 0) {
82 _rnx->deepCopy(obs);
83 }
84 _rnx->dumpEpoch(format, obsTime);
85 }
86}
87
88// Set RINEX Reconnect Flag
89//////////////////////////////////////////////////////////////////////////////
90void GPSDecoder::setRinexReconnectFlag(bool flag) {
91 if (_rnx) {
92 _rnx->setReconnectFlag(flag);
93 }
94}
95
96//
97//////////////////////////////////////////////////////////////////////////////
98void t_obs::setMeasdata(QString rnxStr, float rnxVers, double value) {
99
100 if (rnxVers < 3.0) {
101 if (rnxStr == "C1") rnxStr = "C1C";
102 else if (rnxStr == "P1") rnxStr = "C1P";
103 else if (rnxStr == "C2") rnxStr = "C2C";
104 else if (rnxStr == "P2") rnxStr = "C2P";
105 }
106
107 int ie = iEntry(rnxStr, rnxVers);
108
109 if (ie != -1) {
110 _codetype[ie] = rnxStr.mid(1);
111 _measdata[ie] = value;
112 }
113}
114
115//
116//////////////////////////////////////////////////////////////////////////////
117double t_obs::measdata(const QString& rnxStr, float rnxVers) const {
118 int ie = iEntry(rnxStr, rnxVers);
119 if (ie != -1) {
120 return _measdata[ie];
121 }
122 else {
123 return 0.0;
124 }
125}
126
127//
128//////////////////////////////////////////////////////////////////////////////
129int t_obs::iEntry(QString rnxStr, float rnxVers) const {
130 if (rnxVers < 3.0) {
131 if (rnxStr == "C1") rnxStr = "C1C";
132 else if (rnxStr == "P1") rnxStr = "C1P";
133 else if (rnxStr == "C2") rnxStr = "C2C";
134 else if (rnxStr == "P2") rnxStr = "C2P";
135 }
136 int res = 0;
137 switch(rnxStr[0].toAscii())
138 {
139 case 'C': res += GNSSENTRY_CODE; break;
140 case 'L': res += GNSSENTRY_PHASE; break;
141 case 'D': res += GNSSENTRY_DOPPLER; break;
142 case 'S': res += GNSSENTRY_SNR; break;
143 default:
144 return -1;
145 }
146 switch(rnxStr[1].toAscii())
147 {
148 case '1':
149 switch(rnxStr[2].toAscii())
150 {
151 default:
152 case 'C': res += GNSSENTRY_TYPEC1; break;
153 case 'P': case'W': case 'Y': res += GNSSENTRY_TYPEP1; break;
154 case 'A': case'B':
155 case 'S': case'L': case 'X': res += GNSSENTRY_TYPEC1; break;
156 case 'Z': res += GNSSENTRY_TYPECSAIF; break;
157 }
158 break;
159 case '2':
160 switch(rnxStr[2].toAscii())
161 {
162 default:
163 case 'P': case 'W': case 'Y': res += GNSSENTRY_TYPEP2; break;
164 case 'C': case 'S': case 'L': case 'X': res += GNSSENTRY_TYPEC2; break;
165 case 'I': res += GNSSENTRY_TYPEC5B; break;
166 }
167 break;
168 case '5':
169 res += GNSSENTRY_TYPEC5;
170 break;
171 case '6':
172 res += GNSSENTRY_TYPEC6;
173 break;
174 case '7':
175 res += GNSSENTRY_TYPEC5B;
176 break;
177 case '8':
178 res += GNSSENTRY_TYPEC5AB;
179 break;
180 }
181 return res;
182}
183
184//
185//////////////////////////////////////////////////////////////////////////////
186QString t_obs::rnxStr(int iEntry) const {
187 QString str(3,' ');
188 switch(iEntry & 3) {
189 case GNSSENTRY_CODE: str[0] = 'C'; break;
190 case GNSSENTRY_PHASE: str[0] = 'L'; break;
191 case GNSSENTRY_DOPPLER: str[0] = 'D'; break;
192 case GNSSENTRY_SNR: str[0] = 'S'; break;
193 }
194 str += _codetype[iEntry];
195 return str.trimmed();
196}
Note: See TracBrowser for help on using the repository browser.