source: ntrip/trunk/BNC/src/satObs.cpp@ 6570

Last change on this file since 6570 was 6567, checked in by mervart, 11 years ago
File size: 11.7 KB
Line 
1#include <iostream>
2#include <iomanip>
3#include <sstream>
4#include <newmatio.h>
5
6#include "satObs.h"
7
8using namespace std;
9
10// Constructor
11////////////////////////////////////////////////////////////////////////////
12t_clkCorr::t_clkCorr() {
13 _iod = 0;
14 _dClk = 0.0;
15 _dotDClk = 0.0;
16 _dotDotDClk = 0.0;
17}
18
19//
20////////////////////////////////////////////////////////////////////////////
21void t_clkCorr::writeEpoch(ostream* out, const QList<t_clkCorr>& corrList) {
22 if (!out || corrList.size() == 0) {
23 return;
24 }
25 out->setf(ios::fixed);
26 bncTime epoTime;
27 QListIterator<t_clkCorr> it(corrList);
28 while (it.hasNext()) {
29 const t_clkCorr& corr = it.next();
30 if (!epoTime.valid()) {
31 epoTime = corr._time;
32 *out << "> CLOCK " << epoTime.datestr(' ') << ' ' << epoTime.timestr(1,' ') << " "
33 << corr._updateInt << " "
34 << corrList.size() << ' ' << corr._staID << endl;
35 }
36 *out << corr._prn.toString() << ' ' << setw(3) << corr._iod << ' '
37 << setw(10) << setprecision(4) << corr._dClk * t_CST::c << ' '
38 << setw(10) << setprecision(4) << corr._dotDClk * t_CST::c << ' '
39 << setw(10) << setprecision(4) << corr._dotDotDClk * t_CST::c << endl;
40 }
41 out->flush();
42}
43
44//
45////////////////////////////////////////////////////////////////////////////
46void t_clkCorr::readEpoch(const string& epoLine, istream& inStream, QList<t_clkCorr>& corrList) {
47 bncTime epoTime;
48 unsigned int updateInt;
49 int numCorr;
50 string staID;
51 if (t_corrSSR::readEpoLine(epoLine, epoTime, updateInt, numCorr, staID) != t_corrSSR::clkCorr) {
52 return;
53 }
54 for (int ii = 0; ii < numCorr; ii++) {
55 t_clkCorr corr;
56 corr._time = epoTime;
57 corr._updateInt = updateInt;
58 corr._staID = staID;
59
60 string line;
61 getline(inStream, line);
62 istringstream in(line.c_str());
63
64 in >> corr._prn >> corr._iod >> corr._dClk >> corr._dotDClk >> corr._dotDotDClk;
65
66 corr._dClk /= t_CST::c;
67 corr._dotDClk /= t_CST::c;
68 corr._dotDotDClk /= t_CST::c;
69
70 corrList.push_back(corr);
71 }
72}
73
74// Constructor
75////////////////////////////////////////////////////////////////////////////
76t_orbCorr::t_orbCorr() {
77 _iod = 0;
78 _system = 'R';
79 _xr.ReSize(3); _xr = 0.0;
80 _dotXr.ReSize(3); _dotXr = 0.0;
81}
82
83//
84////////////////////////////////////////////////////////////////////////////
85void t_orbCorr::writeEpoch(ostream* out, const QList<t_orbCorr>& corrList) {
86 if (!out || corrList.size() == 0) {
87 return;
88 }
89 out->setf(ios::fixed);
90 bncTime epoTime;
91 QListIterator<t_orbCorr> it(corrList);
92 while (it.hasNext()) {
93 const t_orbCorr& corr = it.next();
94 if (!epoTime.valid()) {
95 epoTime = corr._time;
96 *out << "> ORBIT " << epoTime.datestr(' ') << ' ' << epoTime.timestr(1,' ') << " "
97 << corr._updateInt << " "
98 << corrList.size() << ' ' << corr._staID << endl;
99 }
100 *out << corr._prn.toString() << ' ' << setw(3) << corr._iod << ' '
101 << setw(10) << setprecision(4) << corr._xr[0] << ' '
102 << setw(10) << setprecision(4) << corr._xr[1] << ' '
103 << setw(10) << setprecision(4) << corr._xr[2] << " "
104 << setw(10) << setprecision(4) << corr._dotXr[0] << ' '
105 << setw(10) << setprecision(4) << corr._dotXr[1] << ' '
106 << setw(10) << setprecision(4) << corr._dotXr[2] << endl;
107 }
108 out->flush();
109}
110
111//
112////////////////////////////////////////////////////////////////////////////
113void t_orbCorr::readEpoch(const string& epoLine, istream& inStream, QList<t_orbCorr>& corrList) {
114 bncTime epoTime;
115 unsigned int updateInt;
116 int numCorr;
117 string staID;
118 if (t_corrSSR::readEpoLine(epoLine, epoTime, updateInt, numCorr, staID) != t_corrSSR::orbCorr) {
119 return;
120 }
121 for (int ii = 0; ii < numCorr; ii++) {
122 t_orbCorr corr;
123 corr._time = epoTime;
124 corr._updateInt = updateInt;
125 corr._staID = staID;
126
127 string line;
128 getline(inStream, line);
129 istringstream in(line.c_str());
130
131 in >> corr._prn >> corr._iod
132 >> corr._xr[0] >> corr._xr[1] >> corr._xr[2]
133 >> corr._dotXr[0] >> corr._dotXr[1] >> corr._dotXr[2];
134
135 corrList.push_back(corr);
136 }
137}
138
139//
140////////////////////////////////////////////////////////////////////////////
141void t_satCodeBias::writeEpoch(ostream* out, const QList<t_satCodeBias>& biasList) {
142 if (!out || biasList.size() == 0) {
143 return;
144 }
145 out->setf(ios::fixed);
146 bncTime epoTime;
147 QListIterator<t_satCodeBias> it(biasList);
148 while (it.hasNext()) {
149 const t_satCodeBias& satCodeBias = it.next();
150 if (!epoTime.valid()) {
151 epoTime = satCodeBias._time;
152 *out << "> CODE_BIAS " << epoTime.datestr(' ') << ' ' << epoTime.timestr(1,' ') << " "
153 << satCodeBias._updateInt << " "
154 << biasList.size() << ' ' << satCodeBias._staID << endl;
155 }
156 *out << satCodeBias._prn.toString() << " " << setw(2) << satCodeBias._bias.size();
157 for (unsigned ii = 0; ii < satCodeBias._bias.size(); ii++) {
158 const t_frqCodeBias& frqCodeBias = satCodeBias._bias[ii];
159 *out << " " << frqCodeBias._rnxType2ch << ' '
160 << setw(10) << setprecision(4) << frqCodeBias._value;
161 }
162 *out << endl;
163 }
164 out->flush();
165}
166
167//
168////////////////////////////////////////////////////////////////////////////
169void t_satCodeBias::readEpoch(const string& epoLine, istream& inStream, QList<t_satCodeBias>& biasList) {
170 bncTime epoTime;
171 unsigned int updateInt;
172 int numSat;
173 string staID;
174 if (t_corrSSR::readEpoLine(epoLine, epoTime, updateInt, numSat, staID) != t_corrSSR::codeBias) {
175 return;
176 }
177 for (int ii = 0; ii < numSat; ii++) {
178 t_satCodeBias satCodeBias;
179 satCodeBias._time = epoTime;
180 satCodeBias._updateInt = updateInt;
181 satCodeBias._staID = staID;
182
183 string line;
184 getline(inStream, line);
185 istringstream in(line.c_str());
186
187 int numBias;
188 in >> satCodeBias._prn >> numBias;
189
190 while (in.good()) {
191 t_frqCodeBias frqCodeBias;
192 in >> frqCodeBias._rnxType2ch >> frqCodeBias._value;
193 if (!frqCodeBias._rnxType2ch.empty()) {
194 satCodeBias._bias.push_back(frqCodeBias);
195 }
196 }
197
198 biasList.push_back(satCodeBias);
199 }
200}
201
202//
203////////////////////////////////////////////////////////////////////////////
204void t_satPhaseBias::writeEpoch(ostream* out, const QList<t_satPhaseBias>& biasList) {
205 if (!out || biasList.size() == 0) {
206 return;
207 }
208 out->setf(ios::fixed);
209 bncTime epoTime;
210 QListIterator<t_satPhaseBias> it(biasList);
211 while (it.hasNext()) {
212 const t_satPhaseBias& satPhaseBias = it.next();
213 if (!epoTime.valid()) {
214 epoTime = satPhaseBias._time;
215 *out << "> PHASE_BIAS " << epoTime.datestr(' ') << ' ' << epoTime.timestr(1,' ') << " "
216 << satPhaseBias._updateInt << " "
217 << biasList.size() << ' ' << satPhaseBias._staID << endl;
218 }
219 *out << satPhaseBias._prn.toString() << ' '
220 << setw(12) << setprecision(8) << satPhaseBias._yawDeg << ' '
221 << setw(12) << setprecision(8) << satPhaseBias._yawDegRate << " "
222 << setw(2) << satPhaseBias._bias.size();
223 for (unsigned ii = 0; ii < satPhaseBias._bias.size(); ii++) {
224 const t_frqPhaseBias& frqPhaseBias = satPhaseBias._bias[ii];
225 *out << " " << frqPhaseBias._rnxType2ch << ' '
226 << setw(10) << setprecision(4) << frqPhaseBias._value << ' '
227 << setw(3) << frqPhaseBias._fixIndicator << ' '
228 << setw(3) << frqPhaseBias._fixWideLaneIndicator << ' '
229 << setw(3) << frqPhaseBias._jumpCounter;
230 }
231 *out << endl;
232 }
233 out->flush();
234}
235
236//
237////////////////////////////////////////////////////////////////////////////
238void t_satPhaseBias::readEpoch(const string& epoLine, istream& inStream, QList<t_satPhaseBias>& biasList) {
239 bncTime epoTime;
240 unsigned int updateInt;
241 int numSat;
242 string staID;
243 if (t_corrSSR::readEpoLine(epoLine, epoTime, updateInt, numSat, staID) != t_corrSSR::phaseBias) {
244 return;
245 }
246 for (int ii = 0; ii < numSat; ii++) {
247 t_satPhaseBias satPhaseBias;
248 satPhaseBias._time = epoTime;
249 satPhaseBias._updateInt = updateInt;
250 satPhaseBias._staID = staID;
251
252 string line;
253 getline(inStream, line);
254 istringstream in(line.c_str());
255
256 int numBias;
257 in >> satPhaseBias._prn >> satPhaseBias._yawDeg >> satPhaseBias._yawDegRate >> numBias;
258
259 while (in.good()) {
260 t_frqPhaseBias frqPhaseBias;
261 in >> frqPhaseBias._rnxType2ch >> frqPhaseBias._value
262 >> frqPhaseBias._fixIndicator >> frqPhaseBias._fixWideLaneIndicator
263 >> frqPhaseBias._jumpCounter;
264 if (!frqPhaseBias._rnxType2ch.empty()) {
265 satPhaseBias._bias.push_back(frqPhaseBias);
266 }
267 }
268
269 biasList.push_back(satPhaseBias);
270 }
271}
272
273//
274////////////////////////////////////////////////////////////////////////////
275void t_vTec::write(ostream* out, const t_vTec& vTec) {
276 if (!out || vTec._layers.size() == 0) {
277 return;
278 }
279 out->setf(ios::fixed);
280 bncTime epoTime = vTec._time;
281 *out << "> VTEC " << epoTime.datestr(' ') << ' ' << epoTime.timestr(1,' ') << " "
282 << vTec._updateInt << " "
283 << vTec._layers.size() << ' ' << vTec._staID << endl;
284 for (unsigned ii = 0; ii < vTec._layers.size(); ii++) {
285 const t_vTecLayer& layer = vTec._layers[ii];
286 *out << setw(2) << ii+1 << ' '
287 << setw(2) << layer._C.Nrows() << ' '
288 << setw(2) << layer._C.Ncols() << ' '
289 << setw(10) << setprecision(1) << layer._height << endl
290 << setw(10) << setprecision(4) << layer._C
291 << setw(10) << setprecision(4) << layer._S;
292 }
293 out->flush();
294}
295
296//
297////////////////////////////////////////////////////////////////////////////
298void t_vTec::read(const string& epoLine, istream& inStream, t_vTec& vTec) {
299 bncTime epoTime;
300 unsigned int updateInt;
301 int numLayers;
302 string staID;
303 if (t_corrSSR::readEpoLine(epoLine, epoTime, updateInt, numLayers, staID) != t_corrSSR::vTec) {
304 return;
305 }
306 if (numLayers <= 0) {
307 return;
308 }
309 vTec._time = epoTime;
310 vTec._updateInt = updateInt;
311 vTec._staID = staID;
312 for (int ii = 0; ii < numLayers; ii++) {
313 t_vTecLayer layer;
314
315 string line;
316 getline(inStream, line);
317 istringstream in(line.c_str());
318
319 int dummy, maxDeg, maxOrd;
320 in >> dummy >> maxDeg >> maxOrd >> layer._height;
321
322 layer._C.ReSize(maxDeg, maxOrd);
323 layer._S.ReSize(maxDeg, maxOrd);
324
325 for (int iDeg = 0; iDeg < maxDeg; iDeg++) {
326 for (int iOrd = 0; iOrd < maxOrd; iOrd++) {
327 inStream >> layer._C[iDeg][iOrd];
328 }
329 }
330 for (int iDeg = 0; iDeg < maxDeg; iDeg++) {
331 for (int iOrd = 0; iOrd < maxOrd; iOrd++) {
332 inStream >> layer._S[iDeg][iOrd];
333 }
334 }
335
336 vTec._layers.push_back(layer);
337 }
338}
339
340//
341////////////////////////////////////////////////////////////////////////////
342t_corrSSR::e_type t_corrSSR::readEpoLine(const string& line, bncTime& epoTime,
343 unsigned int& updateInt, int& numEntries,
344 string& staID) {
345
346 istringstream inLine(line.c_str());
347
348 char epoChar;
349 string typeString;
350 int year, month, day, hour, min;
351 double sec;
352
353 inLine >> epoChar >> typeString
354 >> year >> month >> day >> hour >> min >> sec >> updateInt >> numEntries >> staID;
355
356 if (epoChar == '>') {
357 epoTime.set(year, month, day, hour, min, sec);
358 if (typeString == "CLOCK") {
359 return clkCorr;
360 }
361 else if (typeString == "ORBIT") {
362 return orbCorr;
363 }
364 else if (typeString == "CODE_BIAS") {
365 return codeBias;
366 }
367 else if (typeString == "PHASE_BIAS") {
368 return phaseBias;
369 }
370 else if (typeString == "VTEC") {
371 return vTec;
372 }
373 }
374
375 return unknown;
376}
Note: See TracBrowser for help on using the repository browser.