source: ntrip/trunk/BNC/RTCM3/RTCM3coDecoder.cpp@ 1049

Last change on this file since 1049 was 1035, checked in by weber, 16 years ago

* empty log message *

File size: 6.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: RTCM3coDecoder
30 *
31 * Purpose: RTCM3 Clock Orbit Decoder
32 *
33 * Author: L. Mervart
34 *
35 * Created: 05-May-2008
36 *
37 * Changes:
38 *
39 * -----------------------------------------------------------------------*/
40
41#include <stdio.h>
42#include <math.h>
43
44#include "RTCM3coDecoder.h"
45#include "bncutils.h"
46#include "bncrinex.h"
47#include "bncapp.h"
48
49using namespace std;
50
51// Constructor
52////////////////////////////////////////////////////////////////////////////
53RTCM3coDecoder::RTCM3coDecoder(const QString& staID) {
54
55 _staID = staID;
56
57 // File Output
58 // -----------
59 QSettings settings;
60 QString path = settings.value("corrPath").toString();
61 if (!path.isEmpty()) {
62 expandEnvVar(path);
63 if ( path.length() > 0 && path[path.length()-1] != QDir::separator() ) {
64 path += QDir::separator();
65 }
66 _fileNameSkl = path + staID;
67 }
68 _out = 0;
69
70 connect(this, SIGNAL(newCorrLine(QString, QString, long)),
71 (bncApp*) qApp, SLOT(slotNewCorrLine(QString, QString, long)));
72}
73
74// Destructor
75////////////////////////////////////////////////////////////////////////////
76RTCM3coDecoder::~RTCM3coDecoder() {
77 delete _out;
78}
79
80// Reopen Output File
81////////////////////////////////////////////////////////////////////////
82void RTCM3coDecoder::reopen() {
83
84 if (!_fileNameSkl.isEmpty()) {
85
86 QSettings settings;
87
88 QDateTime datTim = QDateTime::currentDateTime().toUTC();
89
90 QString hlpStr = bncRinex::nextEpochStr(datTim,
91 settings.value("corrIntr").toString());
92
93 QString fileName = _fileNameSkl
94 + QString("%1").arg(datTim.date().dayOfYear(), 3, 10, QChar('0'))
95 + hlpStr + datTim.toString(".yyC");
96
97 if (_fileName == fileName) {
98 return;
99 }
100 else {
101 _fileName = fileName;
102 }
103
104 delete _out;
105 _out = new ofstream( _fileName.toAscii().data() );
106 }
107}
108
109//
110////////////////////////////////////////////////////////////////////////////
111t_irc RTCM3coDecoder::Decode(char* buffer, int bufLen) {
112
113 _buffer.append(buffer, bufLen);
114
115 t_irc retCode = failure;
116
117 while (true) {
118
119 memset(&_co, 0, sizeof(_co));
120
121 int bytesused = 0;
122 GCOB_RETURN irc = GetClockOrbitBias(&_co, &_bias, _buffer.data(),
123 _buffer.size(), &bytesused);
124
125 // Not enough Data
126 // ---------------
127 if (irc == GCOBR_SHORTBUFFER ||
128 irc == GCOBR_MESSAGEEXCEEDSBUFFER) {
129 return retCode;
130 }
131
132 // Message correctly decoded
133 // -------------------------
134 else if ( (irc == GCOBR_OK || irc == GCOBR_MESSAGEFOLLOWS) &&
135 bytesused > 0) {
136 reopen();
137
138 int GPSweek;
139 double GPSweeks;
140 currentGPSWeeks(GPSweek, GPSweeks);
141
142 for (int kk = 0; kk < _co.epochSize; kk++) {
143 _epochList.push_back(_co.epochGPS[kk]); /* Weber, for latency */
144 }
145
146 if (_co.NumberOfGPSSat > 0) {
147 if (GPSweeks > _co.GPSEpochTime + 86400.0) {
148 GPSweek += 1;
149 }
150 else if (GPSweeks < _co.GPSEpochTime - 86400.0) {
151 GPSweek -= 1;
152 }
153 GPSweeks = _co.GPSEpochTime;
154 }
155 else {
156 double GPSdaysec = fmod(GPSweeks, 86400.0);
157 int weekDay = int((GPSweeks - GPSdaysec) / 86400.0);
158 if (GPSdaysec > _co.GLONASSEpochTime + 3600.0) {
159 weekDay += 1;
160 if (weekDay > 6) {
161 weekDay = 0;
162 GPSweek += 1;
163 }
164 }
165 else if (GPSdaysec < _co.GLONASSEpochTime - 3600.0) {
166 weekDay -= 1;
167 if (weekDay < 0) {
168 weekDay = 6;
169 GPSweek -= 1;
170 }
171 }
172 GPSweeks = weekDay * 86400.0 + _co.GLONASSEpochTime;
173 }
174
175 for(int ii = 0; ii < _co.NumberOfGPSSat; ++ii) {
176 QString line;
177 line.sprintf("%d %.1f G%2.2d %3d %8.3f %8.3f %8.3f %8.3f",
178 GPSweek, GPSweeks, _co.Sat[ii].ID, _co.Sat[ii].IOD,
179 _co.Sat[ii].Clock.DeltaA0,
180 _co.Sat[ii].Orbit.DeltaRadial,
181 _co.Sat[ii].Orbit.DeltaAlongTrack,
182 _co.Sat[ii].Orbit.DeltaCrossTrack);
183 long coTime = GPSweek * 7*24*3600 + long(floor(GPSweeks+0.5));
184 printLine(line, coTime);
185 }
186 for(int ii = CLOCKORBIT_NUMGPS;
187 ii < CLOCKORBIT_NUMGPS + _co.NumberOfGLONASSSat; ++ii) {
188 QString line;
189 line.sprintf("%d %.1f R%2.2d %3d %8.3f %8.3f %8.3f %8.3f",
190 GPSweek, GPSweeks, _co.Sat[ii].ID, _co.Sat[ii].IOD,
191 _co.Sat[ii].Clock.DeltaA0,
192 _co.Sat[ii].Orbit.DeltaRadial,
193 _co.Sat[ii].Orbit.DeltaAlongTrack,
194 _co.Sat[ii].Orbit.DeltaCrossTrack);
195 long coTime = GPSweek * 7*24*3600 + long(floor(GPSweeks+0.5));
196 printLine(line, coTime);
197 }
198 _buffer = _buffer.substr(bytesused);
199 retCode = success;
200 }
201
202 // All other Cases
203 // ---------------
204 else {
205 _buffer = _buffer.substr(1);
206 }
207 }
208}
209
210//
211////////////////////////////////////////////////////////////////////////////
212void RTCM3coDecoder::printLine(const QString& line, long coTime) {
213 if (_out) {
214 *_out << line.toAscii().data() << endl;
215 _out->flush();
216 }
217
218 emit newCorrLine(line, _staID, coTime);
219}
Note: See TracBrowser for help on using the repository browser.