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

Last change on this file since 7013 was 7013, checked in by stuerze, 9 years ago

some unit changes regarding ssr clock parameter s
File size: 12.1 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 _updateInt = 0;
14 _iod = 0;
15 _dClk = 0.0;
16 _dotDClk = 0.0;
17 _dotDotDClk = 0.0;
18}
19
20//
21////////////////////////////////////////////////////////////////////////////
22void t_clkCorr::writeEpoch(ostream* out, const QList<t_clkCorr>& corrList) {
23 if (!out || corrList.size() == 0) {
24 return;
25 }
26 out->setf(ios::fixed);
27 bncTime epoTime;
28 QListIterator<t_clkCorr> it(corrList);
29 while (it.hasNext()) {
30 const t_clkCorr& corr = it.next();
31 if (!epoTime.valid()) {
32 epoTime = corr._time;
33 *out << "> CLOCK " << epoTime.datestr(' ') << ' ' << epoTime.timestr(1,' ') << " "
34 << corr._updateInt << " "
35 << corrList.size() << ' ' << corr._staID << endl;
36 }
37 *out << corr._prn.toString() << ' ' << setw(3) << corr._iod << ' '
38 << setw(10) << setprecision(4) << corr._dClk * t_CST::c << ' '
39 << setw(10) << setprecision(4) << corr._dotDClk * t_CST::c << ' '
40 << setw(10) << setprecision(4) << corr._dotDotDClk * t_CST::c << endl;
41 }
42 out->flush();
43}
44
45//
46////////////////////////////////////////////////////////////////////////////
47void t_clkCorr::readEpoch(const string& epoLine, istream& inStream, QList<t_clkCorr>& corrList) {
48 bncTime epoTime;
49 unsigned int updateInt;
50 int numCorr;
51 string staID;
52 if (t_corrSSR::readEpoLine(epoLine, epoTime, updateInt, numCorr, staID) != t_corrSSR::clkCorr) {
53 return;
54 }
55 for (int ii = 0; ii < numCorr; ii++) {
56 t_clkCorr corr;
57 corr._time = epoTime;
58 corr._updateInt = updateInt;
59 corr._staID = staID;
60
61 string line;
62 getline(inStream, line);
63 istringstream in(line.c_str());
64
65 in >> corr._prn >> corr._iod >> corr._dClk >> corr._dotDClk >> corr._dotDotDClk;
66 if (corr._prn.system() == 'E') {
67 corr._prn.setFlags(1);// I/NAV
68 }
69 corrList.push_back(corr);
70 }
71}
72
73// Constructor
74////////////////////////////////////////////////////////////////////////////
75t_orbCorr::t_orbCorr() {
76 _updateInt = 0;
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 if (corr._prn.system() == 'E') {
136 corr._prn.setFlags(1);// I/NAV
137 }
138 corrList.push_back(corr);
139 }
140}
141
142//
143////////////////////////////////////////////////////////////////////////////
144void t_satCodeBias::writeEpoch(ostream* out, const QList<t_satCodeBias>& biasList) {
145 if (!out || biasList.size() == 0) {
146 return;
147 }
148 out->setf(ios::fixed);
149 bncTime epoTime;
150 QListIterator<t_satCodeBias> it(biasList);
151 while (it.hasNext()) {
152 const t_satCodeBias& satCodeBias = it.next();
153 if (!epoTime.valid()) {
154 epoTime = satCodeBias._time;
155 *out << "> CODE_BIAS " << epoTime.datestr(' ') << ' ' << epoTime.timestr(1,' ') << " "
156 << satCodeBias._updateInt << " "
157 << biasList.size() << ' ' << satCodeBias._staID << endl;
158 }
159 *out << satCodeBias._prn.toString() << " " << setw(2) << satCodeBias._bias.size();
160 for (unsigned ii = 0; ii < satCodeBias._bias.size(); ii++) {
161 const t_frqCodeBias& frqCodeBias = satCodeBias._bias[ii];
162 *out << " " << frqCodeBias._rnxType2ch << ' '
163 << setw(10) << setprecision(4) << frqCodeBias._value;
164 }
165 *out << endl;
166 }
167 out->flush();
168}
169
170//
171////////////////////////////////////////////////////////////////////////////
172void t_satCodeBias::readEpoch(const string& epoLine, istream& inStream, QList<t_satCodeBias>& biasList) {
173 bncTime epoTime;
174 unsigned int updateInt;
175 int numSat;
176 string staID;
177 if (t_corrSSR::readEpoLine(epoLine, epoTime, updateInt, numSat, staID) != t_corrSSR::codeBias) {
178 return;
179 }
180 for (int ii = 0; ii < numSat; ii++) {
181 t_satCodeBias satCodeBias;
182 satCodeBias._time = epoTime;
183 satCodeBias._updateInt = updateInt;
184 satCodeBias._staID = staID;
185
186 string line;
187 getline(inStream, line);
188 istringstream in(line.c_str());
189
190 int numBias;
191 in >> satCodeBias._prn >> numBias;
192
193 while (in.good()) {
194 t_frqCodeBias frqCodeBias;
195 in >> frqCodeBias._rnxType2ch >> frqCodeBias._value;
196 if (!frqCodeBias._rnxType2ch.empty()) {
197 satCodeBias._bias.push_back(frqCodeBias);
198 }
199 }
200
201 biasList.push_back(satCodeBias);
202 }
203}
204
205//
206////////////////////////////////////////////////////////////////////////////
207void t_satPhaseBias::writeEpoch(ostream* out, const QList<t_satPhaseBias>& biasList) {
208 if (!out || biasList.size() == 0) {
209 return;
210 }
211 out->setf(ios::fixed);
212 bncTime epoTime;
213 QListIterator<t_satPhaseBias> it(biasList);
214 while (it.hasNext()) {
215 const t_satPhaseBias& satPhaseBias = it.next();
216 if (!epoTime.valid()) {
217 epoTime = satPhaseBias._time;
218 *out << "> PHASE_BIAS " << epoTime.datestr(' ') << ' ' << epoTime.timestr(1,' ') << " "
219 << satPhaseBias._updateInt << " "
220 << biasList.size() << ' ' << satPhaseBias._staID << endl;
221 *out << " " << satPhaseBias._dispBiasConstistInd << " "
222 << satPhaseBias._MWConsistInd << endl;
223 }
224 *out << satPhaseBias._prn.toString() << ' '
225 << setw(12) << setprecision(8) << satPhaseBias._yawDeg << ' '
226 << setw(12) << setprecision(8) << satPhaseBias._yawDegRate << " "
227 << setw(2) << satPhaseBias._bias.size();
228 for (unsigned ii = 0; ii < satPhaseBias._bias.size(); ii++) {
229 const t_frqPhaseBias& frqPhaseBias = satPhaseBias._bias[ii];
230 *out << " " << frqPhaseBias._rnxType2ch << ' '
231 << setw(10) << setprecision(4) << frqPhaseBias._value << ' '
232 << setw(3) << frqPhaseBias._fixIndicator << ' '
233 << setw(3) << frqPhaseBias._fixWideLaneIndicator << ' '
234 << setw(3) << frqPhaseBias._jumpCounter;
235 }
236 *out << endl;
237 }
238 out->flush();
239}
240
241//
242////////////////////////////////////////////////////////////////////////////
243void t_satPhaseBias::readEpoch(const string& epoLine, istream& inStream, QList<t_satPhaseBias>& biasList) {
244 bncTime epoTime;
245 unsigned int updateInt;
246 int numSat;
247 string staID;
248 unsigned int dispInd;
249 unsigned int mwInd;
250 if (t_corrSSR::readEpoLine(epoLine, epoTime, updateInt, numSat, staID) != t_corrSSR::phaseBias) {
251 return;
252 }
253 for (int ii = 0; ii <= numSat; ii++) {
254 t_satPhaseBias satPhaseBias;
255 satPhaseBias._time = epoTime;
256 satPhaseBias._updateInt = updateInt;
257 satPhaseBias._staID = staID;
258
259 string line;
260 getline(inStream, line);
261 istringstream in(line.c_str());
262
263 if (ii == 0) {
264 in >> dispInd >> mwInd;
265 continue;
266 }
267 satPhaseBias._dispBiasConstistInd = dispInd;
268 satPhaseBias._MWConsistInd = mwInd;
269
270 int numBias;
271 in >> satPhaseBias._prn >> satPhaseBias._yawDeg >> satPhaseBias._yawDegRate
272 >> numBias;
273
274 while (in.good()) {
275 t_frqPhaseBias frqPhaseBias;
276 in >> frqPhaseBias._rnxType2ch >> frqPhaseBias._value
277 >> frqPhaseBias._fixIndicator >> frqPhaseBias._fixWideLaneIndicator
278 >> frqPhaseBias._jumpCounter;
279 if (!frqPhaseBias._rnxType2ch.empty()) {
280 satPhaseBias._bias.push_back(frqPhaseBias);
281 }
282 }
283
284 biasList.push_back(satPhaseBias);
285 }
286}
287
288//
289////////////////////////////////////////////////////////////////////////////
290void t_vTec::write(ostream* out, const t_vTec& vTec) {
291 if (!out || vTec._layers.size() == 0) {
292 return;
293 }
294 out->setf(ios::fixed);
295 bncTime epoTime = vTec._time;
296 *out << "> VTEC " << epoTime.datestr(' ') << ' ' << epoTime.timestr(1,' ') << " "
297 << vTec._updateInt << " "
298 << vTec._layers.size() << ' ' << vTec._staID << endl;
299 for (unsigned ii = 0; ii < vTec._layers.size(); ii++) {
300 const t_vTecLayer& layer = vTec._layers[ii];
301 *out << setw(2) << ii+1 << ' '
302 << setw(2) << layer._C.Nrows()-1 << ' '
303 << setw(2) << layer._C.Ncols()-1 << ' '
304 << setw(10) << setprecision(1) << layer._height << endl
305 << setw(10) << setprecision(4) << layer._C
306 << setw(10) << setprecision(4) << layer._S;
307 }
308 out->flush();
309}
310
311//
312////////////////////////////////////////////////////////////////////////////
313void t_vTec::read(const string& epoLine, istream& inStream, t_vTec& vTec) {
314 bncTime epoTime;
315 unsigned int updateInt;
316 int numLayers;
317 string staID;
318 if (t_corrSSR::readEpoLine(epoLine, epoTime, updateInt, numLayers, staID) != t_corrSSR::vTec) {
319 return;
320 }
321 if (numLayers <= 0) {
322 return;
323 }
324 vTec._time = epoTime;
325 vTec._updateInt = updateInt;
326 vTec._staID = staID;
327 for (int ii = 0; ii < numLayers; ii++) {
328 t_vTecLayer layer;
329
330 string line;
331 getline(inStream, line);
332 istringstream in(line.c_str());
333
334 int dummy, maxDeg, maxOrd;
335 in >> dummy >> maxDeg >> maxOrd >> layer._height;
336
337 layer._C.ReSize(maxDeg+1, maxOrd+1);
338 layer._S.ReSize(maxDeg+1, maxOrd+1);
339
340 for (int iDeg = 0; iDeg <= maxDeg; iDeg++) {
341 for (int iOrd = 0; iOrd <= maxOrd; iOrd++) {
342 inStream >> layer._C[iDeg][iOrd];
343 }
344 }
345 for (int iDeg = 0; iDeg <= maxDeg; iDeg++) {
346 for (int iOrd = 0; iOrd <= maxOrd; iOrd++) {
347 inStream >> layer._S[iDeg][iOrd];
348 }
349 }
350
351 vTec._layers.push_back(layer);
352 }
353}
354
355//
356////////////////////////////////////////////////////////////////////////////
357t_corrSSR::e_type t_corrSSR::readEpoLine(const string& line, bncTime& epoTime,
358 unsigned int& updateInt, int& numEntries,
359 string& staID) {
360
361 istringstream inLine(line.c_str());
362
363 char epoChar;
364 string typeString;
365 int year, month, day, hour, min;
366 double sec;
367
368 inLine >> epoChar >> typeString
369 >> year >> month >> day >> hour >> min >> sec >> updateInt >> numEntries >> staID;
370
371 if (epoChar == '>') {
372 epoTime.set(year, month, day, hour, min, sec);
373 if (typeString == "CLOCK") {
374 return clkCorr;
375 }
376 else if (typeString == "ORBIT") {
377 return orbCorr;
378 }
379 else if (typeString == "CODE_BIAS") {
380 return codeBias;
381 }
382 else if (typeString == "PHASE_BIAS") {
383 return phaseBias;
384 }
385 else if (typeString == "VTEC") {
386 return vTec;
387 }
388 }
389
390 return unknown;
391}
Note: See TracBrowser for help on using the repository browser.