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

Last change on this file since 990 was 974, checked in by mervart, 16 years ago

* empty log message *

File size: 6.1 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 while (true) {
116
117 memset(&_co, 0, sizeof(_co));
118
119 int bytesused = 0;
120 GCOB_RETURN irc = GetClockOrbitBias(&_co, &_bias, _buffer.data(),
121 _buffer.size(), &bytesused);
122
123 // Not enough Data
124 // ---------------
125 if (irc == GCOBR_SHORTBUFFER ||
126 irc == GCOBR_MESSAGEEXCEEDSBUFFER) {
127 return failure;
128 }
129
130 // Message correctly decoded
131 // -------------------------
132 else if ( (irc == GCOBR_OK || irc == GCOBR_MESSAGEFOLLOWS) &&
133 bytesused > 0) {
134 reopen();
135
136 int GPSweek;
137 double GPSweeks;
138 currentGPSWeeks(GPSweek, GPSweeks);
139
140 if (_co.NumberOfGPSSat > 0) {
141 if (GPSweeks > _co.GPSEpochTime + 86400.0) {
142 GPSweek += 1;
143 }
144 else if (GPSweeks < _co.GPSEpochTime - 86400.0) {
145 GPSweek -= 1;
146 }
147 GPSweeks = _co.GPSEpochTime;
148 }
149 else {
150 double GPSdaysec = fmod(GPSweeks, 86400.0);
151 int weekDay = int((GPSweeks - GPSdaysec) / 86400.0);
152 if (GPSdaysec > _co.GLONASSEpochTime + 3600.0) {
153 weekDay += 1;
154 if (weekDay > 6) {
155 weekDay = 0;
156 GPSweek += 1;
157 }
158 }
159 else if (GPSdaysec < _co.GLONASSEpochTime - 3600.0) {
160 weekDay -= 1;
161 if (weekDay < 0) {
162 weekDay = 6;
163 GPSweek -= 1;
164 }
165 }
166 GPSweeks = weekDay * 86400.0 + _co.GLONASSEpochTime;
167 }
168
169 for(int ii = 0; ii < _co.NumberOfGPSSat; ++ii) {
170 QString line;
171 line.sprintf("%d %.1f G%2.2d %3d %8.3f %8.3f %8.3f %8.3f",
172 GPSweek, GPSweeks, _co.Sat[ii].ID, _co.Sat[ii].IOD,
173 _co.Sat[ii].Clock.DeltaA0,
174 _co.Sat[ii].Orbit.DeltaRadial,
175 _co.Sat[ii].Orbit.DeltaAlongTrack,
176 _co.Sat[ii].Orbit.DeltaCrossTrack);
177 long coTime = GPSweek * 7*24*3600 + long(floor(GPSweeks+0.5));
178 printLine(line, coTime);
179 }
180 for(int ii = CLOCKORBIT_NUMGPS;
181 ii < CLOCKORBIT_NUMGPS + _co.NumberOfGLONASSSat; ++ii) {
182 QString line;
183 line.sprintf("%d %.1f R%2.2d %3d %8.3f %8.3f %8.3f %8.3f",
184 GPSweek, GPSweeks, _co.Sat[ii].ID, _co.Sat[ii].IOD,
185 _co.Sat[ii].Clock.DeltaA0,
186 _co.Sat[ii].Orbit.DeltaRadial,
187 _co.Sat[ii].Orbit.DeltaAlongTrack,
188 _co.Sat[ii].Orbit.DeltaCrossTrack);
189 long coTime = GPSweek * 7*24*3600 + long(floor(GPSweeks+0.5));
190 printLine(line, coTime);
191 }
192 _buffer = _buffer.substr(bytesused);
193 return success;
194 }
195
196 // All other Cases
197 // ---------------
198 else {
199 _buffer = _buffer.substr(1);
200 }
201 }
202}
203
204//
205////////////////////////////////////////////////////////////////////////////
206void RTCM3coDecoder::printLine(const QString& line, long coTime) {
207 if (_out) {
208 *_out << line.toAscii().data() << endl;
209 _out->flush();
210 }
211
212 emit newCorrLine(line, _staID, coTime);
213}
Note: See TracBrowser for help on using the repository browser.