source: ntrip/branches/BNC_2.12/src/satObs.cpp @ 8693

Last change on this file since 8693 was 8693, checked in by stuerze, 15 months ago

minor changes

File size: 13.8 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(11) << 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    corr._dClk       /= t_CST::c;
70    corr._dotDClk    /= t_CST::c;
71    corr._dotDotDClk /= t_CST::c;
72
73    corrList.push_back(corr);
74  }
75}
76
77// Constructor
78////////////////////////////////////////////////////////////////////////////
79t_orbCorr::t_orbCorr() {
80  _updateInt = 0;
81  _iod       = 0;
82  _system    = 'R';
83  _xr.ReSize(3);    _xr    = 0.0;
84  _dotXr.ReSize(3); _dotXr = 0.0;
85}
86
87//
88////////////////////////////////////////////////////////////////////////////
89void t_orbCorr::writeEpoch(ostream* out, const QList<t_orbCorr>& corrList) {
90  if (!out || corrList.size() == 0) {
91    return;
92  }
93  out->setf(ios::fixed);
94  bncTime epoTime;
95  QListIterator<t_orbCorr> it(corrList);
96  while (it.hasNext()) {
97    const t_orbCorr& corr = it.next();
98    if (!epoTime.valid()) {
99      epoTime = corr._time;
100      *out << "> ORBIT " << epoTime.datestr(' ') << ' ' << epoTime.timestr(1,' ') << " "
101           << corr._updateInt <<  " "
102           << corrList.size() << ' ' << corr._staID << endl;
103    }
104    *out << corr._prn.toString() << ' ' << setw(11) << corr._iod << ' '
105         << setw(10) << setprecision(4) << corr._xr[0]     << ' '
106         << setw(10) << setprecision(4) << corr._xr[1]     << ' '
107         << setw(10) << setprecision(4) << corr._xr[2]     << "    "
108         << setw(10) << setprecision(4) << corr._dotXr[0]  << ' '
109         << setw(10) << setprecision(4) << corr._dotXr[1]  << ' '
110         << setw(10) << setprecision(4) << corr._dotXr[2]  << endl;
111  }
112  out->flush();
113}
114
115//
116////////////////////////////////////////////////////////////////////////////
117void t_orbCorr::readEpoch(const string& epoLine, istream& inStream, QList<t_orbCorr>& corrList) {
118  bncTime      epoTime;
119  unsigned int updateInt;
120  int          numCorr;
121  string       staID;
122  if (t_corrSSR::readEpoLine(epoLine, epoTime, updateInt, numCorr, staID) != t_corrSSR::orbCorr) {
123    return;
124  }
125  for (int ii = 0; ii < numCorr; ii++) {
126    t_orbCorr corr;
127    corr._time      = epoTime;
128    corr._updateInt = updateInt;
129    corr._staID     = staID;
130
131    string line;
132    getline(inStream, line);
133    istringstream in(line.c_str());
134
135    in >> corr._prn      >> corr._iod
136       >> corr._xr[0]    >> corr._xr[1]    >> corr._xr[2]
137       >> corr._dotXr[0] >> corr._dotXr[1] >> corr._dotXr[2];
138
139    if (corr._prn.system() == 'E') {
140      corr._prn.setFlags(1);// I/NAV
141    }
142    corrList.push_back(corr);
143  }
144}
145
146// Constructor
147////////////////////////////////////////////////////////////////////////////
148t_URA::t_URA() {
149  _updateInt  = 0;
150  _iod        = 0;
151  _ura        = 0.0;
152}
153
154//
155////////////////////////////////////////////////////////////////////////////
156void t_URA::writeEpoch(ostream* out, const QList<t_URA>& corrList) {
157  if (!out || corrList.size() == 0) {
158    return;
159  }
160  out->setf(ios::fixed);
161  bncTime epoTime;
162  QListIterator<t_URA> it(corrList);
163  while (it.hasNext()) {
164    const t_URA& corr = it.next();
165    if (!epoTime.valid()) {
166      epoTime = corr._time;
167      *out << "> URA " << epoTime.datestr(' ') << ' ' << epoTime.timestr(1,' ') << " "
168          <<  corr._updateInt <<  " "
169           << corrList.size() << ' ' << corr._staID << endl;
170    }
171    *out << corr._prn.toString() << ' ' << setw(11) << corr._iod << ' '
172         << setw(10) << setprecision(4) << corr._ura << endl;
173  }
174  out->flush();
175}
176
177//
178////////////////////////////////////////////////////////////////////////////
179void t_URA::readEpoch(const string& epoLine, istream& inStream, QList<t_URA>& corrList) {
180  bncTime      epoTime;
181  unsigned int updateInt;
182  int          numCorr;
183  string       staID;
184  if (t_corrSSR::readEpoLine(epoLine, epoTime, updateInt, numCorr, staID) != t_corrSSR::URA) {
185    return;
186  }
187  for (int ii = 0; ii < numCorr; ii++) {
188    t_URA corr;
189    corr._time      = epoTime;
190    corr._updateInt = updateInt;
191    corr._staID     = staID;
192
193    string line;
194    getline(inStream, line);
195    istringstream in(line.c_str());
196
197    in >> corr._prn >> corr._iod >> corr._ura;
198
199    corrList.push_back(corr);
200  }
201}
202
203//
204////////////////////////////////////////////////////////////////////////////
205void t_satCodeBias::writeEpoch(ostream* out, const QList<t_satCodeBias>& biasList) {
206  if (!out || biasList.size() == 0) {
207    return;
208  }
209  out->setf(ios::fixed);
210  bncTime epoTime;
211  QListIterator<t_satCodeBias> it(biasList);
212  while (it.hasNext()) {
213    const t_satCodeBias& satCodeBias = it.next();
214    if (!epoTime.valid()) {
215      epoTime = satCodeBias._time;
216      *out << "> CODE_BIAS " << epoTime.datestr(' ') << ' ' << epoTime.timestr(1,' ') << " "
217           << satCodeBias._updateInt <<  " "
218           << biasList.size() << ' ' << satCodeBias._staID << endl;
219    }
220    if (!satCodeBias._bias.size()) {
221      continue;
222    }
223    *out << satCodeBias._prn.toString() << "   " << setw(2) << satCodeBias._bias.size();
224    for (unsigned ii = 0; ii < satCodeBias._bias.size(); ii++) {
225      const t_frqCodeBias& frqCodeBias = satCodeBias._bias[ii];
226      *out << "   " << frqCodeBias._rnxType2ch << ' '
227           << setw(10) << setprecision(4) << frqCodeBias._value;
228    }
229    *out << endl;
230  }
231  out->flush();
232}
233
234//
235////////////////////////////////////////////////////////////////////////////
236void t_satCodeBias::readEpoch(const string& epoLine, istream& inStream, QList<t_satCodeBias>& biasList) {
237  bncTime      epoTime;
238  unsigned int updateInt;
239  int          numSat;
240  string       staID;
241  if (t_corrSSR::readEpoLine(epoLine, epoTime, updateInt, numSat, staID) != t_corrSSR::codeBias) {
242    return;
243  }
244  for (int ii = 0; ii < numSat; ii++) {
245    t_satCodeBias satCodeBias;
246    satCodeBias._time      = epoTime;
247    satCodeBias._updateInt = updateInt;
248    satCodeBias._staID     = staID;
249
250    string line;
251    getline(inStream, line);
252    istringstream in(line.c_str());
253
254    int numBias;
255    in >> satCodeBias._prn >> numBias;
256
257    while (in.good()) {
258      t_frqCodeBias frqCodeBias;
259      in >> frqCodeBias._rnxType2ch >> frqCodeBias._value;
260      if (!frqCodeBias._rnxType2ch.empty()) {
261        satCodeBias._bias.push_back(frqCodeBias);
262      }
263    }
264
265    biasList.push_back(satCodeBias);
266  }
267}
268
269//
270////////////////////////////////////////////////////////////////////////////
271void t_satPhaseBias::writeEpoch(ostream* out, const QList<t_satPhaseBias>& biasList) {
272  if (!out || biasList.size() == 0) {
273    return;
274  }
275  out->setf(ios::fixed);
276  bncTime epoTime;
277  QListIterator<t_satPhaseBias> it(biasList);
278  while (it.hasNext()) {
279    const t_satPhaseBias& satPhaseBias = it.next();
280    if (!epoTime.valid()) {
281      epoTime = satPhaseBias._time;
282      *out << "> PHASE_BIAS " << epoTime.datestr(' ') << ' ' << epoTime.timestr(1,' ') << " "
283           << satPhaseBias._updateInt <<  " "
284           << biasList.size() << ' ' << satPhaseBias._staID <<  endl;
285      *out << " " << satPhaseBias._dispBiasConstistInd << "   "
286           << satPhaseBias._MWConsistInd << endl;
287    }
288    *out << satPhaseBias._prn.toString() << ' '
289         << setw(12) << setprecision(8) << satPhaseBias._yawDeg << ' '
290         << setw(12) << setprecision(8) << satPhaseBias._yawDegRate << "   "
291         << setw(2) << satPhaseBias._bias.size();
292    for (unsigned ii = 0; ii < satPhaseBias._bias.size(); ii++) {
293      const t_frqPhaseBias& frqPhaseBias = satPhaseBias._bias[ii];
294      *out << "   " << frqPhaseBias._rnxType2ch << ' '
295           << setw(10) << setprecision(4) << frqPhaseBias._value << ' '
296           << setw(3) << frqPhaseBias._fixIndicator << ' '
297           << setw(3) << frqPhaseBias._fixWideLaneIndicator << ' '
298           << setw(3) << frqPhaseBias._jumpCounter;
299    }
300    *out << endl;
301  }
302  out->flush();
303}
304
305//
306////////////////////////////////////////////////////////////////////////////
307void t_satPhaseBias::readEpoch(const string& epoLine, istream& inStream, QList<t_satPhaseBias>& biasList) {
308  bncTime      epoTime;
309  unsigned int updateInt;
310  int          numSat;
311  string       staID;
312  unsigned int dispInd;
313  unsigned int mwInd;
314  if (t_corrSSR::readEpoLine(epoLine, epoTime, updateInt, numSat, staID) != t_corrSSR::phaseBias) {
315    return;
316  }
317  for (int ii = 0; ii <= numSat; ii++) {
318    t_satPhaseBias satPhaseBias;
319    satPhaseBias._time      = epoTime;
320    satPhaseBias._updateInt = updateInt;
321    satPhaseBias._staID     = staID;
322
323    string line;
324    getline(inStream, line);
325    istringstream in(line.c_str());
326
327    if (ii == 0) {
328      in >> dispInd >> mwInd;
329      continue;
330    }
331    satPhaseBias._dispBiasConstistInd = dispInd;
332    satPhaseBias._MWConsistInd = mwInd;
333
334    int numBias;
335    in >> satPhaseBias._prn  >> satPhaseBias._yawDeg >> satPhaseBias._yawDegRate
336      >> numBias;
337
338    while (in.good()) {
339      t_frqPhaseBias frqPhaseBias;
340      in >> frqPhaseBias._rnxType2ch >> frqPhaseBias._value
341         >> frqPhaseBias._fixIndicator >> frqPhaseBias._fixWideLaneIndicator
342         >> frqPhaseBias._jumpCounter;
343      if (!frqPhaseBias._rnxType2ch.empty()) {
344        satPhaseBias._bias.push_back(frqPhaseBias);
345      }
346    }
347
348    biasList.push_back(satPhaseBias);
349  }
350}
351
352//
353////////////////////////////////////////////////////////////////////////////
354void t_vTec::write(ostream* out, const t_vTec& vTec) {
355  if (!out || vTec._layers.size() == 0) {
356    return;
357  }
358  out->setf(ios::fixed);
359  bncTime epoTime = vTec._time;
360  *out << "> VTEC " << epoTime.datestr(' ') << ' ' << epoTime.timestr(1,' ') << " "
361       << vTec._updateInt <<  " "
362       << vTec._layers.size() << ' ' << vTec._staID << endl;
363  for (unsigned ii = 0; ii < vTec._layers.size(); ii++) {
364    const t_vTecLayer& layer = vTec._layers[ii];
365    *out << setw(2)  << ii+1 << ' '
366         << setw(2)  << layer._C.Nrows()-1 << ' '
367         << setw(2)  << layer._C.Ncols()-1 << ' '
368         << setw(10) << setprecision(1) << layer._height << endl
369         << setw(10) << setprecision(4) << layer._C
370         << setw(10) << setprecision(4) << layer._S;
371  }
372  out->flush();
373}
374
375//
376////////////////////////////////////////////////////////////////////////////
377void t_vTec::read(const string& epoLine, istream& inStream, t_vTec& vTec) {
378  bncTime      epoTime;
379  unsigned int updateInt;
380  int          numLayers;
381  string       staID;
382  if (t_corrSSR::readEpoLine(epoLine, epoTime, updateInt, numLayers, staID) != t_corrSSR::vTec) {
383    return;
384  }
385  if (numLayers <= 0) {
386    return;
387  }
388  vTec._time      = epoTime;
389  vTec._updateInt = updateInt;
390  vTec._staID     = staID;
391  for (int ii = 0; ii < numLayers; ii++) {
392    t_vTecLayer layer;
393
394    string line;
395    getline(inStream, line);
396    istringstream in(line.c_str());
397
398    int dummy, maxDeg, maxOrd;
399    in >> dummy >> maxDeg >> maxOrd >> layer._height;
400
401    layer._C.ReSize(maxDeg+1, maxOrd+1);
402    layer._S.ReSize(maxDeg+1, maxOrd+1);
403
404    for (int iDeg = 0; iDeg <= maxDeg; iDeg++) {
405      for (int iOrd = 0; iOrd <= maxOrd; iOrd++) {
406        inStream >> layer._C[iDeg][iOrd];
407      }
408    }
409    for (int iDeg = 0; iDeg <= maxDeg; iDeg++) {
410      for (int iOrd = 0; iOrd <= maxOrd; iOrd++) {
411        inStream >> layer._S[iDeg][iOrd];
412      }
413    }
414
415    vTec._layers.push_back(layer);
416  }
417}
418
419//
420////////////////////////////////////////////////////////////////////////////
421t_corrSSR::e_type t_corrSSR::readEpoLine(const string& line, bncTime& epoTime,
422                                         unsigned int& updateInt, int& numEntries,
423                                         string& staID) {
424
425  istringstream inLine(line.c_str());
426
427  char   epoChar;
428  string typeString;
429  int    year, month, day, hour, min;
430  double sec;
431
432  inLine >> epoChar >> typeString
433         >> year >> month >> day >> hour >> min >> sec >> updateInt >> numEntries >> staID;
434
435  if (epoChar == '>') {
436    epoTime.set(year, month, day, hour, min, sec);
437    if      (typeString == "CLOCK") {
438      return clkCorr;
439    }
440    else if (typeString == "ORBIT") {
441      return orbCorr;
442    }
443    else if (typeString == "CODE_BIAS") {
444      return codeBias;
445    }
446    else if (typeString == "PHASE_BIAS") {
447      return phaseBias;
448    }
449    else if (typeString == "VTEC") {
450      return vTec;
451    }
452    else if (typeString == "URA") {
453      return URA;
454    }
455  }
456
457  return unknown;
458}
Note: See TracBrowser for help on using the repository browser.