source: ntrip/trunk/BNC/src/upload/bncrtnetuploadcaster.cpp@ 7063

Last change on this file since 7063 was 7058, checked in by stuerze, 10 years ago

some format changes to support IODs computed from CRC over broadcasted ephemris and clock parameters
File size: 85.6 KB
Line 
1/* -------------------------------------------------------------------------
2 * BKG NTRIP Server
3 * -------------------------------------------------------------------------
4 *
5 * Class: bncRtnetUploadCaster
6 *
7 * Purpose: Connection to NTRIP Caster
8 *
9 * Author: L. Mervart
10 *
11 * Created: 29-Mar-2011
12 *
13 * Changes:
14 *
15 * -----------------------------------------------------------------------*/
16
17#include <math.h>
18#include "bncrtnetuploadcaster.h"
19#include "bncsettings.h"
20#include "bncephuser.h"
21#include "bncclockrinex.h"
22#include "bncsp3.h"
23#include "gnss.h"
24
25using namespace std;
26
27// Constructor
28////////////////////////////////////////////////////////////////////////////
29bncRtnetUploadCaster::bncRtnetUploadCaster(const QString& mountpoint,
30 const QString& outHost, int outPort, const QString& password,
31 const QString& crdTrafo, bool CoM, const QString& sp3FileName,
32 const QString& rnxFileName, int PID, int SID, int IOD, int iRow) :
33 bncUploadCaster(mountpoint, outHost, outPort, password, iRow, 0) {
34
35 if (!outHost.isEmpty()) {
36 _casterID += outHost;
37 }
38 if (!crdTrafo.isEmpty()) {
39 _casterID += " " + crdTrafo;
40 }
41 if (!sp3FileName.isEmpty()) {
42 _casterID += " " + sp3FileName;
43 }
44 if (!rnxFileName.isEmpty()) {
45 _casterID += " " + rnxFileName;
46 }
47
48 _crdTrafo = crdTrafo;
49 _CoM = CoM;
50 _PID = PID;
51 _SID = SID;
52 _IOD = IOD;
53
54 // Member that receives the ephemeris
55 // ----------------------------------
56 _ephUser = new bncEphUser(true);
57
58 bncSettings settings;
59 QString intr = settings.value("uploadIntr").toString();
60 QStringList hlp = settings.value("combineStreams").toStringList();
61 _samplRtcmEphCorr = settings.value("uploadSamplRtcmEphCorr").toDouble();
62 if (hlp.size() > 1) { // combination stream upload
63 _samplRtcmClkCorr = settings.value("cmbSampl").toInt();
64 }
65 else { // single stream upload or sp3 file generation
66 _samplRtcmClkCorr = 5; // default
67 }
68 int samplClkRnx = settings.value("uploadSamplClkRnx").toInt();
69 int samplSp3 = settings.value("uploadSamplSp3").toInt() * 60;
70
71 if (_samplRtcmEphCorr == 0.0) {
72 _usedEph = 0;
73 }
74 else {
75 _usedEph = new QMap<QString, const t_eph*>;
76 }
77
78 // RINEX writer
79 // ------------
80 if (!rnxFileName.isEmpty()) {
81 _rnx = new bncClockRinex(rnxFileName, intr, samplClkRnx);
82 }
83 else {
84 _rnx = 0;
85 }
86
87 // SP3 writer
88 // ----------
89 if (!sp3FileName.isEmpty()) {
90 _sp3 = new bncSP3(sp3FileName, intr, samplSp3);
91 }
92 else {
93 _sp3 = 0;
94 }
95
96 // Set Transformation Parameters
97 // -----------------------------
98 if (_crdTrafo == "ETRF2000") {
99 _dx = 0.0521;
100 _dy = 0.0493;
101 _dz = -0.0585;
102 _dxr = 0.0001;
103 _dyr = 0.0001;
104 _dzr = -0.0018;
105 _ox = 0.000891;
106 _oy = 0.005390;
107 _oz = -0.008712;
108 _oxr = 0.000081;
109 _oyr = 0.000490;
110 _ozr = -0.000792;
111 _sc = 1.34;
112 _scr = 0.08;
113 _t0 = 2000.0;
114 }
115 else if (_crdTrafo == "NAD83") {
116 _dx = 0.99343;
117 _dy = -1.90331;
118 _dz = -0.52655;
119 _dxr = 0.00079;
120 _dyr = -0.00060;
121 _dzr = -0.00134;
122 _ox = -0.02591467;
123 _oy = -0.00942645;
124 _oz = -0.01159935;
125 _oxr = -0.00006667;
126 _oyr = 0.00075744;
127 _ozr = 0.00005133;
128 _sc = 1.71504;
129 _scr = -0.10201;
130 _t0 = 1997.0;
131 }
132 else if (_crdTrafo == "GDA94") {
133 _dx = -0.08468;
134 _dy = -0.01942;
135 _dz = 0.03201;
136 _dxr = 0.00142;
137 _dyr = 0.00134;
138 _dzr = 0.00090;
139 _ox = 0.0004254;
140 _oy = -0.0022578;
141 _oz = -0.0024015;
142 _oxr = -0.0015461;
143 _oyr = -0.0011820;
144 _ozr = -0.0011551;
145 _sc = 9.710;
146 _scr = 0.109;
147 _t0 = 1994.0;
148 }
149 else if (_crdTrafo == "SIRGAS2000") {
150 _dx = 0.0020;
151 _dy = 0.0041;
152 _dz = 0.0039;
153 _dxr = 0.0000;
154 _dyr = 0.0000;
155 _dzr = 0.0000;
156 _ox = 0.000170;
157 _oy = -0.000030;
158 _oz = 0.000070;
159 _oxr = 0.000000;
160 _oyr = 0.000000;
161 _ozr = 0.000000;
162 _sc = -1.000;
163 _scr = 0.000;
164 _t0 = 0000.0;
165 }
166 else if (_crdTrafo == "SIRGAS95") {
167 _dx = 0.0077;
168 _dy = 0.0058;
169 _dz = -0.0138;
170 _dxr = 0.0000;
171 _dyr = 0.0000;
172 _dzr = 0.0000;
173 _ox = 0.000000;
174 _oy = 0.000000;
175 _oz = -0.000030;
176 _oxr = 0.000000;
177 _oyr = 0.000000;
178 _ozr = 0.000000;
179 _sc = 1.570;
180 _scr = 0.000;
181 _t0 = 0000.0;
182 }
183 else if (_crdTrafo == "DREF91") {
184 _dx = -0.0118;
185 _dy = 0.1432;
186 _dz = -0.1117;
187 _dxr = 0.0001;
188 _dyr = 0.0001;
189 _dzr = -0.0018;
190 _ox = 0.003291;
191 _oy = 0.006190;
192 _oz = -0.011012;
193 _oxr = 0.000081;
194 _oyr = 0.000490;
195 _ozr = -0.000792;
196 _sc = 12.24;
197 _scr = 0.08;
198 _t0 = 2000.0;
199 }
200 else if (_crdTrafo == "Custom") {
201 _dx = settings.value("trafo_dx").toDouble();
202 _dy = settings.value("trafo_dy").toDouble();
203 _dz = settings.value("trafo_dz").toDouble();
204 _dxr = settings.value("trafo_dxr").toDouble();
205 _dyr = settings.value("trafo_dyr").toDouble();
206 _dzr = settings.value("trafo_dzr").toDouble();
207 _ox = settings.value("trafo_ox").toDouble();
208 _oy = settings.value("trafo_oy").toDouble();
209 _oz = settings.value("trafo_oz").toDouble();
210 _oxr = settings.value("trafo_oxr").toDouble();
211 _oyr = settings.value("trafo_oyr").toDouble();
212 _ozr = settings.value("trafo_ozr").toDouble();
213 _sc = settings.value("trafo_sc").toDouble();
214 _scr = settings.value("trafo_scr").toDouble();
215 _t0 = settings.value("trafo_t0").toDouble();
216 }
217}
218
219// Destructor
220////////////////////////////////////////////////////////////////////////////
221bncRtnetUploadCaster::~bncRtnetUploadCaster() {
222 if (isRunning()) {
223 wait();
224 }
225 delete _rnx;
226 delete _sp3;
227 delete _ephUser;
228 delete _usedEph;
229}
230
231//
232////////////////////////////////////////////////////////////////////////////
233void bncRtnetUploadCaster::decodeRtnetStream(char* buffer, int bufLen) {
234
235 QMutexLocker locker(&_mutex);
236
237 // Append to internal buffer
238 // -------------------------
239 _rtnetStreamBuffer.append(QByteArray(buffer, bufLen));
240
241 // Select buffer part that contains last epoch
242 // -------------------------------------------
243 QStringList lines;
244 int iEpoBeg = _rtnetStreamBuffer.lastIndexOf('*'); // begin of last epoch
245 if (iEpoBeg == -1) {
246 _rtnetStreamBuffer.clear();
247 return;
248 }
249 int iEpoBegEarlier = _rtnetStreamBuffer.indexOf('*');
250 if (iEpoBegEarlier != -1 && iEpoBegEarlier < iEpoBeg) { // are there two epoch lines in buffer?
251 _rtnetStreamBuffer = _rtnetStreamBuffer.mid(iEpoBegEarlier);
252 }
253 else {
254 _rtnetStreamBuffer = _rtnetStreamBuffer.mid(iEpoBeg);
255 }
256
257 int iEpoEnd = _rtnetStreamBuffer.lastIndexOf("EOE"); // end of last epoch
258 if (iEpoEnd == -1) {
259 return;
260 }
261 else {
262 lines = _rtnetStreamBuffer.left(iEpoEnd).split('\n',
263 QString::SkipEmptyParts);
264 _rtnetStreamBuffer = _rtnetStreamBuffer.mid(iEpoEnd + 3);
265 }
266
267 if (lines.size() < 2) {
268 return;
269 }
270
271 // Read first line (with epoch time)
272 // ---------------------------------
273 QTextStream in(lines[0].toAscii());
274 QString hlp;
275 int year, month, day, hour, min;
276 double sec;
277 in >> hlp >> year >> month >> day >> hour >> min >> sec;
278 bncTime epoTime;
279 epoTime.set(year, month, day, hour, min, sec);
280
281 emit(newMessage(
282 "bncRtnetUploadCaster: decode " + QByteArray(epoTime.datestr().c_str())
283 + " " + QByteArray(epoTime.timestr().c_str()) + " "
284 + _casterID.toAscii(), false));
285
286 struct ClockOrbit co;
287 memset(&co, 0, sizeof(co));
288 co.EpochTime[CLOCKORBIT_SATGPS] = static_cast<int>(epoTime.gpssec());
289 double gt = epoTime.gpssec() + 3 * 3600 - gnumleap(year, month, day);
290 co.EpochTime[CLOCKORBIT_SATGLONASS] = static_cast<int>(fmod(gt, 86400.0));
291 co.EpochTime[CLOCKORBIT_SATGALILEO] = static_cast<int>(epoTime.gpssec());
292 co.EpochTime[CLOCKORBIT_SATQZSS] = static_cast<int>(epoTime.gpssec());
293 co.EpochTime[CLOCKORBIT_SATSBAS] = static_cast<int>(epoTime.gpssec());
294 co.EpochTime[CLOCKORBIT_SATBDS] = static_cast<int>(epoTime.bdssec());
295 co.Supplied[COBOFS_CLOCK] = 1;
296 co.Supplied[COBOFS_ORBIT] = 1;
297 co.SatRefDatum = DATUM_ITRF;
298 co.SSRIOD = _IOD;
299 co.SSRProviderID = _PID; // 256 .. BKG, 257 ... EUREF
300 co.SSRSolutionID = _SID;
301
302 struct CodeBias bias;
303 memset(&bias, 0, sizeof(bias));
304 bias.EpochTime[CLOCKORBIT_SATGPS] = co.EpochTime[CLOCKORBIT_SATGPS];
305 bias.EpochTime[CLOCKORBIT_SATGLONASS] = co.EpochTime[CLOCKORBIT_SATGLONASS];
306 bias.EpochTime[CLOCKORBIT_SATGALILEO] = co.EpochTime[CLOCKORBIT_SATGALILEO];
307 bias.EpochTime[CLOCKORBIT_SATQZSS] = co.EpochTime[CLOCKORBIT_SATQZSS];
308 bias.EpochTime[CLOCKORBIT_SATSBAS] = co.EpochTime[CLOCKORBIT_SATSBAS];
309 bias.EpochTime[CLOCKORBIT_SATBDS] = co.EpochTime[CLOCKORBIT_SATBDS];
310 bias.SSRIOD = _IOD;
311 bias.SSRProviderID = _PID;
312 bias.SSRSolutionID = _SID;
313
314 struct PhaseBias phasebias;
315 memset(&phasebias, 0, sizeof(phasebias));
316 unsigned int dispInd = 0;
317 unsigned int mwInd = 0;
318 phasebias.EpochTime[CLOCKORBIT_SATGPS] = co.EpochTime[CLOCKORBIT_SATGPS];
319 phasebias.EpochTime[CLOCKORBIT_SATGLONASS] = co.EpochTime[CLOCKORBIT_SATGLONASS];
320 phasebias.EpochTime[CLOCKORBIT_SATGALILEO] = co.EpochTime[CLOCKORBIT_SATGALILEO];
321 phasebias.EpochTime[CLOCKORBIT_SATQZSS] = co.EpochTime[CLOCKORBIT_SATQZSS];
322 phasebias.EpochTime[CLOCKORBIT_SATSBAS] = co.EpochTime[CLOCKORBIT_SATSBAS];
323 phasebias.EpochTime[CLOCKORBIT_SATBDS] = co.EpochTime[CLOCKORBIT_SATBDS];
324 phasebias.SSRIOD = _IOD;
325 phasebias.SSRProviderID = _PID;
326 phasebias.SSRSolutionID = _SID;
327
328 struct VTEC vtec;
329 memset(&vtec, 0, sizeof(vtec));
330 vtec.EpochTime = static_cast<int>(epoTime.gpssec());
331 vtec.SSRIOD = _IOD;
332 vtec.SSRProviderID = _PID;
333 vtec.SSRSolutionID = _SID;
334
335 // Default Update Interval
336 // -----------------------
337 int clkUpdInd = 2; // 5 sec
338 int ephUpdInd = clkUpdInd; // default
339
340 if (_samplRtcmClkCorr > 5.0 && _samplRtcmEphCorr <= 5.0) { // combined orb and clock
341 ephUpdInd = determineUpdateInd(_samplRtcmClkCorr);
342 }
343 if (_samplRtcmClkCorr > 5.0) {
344 clkUpdInd = determineUpdateInd(_samplRtcmClkCorr);
345 }
346 if (_samplRtcmEphCorr > 5.0) {
347 ephUpdInd = determineUpdateInd(_samplRtcmEphCorr);
348 }
349
350 co.UpdateInterval = clkUpdInd;
351 bias.UpdateInterval = clkUpdInd;
352 phasebias.UpdateInterval = clkUpdInd;
353
354 for (int ii = 1; ii < lines.size(); ii++) {
355 QString key; // prn or key VTEC, IND (phase bias indicators)
356 ColumnVector rtnAPC;
357 ColumnVector rtnVel;
358 ColumnVector rtnCoM;
359 double rtnClk;
360 t_prn prn;
361
362 QTextStream in(lines[ii].toAscii());
363
364 in >> key;
365
366 // non-satellite specific parameters
367 if (key.contains("IND", Qt::CaseSensitive)) {
368 in >> dispInd >> mwInd;
369 continue;
370 }
371 // non-satellite specific parameters
372 if (key.contains("VTEC", Qt::CaseSensitive)) {
373 double ui;
374 in >> ui >> vtec.NumLayers;
375 vtec.UpdateInterval = (unsigned int) determineUpdateInd(ui);
376 for (unsigned ll = 0; ll < vtec.NumLayers; ll++) {
377 int dummy;
378 in >> dummy >> vtec.Layers[ll].Degree >> vtec.Layers[ll].Order
379 >> vtec.Layers[ll].Height;
380 for (unsigned iDeg = 0; iDeg <= vtec.Layers[ll].Degree; iDeg++) {
381 for (unsigned iOrd = 0; iOrd <= vtec.Layers[ll].Order; iOrd++) {
382 in >> vtec.Layers[ll].Cosinus[iDeg][iOrd];
383 }
384 }
385 for (unsigned iDeg = 0; iDeg <= vtec.Layers[ll].Degree; iDeg++) {
386 for (unsigned iOrd = 0; iOrd <= vtec.Layers[ll].Order; iOrd++) {
387 in >> vtec.Layers[ll].Sinus[iDeg][iOrd];
388 }
389 }
390 }
391 continue;
392 }
393 // satellite specific parameters
394 char sys = key.mid(0, 1).at(0).toAscii();
395 int number = key.mid(1, 2).toInt();
396 int flags = 0;
397 if (sys == 'E') { // I/NAV
398 flags = 1;
399 }
400 prn.set(sys, number, flags);
401 QString prnInternalStr = QString::fromStdString(prn.toInternalString());
402 QString prnStr = QString::fromStdString(prn.toString());
403
404 const t_eph* ephLast = _ephUser->ephLast(prnInternalStr);
405 const t_eph* ephPrev = _ephUser->ephPrev(prnInternalStr);
406 const t_eph* eph = ephLast;
407 if (eph) {
408
409 // Use previous ephemeris if the last one is too recent
410 // ----------------------------------------------------
411 const int MINAGE = 60; // seconds
412 if (ephPrev && eph->receptDateTime().isValid()
413 && eph->receptDateTime().secsTo(currentDateAndTimeGPS()) < MINAGE) {
414 eph = ephPrev;
415 }
416
417 // Make sure the clock messages refer to same IOD as orbit messages
418 // ----------------------------------------------------------------
419 if (_usedEph) {
420 if (fmod(epoTime.gpssec(), _samplRtcmEphCorr) == 0.0) {
421 (*_usedEph)[prnInternalStr] = eph;
422 }
423 else {
424 eph = 0;
425 if (_usedEph->contains(prnInternalStr)) {
426 const t_eph* usedEph = _usedEph->value(prnInternalStr);
427 if (usedEph == ephLast) {
428 eph = ephLast;
429 }
430 else if (usedEph == ephPrev) {
431 eph = ephPrev;
432 }
433 }
434 }
435 }
436 }
437
438 if (eph) {
439
440 QMap<QString, double> codeBiases;
441 QList<phaseBiasSignal> phaseBiasList;
442 phaseBiasesSat pbSat;
443
444 while (true) {
445 QString key;
446 int numVal = 0;
447 in >> key;
448 if (in.status() != QTextStream::Ok) {
449 break;
450 }
451 if (key == "APC") {
452 in >> numVal;
453 rtnAPC.ReSize(3);
454 for (int ii = 0; ii < numVal; ii++) {
455 in >> rtnAPC[ii];
456 }
457 }
458 else if (key == "Clk") {
459 in >> numVal;
460 if (numVal == 1)
461 in >> rtnClk;
462 }
463 else if (key == "Vel") {
464 rtnVel.ReSize(3);
465 in >> numVal;
466 for (int ii = 0; ii < numVal; ii++) {
467 in >> rtnVel[ii];
468 }
469 }
470 else if (key == "CoM") {
471 rtnCoM.ReSize(3);
472 in >> numVal;
473 for (int ii = 0; ii < numVal; ii++) {
474 in >> rtnCoM[ii];
475 }
476 }
477 else if (key == "CodeBias") {
478 in >> numVal;
479 for (int ii = 0; ii < numVal; ii++) {
480 QString type;
481 double value;
482 in >> type >> value;
483 codeBiases[type] = value;
484 }
485 }
486 else if (key == "YawAngle") {
487 in >> numVal >> pbSat.yA;
488 if (pbSat.yA < 0.0) {
489 pbSat.yA += (2*M_PI);
490 }
491 else if (pbSat.yA > 2*M_PI) {
492 pbSat.yA -= (2*M_PI);
493 }
494 }
495 else if (key == "YawRate") {
496 in >> numVal >> pbSat.yR;
497 }
498 else if (key == "PhaseBias") {
499 in >> numVal;
500 for (int ii = 0; ii < numVal; ii++) {
501 phaseBiasSignal pb;
502 in >> pb.type >> pb.bias >> pb.intInd >> pb.wlInd >> pb.discCount;
503 phaseBiasList.append(pb);
504 }
505 }
506 else {
507 for (int ii = 0; ii < numVal; ii++) {
508 double dummy;
509 in >> dummy;
510 }
511 }
512 }
513
514 struct ClockOrbit::SatData* sd = 0;
515 if (prn.system() == 'G') {
516 sd = co.Sat + co.NumberOfSat[CLOCKORBIT_SATGPS];
517 ++co.NumberOfSat[CLOCKORBIT_SATGPS];
518 }
519 else if (prn.system() == 'R') {
520 sd = co.Sat + CLOCKORBIT_NUMGPS + co.NumberOfSat[CLOCKORBIT_SATGLONASS];
521 ++co.NumberOfSat[CLOCKORBIT_SATGLONASS];
522 }
523 else if (prn.system() == 'E') {
524 sd = co.Sat + CLOCKORBIT_NUMGPS + CLOCKORBIT_NUMGLONASS
525 + co.NumberOfSat[CLOCKORBIT_SATGALILEO];
526 ++co.NumberOfSat[CLOCKORBIT_SATGALILEO];
527 }
528 else if (prn.system() == 'J') {
529 sd = co.Sat + CLOCKORBIT_NUMGPS + CLOCKORBIT_NUMGLONASS
530 + CLOCKORBIT_NUMGALILEO + co.NumberOfSat[CLOCKORBIT_SATQZSS];
531 ++co.NumberOfSat[CLOCKORBIT_SATQZSS];
532 }
533 else if (prn.system() == 'S') {
534 sd = co.Sat + CLOCKORBIT_NUMGPS + CLOCKORBIT_NUMGLONASS
535 + CLOCKORBIT_NUMGALILEO + CLOCKORBIT_NUMQZSS
536 + co.NumberOfSat[CLOCKORBIT_SATSBAS];
537 ++co.NumberOfSat[CLOCKORBIT_SATSBAS];
538 }
539 else if (prn.system() == 'C') {
540 sd = co.Sat + CLOCKORBIT_NUMGPS + CLOCKORBIT_NUMGLONASS
541 + CLOCKORBIT_NUMGALILEO + CLOCKORBIT_NUMQZSS + CLOCKORBIT_NUMSBAS
542 + co.NumberOfSat[CLOCKORBIT_SATBDS];
543 ++co.NumberOfSat[CLOCKORBIT_SATBDS];
544 }
545 if (sd) {
546 QString outLine;
547 processSatellite(eph, epoTime.gpsw(), epoTime.gpssec(), prnStr, rtnAPC,
548 rtnClk, rtnVel, rtnCoM, sd, outLine);
549 }
550
551 // Code Biases
552 // -----------
553 struct CodeBias::BiasSat* biasSat = 0;
554 if (!codeBiases.isEmpty()) {
555 if (prn.system() == 'G') {
556 biasSat = bias.Sat + bias.NumberOfSat[CLOCKORBIT_SATGPS];
557 ++bias.NumberOfSat[CLOCKORBIT_SATGPS];
558 }
559 else if (prn.system() == 'R') {
560 biasSat = bias.Sat + CLOCKORBIT_NUMGPS
561 + bias.NumberOfSat[CLOCKORBIT_SATGLONASS];
562 ++bias.NumberOfSat[CLOCKORBIT_SATGLONASS];
563 }
564 else if (prn.system() == 'E') {
565 biasSat = bias.Sat + CLOCKORBIT_NUMGPS + CLOCKORBIT_NUMGLONASS
566 + bias.NumberOfSat[CLOCKORBIT_SATGALILEO];
567 ++bias.NumberOfSat[CLOCKORBIT_SATGALILEO];
568 }
569 else if (prn.system() == 'J') {
570 biasSat = bias.Sat + CLOCKORBIT_NUMGPS + CLOCKORBIT_NUMGLONASS
571 + CLOCKORBIT_NUMGALILEO + bias.NumberOfSat[CLOCKORBIT_SATQZSS];
572 ++bias.NumberOfSat[CLOCKORBIT_SATQZSS];
573 }
574 else if (prn.system() == 'S') {
575 biasSat = bias.Sat + CLOCKORBIT_NUMGPS + CLOCKORBIT_NUMGLONASS
576 + CLOCKORBIT_NUMGALILEO + CLOCKORBIT_NUMQZSS
577 + bias.NumberOfSat[CLOCKORBIT_SATSBAS];
578 ++bias.NumberOfSat[CLOCKORBIT_SATSBAS];
579 }
580 else if (prn.system() == 'C') {
581 biasSat = bias.Sat + CLOCKORBIT_NUMGPS + CLOCKORBIT_NUMGLONASS
582 + CLOCKORBIT_NUMGALILEO + CLOCKORBIT_NUMQZSS + CLOCKORBIT_NUMSBAS
583 + bias.NumberOfSat[CLOCKORBIT_SATBDS];
584 ++bias.NumberOfSat[CLOCKORBIT_SATBDS];
585 }
586 }
587
588 if (biasSat) {
589 biasSat->ID = prn.number();
590 biasSat->NumberOfCodeBiases = 0;
591 if (prn.system() == 'G') {
592 QMapIterator<QString, double> it(codeBiases);
593 while (it.hasNext()) {
594 it.next();
595 if (it.key() == "1C") {
596 int ii = biasSat->NumberOfCodeBiases;
597 if (ii >= CLOCKORBIT_NUMBIAS)
598 break;
599 biasSat->NumberOfCodeBiases += 1;
600 biasSat->Biases[ii].Type = CODETYPEGPS_L1_CA;
601 biasSat->Biases[ii].Bias = it.value();
602 }
603 else if (it.key() == "1P") {
604 int ii = biasSat->NumberOfCodeBiases;
605 if (ii >= CLOCKORBIT_NUMBIAS)
606 break;
607 biasSat->NumberOfCodeBiases += 1;
608 biasSat->Biases[ii].Type = CODETYPEGPS_L1_P;
609 biasSat->Biases[ii].Bias = it.value();
610 }
611 else if (it.key() == "1W") {
612 int ii = biasSat->NumberOfCodeBiases;
613 if (ii >= CLOCKORBIT_NUMBIAS)
614 break;
615 biasSat->NumberOfCodeBiases += 1;
616 biasSat->Biases[ii].Type = CODETYPEGPS_L1_Z;
617 biasSat->Biases[ii].Bias = it.value();
618 }
619 else if (it.key() == "2C") {
620 int ii = biasSat->NumberOfCodeBiases;
621 if (ii >= CLOCKORBIT_NUMBIAS)
622 break;
623 biasSat->NumberOfCodeBiases += 1;
624 biasSat->Biases[ii].Type = CODETYPEGPS_L2_CA;
625 biasSat->Biases[ii].Bias = it.value();
626 }
627 else if (it.key() == "2D") {
628 int ii = biasSat->NumberOfCodeBiases;
629 if (ii >= CLOCKORBIT_NUMBIAS)
630 break;
631 biasSat->NumberOfCodeBiases += 1;
632 biasSat->Biases[ii].Type = CODETYPEGPS_SEMI_CODELESS;
633 biasSat->Biases[ii].Bias = it.value();
634 }
635 else if (it.key() == "2S") {
636 int ii = biasSat->NumberOfCodeBiases;
637 if (ii >= CLOCKORBIT_NUMBIAS)
638 break;
639 biasSat->NumberOfCodeBiases += 1;
640 biasSat->Biases[ii].Type = CODETYPEGPS_L2_CM;
641 biasSat->Biases[ii].Bias = it.value();
642 }
643 else if (it.key() == "2L") {
644 int ii = biasSat->NumberOfCodeBiases;
645 if (ii >= CLOCKORBIT_NUMBIAS)
646 break;
647 biasSat->NumberOfCodeBiases += 1;
648 biasSat->Biases[ii].Type = CODETYPEGPS_L2_CL;
649 biasSat->Biases[ii].Bias = it.value();
650 }
651 else if (it.key() == "2X") {
652 int ii = biasSat->NumberOfCodeBiases;
653 if (ii >= CLOCKORBIT_NUMBIAS)
654 break;
655 biasSat->NumberOfCodeBiases += 1;
656 biasSat->Biases[ii].Type = CODETYPEGPS_L2_CML;
657 biasSat->Biases[ii].Bias = it.value();
658 }
659 else if (it.key() == "2P") {
660 int ii = biasSat->NumberOfCodeBiases;
661 if (ii >= CLOCKORBIT_NUMBIAS)
662 break;
663 biasSat->NumberOfCodeBiases += 1;
664 biasSat->Biases[ii].Type = CODETYPEGPS_L2_P;
665 biasSat->Biases[ii].Bias = it.value();
666 }
667 else if (it.key() == "2W") {
668 int ii = biasSat->NumberOfCodeBiases;
669 if (ii >= CLOCKORBIT_NUMBIAS)
670 break;
671 biasSat->NumberOfCodeBiases += 1;
672 biasSat->Biases[ii].Type = CODETYPEGPS_L2_Z;
673 biasSat->Biases[ii].Bias = it.value();
674 }
675 else if (it.key() == "5I") {
676 int ii = biasSat->NumberOfCodeBiases;
677 if (ii >= CLOCKORBIT_NUMBIAS)
678 break;
679 biasSat->NumberOfCodeBiases += 1;
680 biasSat->Biases[ii].Type = CODETYPEGPS_L5_I;
681 biasSat->Biases[ii].Bias = it.value();
682 }
683 else if (it.key() == "5Q") {
684 int ii = biasSat->NumberOfCodeBiases;
685 if (ii >= CLOCKORBIT_NUMBIAS)
686 break;
687 biasSat->NumberOfCodeBiases += 1;
688 biasSat->Biases[ii].Type = CODETYPEGPS_L5_Q;
689 biasSat->Biases[ii].Bias = it.value();
690 }
691 else if (it.key() == "5X") {
692 int ii = biasSat->NumberOfCodeBiases;
693 if (ii >= CLOCKORBIT_NUMBIAS)
694 break;
695 biasSat->NumberOfCodeBiases += 1;
696 biasSat->Biases[ii].Type = CODETYPEGPS_L5_IQ;
697 biasSat->Biases[ii].Bias = it.value();
698 }
699 }
700 }
701 else if (prn.system() == 'R') {
702 QMapIterator<QString, double> it(codeBiases);
703 while (it.hasNext()) {
704 it.next();
705 if (it.key() == "1C") {
706 int ii = biasSat->NumberOfCodeBiases;
707 if (ii >= CLOCKORBIT_NUMBIAS)
708 break;
709 biasSat->NumberOfCodeBiases += 1;
710 biasSat->Biases[ii].Type = CODETYPEGLONASS_L1_CA;
711 biasSat->Biases[ii].Bias = it.value();
712 }
713 else if (it.key() == "1P") {
714 int ii = biasSat->NumberOfCodeBiases;
715 if (ii >= CLOCKORBIT_NUMBIAS)
716 break;
717 biasSat->NumberOfCodeBiases += 1;
718 biasSat->Biases[ii].Type = CODETYPEGLONASS_L1_P;
719 biasSat->Biases[ii].Bias = it.value();
720 }
721 else if (it.key() == "2C") {
722 int ii = biasSat->NumberOfCodeBiases;
723 if (ii >= CLOCKORBIT_NUMBIAS)
724 break;
725 biasSat->NumberOfCodeBiases += 1;
726 biasSat->Biases[ii].Type = CODETYPEGLONASS_L2_CA;
727 biasSat->Biases[ii].Bias = it.value();
728 }
729 else if (it.key() == "2P") {
730 int ii = biasSat->NumberOfCodeBiases;
731 if (ii >= CLOCKORBIT_NUMBIAS)
732 break;
733 biasSat->NumberOfCodeBiases += 1;
734 biasSat->Biases[ii].Type = CODETYPEGLONASS_L2_P;
735 biasSat->Biases[ii].Bias = it.value();
736 }
737 }
738 }
739 else if (prn.system() == 'E') {
740 QMapIterator<QString, double> it(codeBiases);
741 while (it.hasNext()) {
742 it.next();
743 if (it.key() == "1A") {
744 int ii = biasSat->NumberOfCodeBiases;
745 if (ii >= CLOCKORBIT_NUMBIAS)
746 break;
747 biasSat->NumberOfCodeBiases += 1;
748 biasSat->Biases[ii].Type = CODETYPEGALILEO_E1_A;
749 biasSat->Biases[ii].Bias = it.value();
750 }
751 else if (it.key() == "1B") {
752 int ii = biasSat->NumberOfCodeBiases;
753 if (ii >= CLOCKORBIT_NUMBIAS)
754 break;
755 biasSat->NumberOfCodeBiases += 1;
756 biasSat->Biases[ii].Type = CODETYPEGALILEO_E1_B;
757 biasSat->Biases[ii].Bias = it.value();
758 }
759 else if (it.key() == "1C") {
760 int ii = biasSat->NumberOfCodeBiases;
761 if (ii >= CLOCKORBIT_NUMBIAS)
762 break;
763 biasSat->NumberOfCodeBiases += 1;
764 biasSat->Biases[ii].Type = CODETYPEGALILEO_E1_C;
765 biasSat->Biases[ii].Bias = it.value();
766 }
767 else if (it.key() == "5I") {
768 int ii = biasSat->NumberOfCodeBiases;
769 if (ii >= CLOCKORBIT_NUMBIAS)
770 break;
771 biasSat->NumberOfCodeBiases += 1;
772 biasSat->Biases[ii].Type = CODETYPEGALILEO_E5A_I;
773 biasSat->Biases[ii].Bias = it.value();
774 }
775 else if (it.key() == "5Q") {
776 int ii = biasSat->NumberOfCodeBiases;
777 if (ii >= CLOCKORBIT_NUMBIAS)
778 break;
779 biasSat->NumberOfCodeBiases += 1;
780 biasSat->Biases[ii].Type = CODETYPEGALILEO_E5A_Q;
781 biasSat->Biases[ii].Bias = it.value();
782 }
783 else if (it.key() == "7I") {
784 int ii = biasSat->NumberOfCodeBiases;
785 if (ii >= CLOCKORBIT_NUMBIAS)
786 break;
787 biasSat->NumberOfCodeBiases += 1;
788 biasSat->Biases[ii].Type = CODETYPEGALILEO_E5B_I;
789 biasSat->Biases[ii].Bias = it.value();
790 }
791 else if (it.key() == "7Q") {
792 int ii = biasSat->NumberOfCodeBiases;
793 if (ii >= CLOCKORBIT_NUMBIAS)
794 break;
795 biasSat->NumberOfCodeBiases += 1;
796 biasSat->Biases[ii].Type = CODETYPEGALILEO_E5B_Q;
797 biasSat->Biases[ii].Bias = it.value();
798 }
799 else if (it.key() == "8I") {
800 int ii = biasSat->NumberOfCodeBiases;
801 if (ii >= CLOCKORBIT_NUMBIAS)
802 break;
803 biasSat->NumberOfCodeBiases += 1;
804 biasSat->Biases[ii].Type = CODETYPEGALILEO_E5_I;
805 biasSat->Biases[ii].Bias = it.value();
806 }
807 else if (it.key() == "8Q") {
808 int ii = biasSat->NumberOfCodeBiases;
809 if (ii >= CLOCKORBIT_NUMBIAS)
810 break;
811 biasSat->NumberOfCodeBiases += 1;
812 biasSat->Biases[ii].Type = CODETYPEGALILEO_E5_Q;
813 biasSat->Biases[ii].Bias = it.value();
814 }
815 else if (it.key() == "6A") {
816 int ii = biasSat->NumberOfCodeBiases;
817 if (ii >= CLOCKORBIT_NUMBIAS)
818 break;
819 biasSat->NumberOfCodeBiases += 1;
820 biasSat->Biases[ii].Type = CODETYPEGALILEO_E6_A;
821 biasSat->Biases[ii].Bias = it.value();
822 }
823 else if (it.key() == "6B") {
824 int ii = biasSat->NumberOfCodeBiases;
825 if (ii >= CLOCKORBIT_NUMBIAS)
826 break;
827 biasSat->NumberOfCodeBiases += 1;
828 biasSat->Biases[ii].Type = CODETYPEGALILEO_E6_B;
829 biasSat->Biases[ii].Bias = it.value();
830 }
831 else if (it.key() == "6C") {
832 int ii = biasSat->NumberOfCodeBiases;
833 if (ii >= CLOCKORBIT_NUMBIAS)
834 break;
835 biasSat->NumberOfCodeBiases += 1;
836 biasSat->Biases[ii].Type = CODETYPEGALILEO_E6_C;
837 biasSat->Biases[ii].Bias = it.value();
838 }
839 }
840 }
841 else if (prn.system() == 'J') {
842 QMapIterator<QString, double> it(codeBiases);
843 while (it.hasNext()) {
844 it.next();
845 if (it.key() == "1C") {
846 int ii = biasSat->NumberOfCodeBiases;
847 if (ii >= CLOCKORBIT_NUMBIAS)
848 break;
849 biasSat->NumberOfCodeBiases += 1;
850 biasSat->Biases[ii].Type = CODETYPEQZSS_L1_CA;
851 biasSat->Biases[ii].Bias = it.value();
852 }
853 else if (it.key() == "1S") {
854 int ii = biasSat->NumberOfCodeBiases;
855 if (ii >= CLOCKORBIT_NUMBIAS)
856 break;
857 biasSat->NumberOfCodeBiases += 1;
858 biasSat->Biases[ii].Type = CODETYPEQZSS_L1C_D;
859 biasSat->Biases[ii].Bias = it.value();
860 }
861 else if (it.key() == "1L") {
862 int ii = biasSat->NumberOfCodeBiases;
863 if (ii >= CLOCKORBIT_NUMBIAS)
864 break;
865 biasSat->NumberOfCodeBiases += 1;
866 biasSat->Biases[ii].Type = CODETYPEQZSS_L1C_P;
867 biasSat->Biases[ii].Bias = it.value();
868 }
869 else if (it.key() == "1X") {
870 int ii = biasSat->NumberOfCodeBiases;
871 if (ii >= CLOCKORBIT_NUMBIAS)
872 break;
873 biasSat->NumberOfCodeBiases += 1;
874 biasSat->Biases[ii].Type = CODETYPEQZSS_L1C_DP;
875 biasSat->Biases[ii].Bias = it.value();
876 }
877 else if (it.key() == "2S") {
878 int ii = biasSat->NumberOfCodeBiases;
879 if (ii >= CLOCKORBIT_NUMBIAS)
880 break;
881 biasSat->NumberOfCodeBiases += 1;
882 biasSat->Biases[ii].Type = CODETYPEQZSS_L2_CM;
883 biasSat->Biases[ii].Bias = it.value();
884 }
885 else if (it.key() == "2L") {
886 int ii = biasSat->NumberOfCodeBiases;
887 if (ii >= CLOCKORBIT_NUMBIAS)
888 break;
889 biasSat->NumberOfCodeBiases += 1;
890 biasSat->Biases[ii].Type = CODETYPEQZSS_L2_CL;
891 biasSat->Biases[ii].Bias = it.value();
892 }
893 else if (it.key() == "2X") {
894 int ii = biasSat->NumberOfCodeBiases;
895 if (ii >= CLOCKORBIT_NUMBIAS)
896 break;
897 biasSat->NumberOfCodeBiases += 1;
898 biasSat->Biases[ii].Type = CODETYPEQZSS_L2_CML;
899 biasSat->Biases[ii].Bias = it.value();
900 }
901 else if (it.key() == "5I") {
902 int ii = biasSat->NumberOfCodeBiases;
903 if (ii >= CLOCKORBIT_NUMBIAS)
904 break;
905 biasSat->NumberOfCodeBiases += 1;
906 biasSat->Biases[ii].Type = CODETYPEQZSS_L5_I;
907 biasSat->Biases[ii].Bias = it.value();
908 }
909 else if (it.key() == "5Q") {
910 int ii = biasSat->NumberOfCodeBiases;
911 if (ii >= CLOCKORBIT_NUMBIAS)
912 break;
913 biasSat->NumberOfCodeBiases += 1;
914 biasSat->Biases[ii].Type = CODETYPEQZSS_L5_Q;
915 biasSat->Biases[ii].Bias = it.value();
916 }
917 else if (it.key() == "5X") {
918 int ii = biasSat->NumberOfCodeBiases;
919 if (ii >= CLOCKORBIT_NUMBIAS)
920 break;
921 biasSat->NumberOfCodeBiases += 1;
922 biasSat->Biases[ii].Type = CODETYPEQZSS_L5_IQ;
923 biasSat->Biases[ii].Bias = it.value();
924 }
925 else if (it.key() == "6S") {
926 int ii = biasSat->NumberOfCodeBiases;
927 if (ii >= CLOCKORBIT_NUMBIAS)
928 break;
929 biasSat->NumberOfCodeBiases += 1;
930 biasSat->Biases[ii].Type = CODETYPEQZSS_LEX_S;
931 biasSat->Biases[ii].Bias = it.value();
932 }
933 else if (it.key() == "6L") {
934 int ii = biasSat->NumberOfCodeBiases;
935 if (ii >= CLOCKORBIT_NUMBIAS)
936 break;
937 biasSat->NumberOfCodeBiases += 1;
938 biasSat->Biases[ii].Type = CODETYPEQZSS_LEX_L;
939 biasSat->Biases[ii].Bias = it.value();
940 }
941 else if (it.key() == "6X") {
942 int ii = biasSat->NumberOfCodeBiases;
943 if (ii >= CLOCKORBIT_NUMBIAS)
944 break;
945 biasSat->NumberOfCodeBiases += 1;
946 biasSat->Biases[ii].Type = CODETYPEQZSS_LEX_SL;
947 biasSat->Biases[ii].Bias = it.value();
948 }
949 }
950 }
951 else if (prn.system() == 'S') {
952 QMapIterator<QString, double> it(codeBiases);
953 while (it.hasNext()) {
954 it.next();
955 if (it.key() == "1C") {
956 int ii = biasSat->NumberOfCodeBiases;
957 if (ii >= CLOCKORBIT_NUMBIAS)
958 break;
959 biasSat->NumberOfCodeBiases += 1;
960 biasSat->Biases[ii].Type = CODETYPE_SBAS_L1_CA;
961 biasSat->Biases[ii].Bias = it.value();
962 }
963 else if (it.key() == "5I") {
964 int ii = biasSat->NumberOfCodeBiases;
965 if (ii >= CLOCKORBIT_NUMBIAS)
966 break;
967 biasSat->NumberOfCodeBiases += 1;
968 biasSat->Biases[ii].Type = CODETYPE_SBAS_L5_I;
969 biasSat->Biases[ii].Bias = it.value();
970 }
971 else if (it.key() == "5Q") {
972 int ii = biasSat->NumberOfCodeBiases;
973 if (ii >= CLOCKORBIT_NUMBIAS)
974 break;
975 biasSat->NumberOfCodeBiases += 1;
976 biasSat->Biases[ii].Type = CODETYPE_SBAS_L5_Q;
977 biasSat->Biases[ii].Bias = it.value();
978 }
979 else if (it.key() == "5X") {
980 int ii = biasSat->NumberOfCodeBiases;
981 if (ii >= CLOCKORBIT_NUMBIAS)
982 break;
983 biasSat->NumberOfCodeBiases += 1;
984 biasSat->Biases[ii].Type = CODETYPE_SBAS_L5_IQ;
985 biasSat->Biases[ii].Bias = it.value();
986 }
987 }
988 }
989 else if (prn.system() == 'C') {
990 QMapIterator<QString, double> it(codeBiases);
991 while (it.hasNext()) {
992 it.next();
993 if (it.key() == "2I") {
994 int ii = biasSat->NumberOfCodeBiases;
995 if (ii >= CLOCKORBIT_NUMBIAS)
996 break;
997 biasSat->NumberOfCodeBiases += 1;
998 biasSat->Biases[ii].Type = CODETYPE_BDS_B1_I;
999 biasSat->Biases[ii].Bias = it.value();
1000 }
1001 else if (it.key() == "2Q") {
1002 int ii = biasSat->NumberOfCodeBiases;
1003 if (ii >= CLOCKORBIT_NUMBIAS)
1004 break;
1005 biasSat->NumberOfCodeBiases += 1;
1006 biasSat->Biases[ii].Type = CODETYPE_BDS_B1_Q;
1007 biasSat->Biases[ii].Bias = it.value();
1008 }
1009 else if (it.key() == "2X") {
1010 int ii = biasSat->NumberOfCodeBiases;
1011 if (ii >= CLOCKORBIT_NUMBIAS)
1012 break;
1013 biasSat->NumberOfCodeBiases += 1;
1014 biasSat->Biases[ii].Type = CODETYPE_BDS_B1_IQ;
1015 biasSat->Biases[ii].Bias = it.value();
1016 }
1017 else if (it.key() == "6I") {
1018 int ii = biasSat->NumberOfCodeBiases;
1019 if (ii >= CLOCKORBIT_NUMBIAS)
1020 break;
1021 biasSat->NumberOfCodeBiases += 1;
1022 biasSat->Biases[ii].Type = CODETYPE_BDS_B3_I;
1023 biasSat->Biases[ii].Bias = it.value();
1024 }
1025 else if (it.key() == "6Q") {
1026 int ii = biasSat->NumberOfCodeBiases;
1027 if (ii >= CLOCKORBIT_NUMBIAS)
1028 break;
1029 biasSat->NumberOfCodeBiases += 1;
1030 biasSat->Biases[ii].Type = CODETYPE_BDS_B3_Q;
1031 biasSat->Biases[ii].Bias = it.value();
1032 }
1033 else if (it.key() == "6X") {
1034 int ii = biasSat->NumberOfCodeBiases;
1035 if (ii >= CLOCKORBIT_NUMBIAS)
1036 break;
1037 biasSat->NumberOfCodeBiases += 1;
1038 biasSat->Biases[ii].Type = CODETYPE_BDS_B3_IQ;
1039 biasSat->Biases[ii].Bias = it.value();
1040 }
1041 else if (it.key() == "7I") {
1042 int ii = biasSat->NumberOfCodeBiases;
1043 if (ii >= CLOCKORBIT_NUMBIAS)
1044 break;
1045 biasSat->NumberOfCodeBiases += 1;
1046 biasSat->Biases[ii].Type = CODETYPE_BDS_B2_I;
1047 biasSat->Biases[ii].Bias = it.value();
1048 }
1049 else if (it.key() == "7Q") {
1050 int ii = biasSat->NumberOfCodeBiases;
1051 if (ii >= CLOCKORBIT_NUMBIAS)
1052 break;
1053 biasSat->NumberOfCodeBiases += 1;
1054 biasSat->Biases[ii].Type = CODETYPE_BDS_B2_Q;
1055 biasSat->Biases[ii].Bias = it.value();
1056 }
1057 else if (it.key() == "7X") {
1058 int ii = biasSat->NumberOfCodeBiases;
1059 if (ii >= CLOCKORBIT_NUMBIAS)
1060 break;
1061 biasSat->NumberOfCodeBiases += 1;
1062 biasSat->Biases[ii].Type = CODETYPE_BDS_B2_IQ;
1063 biasSat->Biases[ii].Bias = it.value();
1064 }
1065 }
1066 }
1067 }
1068 // Phase Biases
1069 // ------------
1070 struct PhaseBias::PhaseBiasSat* phasebiasSat = 0;
1071 if (!phaseBiasList.isEmpty()) {
1072 if (prn.system() == 'G') {
1073 phasebiasSat = phasebias.Sat
1074 + phasebias.NumberOfSat[CLOCKORBIT_SATGPS];
1075 ++phasebias.NumberOfSat[CLOCKORBIT_SATGPS];
1076 }
1077 else if (prn.system() == 'R') {
1078 phasebiasSat = phasebias.Sat + CLOCKORBIT_NUMGPS
1079 + phasebias.NumberOfSat[CLOCKORBIT_SATGLONASS];
1080 ++phasebias.NumberOfSat[CLOCKORBIT_SATGLONASS];
1081 }
1082 else if (prn.system() == 'E') {
1083 phasebiasSat = phasebias.Sat + CLOCKORBIT_NUMGPS
1084 + CLOCKORBIT_NUMGLONASS
1085 + phasebias.NumberOfSat[CLOCKORBIT_SATGALILEO];
1086 ++phasebias.NumberOfSat[CLOCKORBIT_SATGALILEO];
1087 }
1088 else if (prn.system() == 'J') {
1089 phasebiasSat = phasebias.Sat + CLOCKORBIT_NUMGPS
1090 + CLOCKORBIT_NUMGLONASS + CLOCKORBIT_NUMGALILEO
1091 + phasebias.NumberOfSat[CLOCKORBIT_SATQZSS];
1092 ++phasebias.NumberOfSat[CLOCKORBIT_SATQZSS];
1093 }
1094 else if (prn.system() == 'S') {
1095 phasebiasSat = phasebias.Sat + CLOCKORBIT_NUMGPS
1096 + CLOCKORBIT_NUMGLONASS + CLOCKORBIT_NUMGALILEO
1097 + CLOCKORBIT_NUMQZSS + phasebias.NumberOfSat[CLOCKORBIT_SATSBAS];
1098 ++phasebias.NumberOfSat[CLOCKORBIT_SATSBAS];
1099 }
1100 else if (prn.system() == 'C') {
1101 phasebiasSat = phasebias.Sat + CLOCKORBIT_NUMGPS
1102 + CLOCKORBIT_NUMGLONASS + CLOCKORBIT_NUMGALILEO
1103 + CLOCKORBIT_NUMQZSS + CLOCKORBIT_NUMSBAS
1104 + phasebias.NumberOfSat[CLOCKORBIT_SATBDS];
1105 ++phasebias.NumberOfSat[CLOCKORBIT_SATBDS];
1106 }
1107 }
1108
1109 if (phasebiasSat) {
1110 phasebias.DispersiveBiasConsistencyIndicator = dispInd;
1111 phasebias.MWConsistencyIndicator = mwInd;
1112 phasebiasSat->ID = prn.number();
1113 phasebiasSat->NumberOfPhaseBiases = 0;
1114 phasebiasSat->YawAngle = pbSat.yA;
1115 phasebiasSat->YawRate = pbSat.yR;
1116 if (prn.system() == 'G') {
1117 QListIterator<phaseBiasSignal> it(phaseBiasList);
1118 while (it.hasNext()) {
1119 const phaseBiasSignal &pbSig = it.next();
1120 if (pbSig.type == "1C") {
1121 int ii = phasebiasSat->NumberOfPhaseBiases;
1122 if (ii >= CLOCKORBIT_NUMBIAS)
1123 break;
1124 phasebiasSat->NumberOfPhaseBiases += 1;
1125 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L1_CA;
1126 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1127 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1128 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1129 pbSig.wlInd;
1130 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1131 pbSig.discCount;
1132 }
1133 else if (pbSig.type == "1P") {
1134 int ii = phasebiasSat->NumberOfPhaseBiases;
1135 if (ii >= CLOCKORBIT_NUMBIAS)
1136 break;
1137 phasebiasSat->NumberOfPhaseBiases += 1;
1138 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L1_P;
1139 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1140 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1141 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1142 pbSig.wlInd;
1143 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1144 pbSig.discCount;
1145 }
1146 else if (pbSig.type == "1W") {
1147 int ii = phasebiasSat->NumberOfPhaseBiases;
1148 if (ii >= CLOCKORBIT_NUMBIAS)
1149 break;
1150 phasebiasSat->NumberOfPhaseBiases += 1;
1151 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L1_Z;
1152 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1153 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1154 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1155 pbSig.wlInd;
1156 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1157 pbSig.discCount;
1158 }
1159 else if (pbSig.type == "2C") {
1160 int ii = phasebiasSat->NumberOfPhaseBiases;
1161 if (ii >= CLOCKORBIT_NUMBIAS)
1162 break;
1163 phasebiasSat->NumberOfPhaseBiases += 1;
1164 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L2_CA;
1165 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1166 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1167 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1168 pbSig.wlInd;
1169 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1170 pbSig.discCount;
1171 }
1172 else if (pbSig.type == "2D") {
1173 int ii = phasebiasSat->NumberOfPhaseBiases;
1174 if (ii >= CLOCKORBIT_NUMBIAS)
1175 break;
1176 phasebiasSat->NumberOfPhaseBiases += 1;
1177 phasebiasSat->Biases[ii].Type = CODETYPEGPS_SEMI_CODELESS;
1178 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1179 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1180 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1181 pbSig.wlInd;
1182 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1183 pbSig.discCount;
1184 }
1185 else if (pbSig.type == "2S") {
1186 int ii = phasebiasSat->NumberOfPhaseBiases;
1187 if (ii >= CLOCKORBIT_NUMBIAS)
1188 break;
1189 phasebiasSat->NumberOfPhaseBiases += 1;
1190 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L2_CM;
1191 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1192 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1193 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1194 pbSig.wlInd;
1195 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1196 pbSig.discCount;
1197 }
1198 else if (pbSig.type == "2L") {
1199 int ii = phasebiasSat->NumberOfPhaseBiases;
1200 if (ii >= CLOCKORBIT_NUMBIAS)
1201 break;
1202 phasebiasSat->NumberOfPhaseBiases += 1;
1203 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L2_CL;
1204 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1205 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1206 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1207 pbSig.wlInd;
1208 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1209 pbSig.discCount;
1210 }
1211 else if (pbSig.type == "2X") {
1212 int ii = phasebiasSat->NumberOfPhaseBiases;
1213 if (ii >= CLOCKORBIT_NUMBIAS)
1214 break;
1215 phasebiasSat->NumberOfPhaseBiases += 1;
1216 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L2_CML;
1217 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1218 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1219 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1220 pbSig.wlInd;
1221 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1222 pbSig.discCount;
1223 }
1224 else if (pbSig.type == "2P") {
1225 int ii = phasebiasSat->NumberOfPhaseBiases;
1226 if (ii >= CLOCKORBIT_NUMBIAS)
1227 break;
1228 phasebiasSat->NumberOfPhaseBiases += 1;
1229 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L2_P;
1230 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1231 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1232 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1233 pbSig.wlInd;
1234 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1235 pbSig.discCount;
1236 }
1237 else if (pbSig.type == "2W") {
1238 int ii = phasebiasSat->NumberOfPhaseBiases;
1239 if (ii >= CLOCKORBIT_NUMBIAS)
1240 break;
1241 phasebiasSat->NumberOfPhaseBiases += 1;
1242 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L2_Z;
1243 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1244 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1245 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1246 pbSig.wlInd;
1247 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1248 pbSig.discCount;
1249 }
1250 else if (pbSig.type == "5I") {
1251 int ii = phasebiasSat->NumberOfPhaseBiases;
1252 if (ii >= CLOCKORBIT_NUMBIAS)
1253 break;
1254 phasebiasSat->NumberOfPhaseBiases += 1;
1255 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L5_I;
1256 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1257 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1258 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1259 pbSig.wlInd;
1260 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1261 pbSig.discCount;
1262 }
1263 else if (pbSig.type == "5Q") {
1264 int ii = phasebiasSat->NumberOfPhaseBiases;
1265 if (ii >= CLOCKORBIT_NUMBIAS)
1266 break;
1267 phasebiasSat->NumberOfPhaseBiases += 1;
1268 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L5_Q;
1269 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1270 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1271 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1272 pbSig.wlInd;
1273 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1274 pbSig.discCount;
1275 }
1276 else if (pbSig.type == "5X") {
1277 int ii = phasebiasSat->NumberOfPhaseBiases;
1278 if (ii >= CLOCKORBIT_NUMBIAS)
1279 break;
1280 phasebiasSat->NumberOfPhaseBiases += 1;
1281 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L5_IQ;
1282 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1283 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1284 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1285 pbSig.wlInd;
1286 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1287 pbSig.discCount;
1288 }
1289 }
1290 }
1291 if (prn.system() == 'R') {
1292 QListIterator<phaseBiasSignal> it(phaseBiasList);
1293 while (it.hasNext()) {
1294 const phaseBiasSignal &pbSig = it.next();
1295 if (pbSig.type == "1C") {
1296 int ii = phasebiasSat->NumberOfPhaseBiases;
1297 if (ii >= CLOCKORBIT_NUMBIAS)
1298 break;
1299 phasebiasSat->NumberOfPhaseBiases += 1;
1300 phasebiasSat->Biases[ii].Type = CODETYPEGLONASS_L1_CA;
1301 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1302 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1303 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1304 pbSig.wlInd;
1305 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1306 pbSig.discCount;
1307 }
1308 else if (pbSig.type == "1P") {
1309 int ii = phasebiasSat->NumberOfPhaseBiases;
1310 if (ii >= CLOCKORBIT_NUMBIAS)
1311 break;
1312 phasebiasSat->NumberOfPhaseBiases += 1;
1313 phasebiasSat->Biases[ii].Type = CODETYPEGLONASS_L1_P;
1314 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1315 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1316 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1317 pbSig.wlInd;
1318 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1319 pbSig.discCount;
1320 }
1321 else if (pbSig.type == "2C") {
1322 int ii = phasebiasSat->NumberOfPhaseBiases;
1323 if (ii >= CLOCKORBIT_NUMBIAS)
1324 break;
1325 phasebiasSat->NumberOfPhaseBiases += 1;
1326 phasebiasSat->Biases[ii].Type = CODETYPEGLONASS_L2_CA;
1327 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1328 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1329 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1330 pbSig.wlInd;
1331 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1332 pbSig.discCount;
1333 }
1334 else if (pbSig.type == "2P") {
1335 int ii = phasebiasSat->NumberOfPhaseBiases;
1336 if (ii >= CLOCKORBIT_NUMBIAS)
1337 break;
1338 phasebiasSat->NumberOfPhaseBiases += 1;
1339 phasebiasSat->Biases[ii].Type = CODETYPEGLONASS_L2_P;
1340 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1341 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1342 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1343 pbSig.wlInd;
1344 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1345 pbSig.discCount;
1346 }
1347 }
1348 }
1349 if (prn.system() == 'E') {
1350 QListIterator<phaseBiasSignal> it(phaseBiasList);
1351 while (it.hasNext()) {
1352 const phaseBiasSignal &pbSig = it.next();
1353 if (pbSig.type == "1A") {
1354 int ii = phasebiasSat->NumberOfPhaseBiases;
1355 if (ii >= CLOCKORBIT_NUMBIAS)
1356 break;
1357 phasebiasSat->NumberOfPhaseBiases += 1;
1358 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E1_A;
1359 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1360 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1361 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1362 pbSig.wlInd;
1363 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1364 pbSig.discCount;
1365 }
1366 else if (pbSig.type == "1B") {
1367 int ii = phasebiasSat->NumberOfPhaseBiases;
1368 if (ii >= CLOCKORBIT_NUMBIAS)
1369 break;
1370 phasebiasSat->NumberOfPhaseBiases += 1;
1371 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E1_B;
1372 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1373 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1374 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1375 pbSig.wlInd;
1376 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1377 pbSig.discCount;
1378 }
1379 else if (pbSig.type == "1C") {
1380 int ii = phasebiasSat->NumberOfPhaseBiases;
1381 if (ii >= CLOCKORBIT_NUMBIAS)
1382 break;
1383 phasebiasSat->NumberOfPhaseBiases += 1;
1384 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E1_C;
1385 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1386 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1387 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1388 pbSig.wlInd;
1389 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1390 pbSig.discCount;
1391 }
1392 else if (pbSig.type == "5I") {
1393 int ii = phasebiasSat->NumberOfPhaseBiases;
1394 if (ii >= CLOCKORBIT_NUMBIAS)
1395 break;
1396 phasebiasSat->NumberOfPhaseBiases += 1;
1397 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E5A_I;
1398 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1399 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1400 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1401 pbSig.wlInd;
1402 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1403 pbSig.discCount;
1404 }
1405 else if (pbSig.type == "5Q") {
1406 int ii = phasebiasSat->NumberOfPhaseBiases;
1407 if (ii >= CLOCKORBIT_NUMBIAS)
1408 break;
1409 phasebiasSat->NumberOfPhaseBiases += 1;
1410 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E5A_Q;
1411 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1412 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1413 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1414 pbSig.wlInd;
1415 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1416 pbSig.discCount;
1417 }
1418 else if (pbSig.type == "7I") {
1419 int ii = phasebiasSat->NumberOfPhaseBiases;
1420 if (ii >= CLOCKORBIT_NUMBIAS)
1421 break;
1422 phasebiasSat->NumberOfPhaseBiases += 1;
1423 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E5B_I;
1424 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1425 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1426 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1427 pbSig.wlInd;
1428 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1429 pbSig.discCount;
1430 }
1431 else if (pbSig.type == "7Q") {
1432 int ii = phasebiasSat->NumberOfPhaseBiases;
1433 if (ii >= CLOCKORBIT_NUMBIAS)
1434 break;
1435 phasebiasSat->NumberOfPhaseBiases += 1;
1436 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E5B_Q;
1437 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1438 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1439 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1440 pbSig.wlInd;
1441 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1442 pbSig.discCount;
1443 }
1444 else if (pbSig.type == "8I") {
1445 int ii = phasebiasSat->NumberOfPhaseBiases;
1446 if (ii >= CLOCKORBIT_NUMBIAS)
1447 break;
1448 phasebiasSat->NumberOfPhaseBiases += 1;
1449 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E5_I;
1450 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1451 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1452 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1453 pbSig.wlInd;
1454 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1455 pbSig.discCount;
1456 }
1457 else if (pbSig.type == "8Q") {
1458 int ii = phasebiasSat->NumberOfPhaseBiases;
1459 if (ii >= CLOCKORBIT_NUMBIAS)
1460 break;
1461 phasebiasSat->NumberOfPhaseBiases += 1;
1462 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E5_Q;
1463 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1464 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1465 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1466 pbSig.wlInd;
1467 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1468 pbSig.discCount;
1469 }
1470 else if (pbSig.type == "6A") {
1471 int ii = phasebiasSat->NumberOfPhaseBiases;
1472 if (ii >= CLOCKORBIT_NUMBIAS)
1473 break;
1474 phasebiasSat->NumberOfPhaseBiases += 1;
1475 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E6_A;
1476 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1477 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1478 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1479 pbSig.wlInd;
1480 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1481 pbSig.discCount;
1482 }
1483 else if (pbSig.type == "6B") {
1484 int ii = phasebiasSat->NumberOfPhaseBiases;
1485 if (ii >= CLOCKORBIT_NUMBIAS)
1486 break;
1487 phasebiasSat->NumberOfPhaseBiases += 1;
1488 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E6_B;
1489 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1490 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1491 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1492 pbSig.wlInd;
1493 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1494 pbSig.discCount;
1495 }
1496 else if (pbSig.type == "6C") {
1497 int ii = phasebiasSat->NumberOfPhaseBiases;
1498 if (ii >= CLOCKORBIT_NUMBIAS)
1499 break;
1500 phasebiasSat->NumberOfPhaseBiases += 1;
1501 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E6_C;
1502 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1503 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1504 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1505 pbSig.wlInd;
1506 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1507 pbSig.discCount;
1508 }
1509 }
1510 }
1511 if (prn.system() == 'J') {
1512 QListIterator<phaseBiasSignal> it(phaseBiasList);
1513 while (it.hasNext()) {
1514 const phaseBiasSignal &pbSig = it.next();
1515 if (pbSig.type == "1C") {
1516 int ii = phasebiasSat->NumberOfPhaseBiases;
1517 if (ii >= CLOCKORBIT_NUMBIAS)
1518 break;
1519 phasebiasSat->NumberOfPhaseBiases += 1;
1520 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L1_CA;
1521 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1522 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1523 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1524 pbSig.wlInd;
1525 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1526 pbSig.discCount;
1527 }
1528 else if (pbSig.type == "1S") {
1529 int ii = phasebiasSat->NumberOfPhaseBiases;
1530 if (ii >= CLOCKORBIT_NUMBIAS)
1531 break;
1532 phasebiasSat->NumberOfPhaseBiases += 1;
1533 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L1C_D;
1534 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1535 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1536 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1537 pbSig.wlInd;
1538 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1539 pbSig.discCount;
1540 }
1541 else if (pbSig.type == "1L") {
1542 int ii = phasebiasSat->NumberOfPhaseBiases;
1543 if (ii >= CLOCKORBIT_NUMBIAS)
1544 break;
1545 phasebiasSat->NumberOfPhaseBiases += 1;
1546 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L1C_P;
1547 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1548 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1549 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1550 pbSig.wlInd;
1551 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1552 pbSig.discCount;
1553 }
1554 else if (pbSig.type == "1X") {
1555 int ii = phasebiasSat->NumberOfPhaseBiases;
1556 if (ii >= CLOCKORBIT_NUMBIAS)
1557 break;
1558 phasebiasSat->NumberOfPhaseBiases += 1;
1559 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L1C_DP;
1560 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1561 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1562 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1563 pbSig.wlInd;
1564 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1565 pbSig.discCount;
1566 }
1567 else if (pbSig.type == "2S") {
1568 int ii = phasebiasSat->NumberOfPhaseBiases;
1569 if (ii >= CLOCKORBIT_NUMBIAS)
1570 break;
1571 phasebiasSat->NumberOfPhaseBiases += 1;
1572 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L2_CM;
1573 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1574 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1575 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1576 pbSig.wlInd;
1577 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1578 pbSig.discCount;
1579 }
1580 else if (pbSig.type == "2L") {
1581 int ii = phasebiasSat->NumberOfPhaseBiases;
1582 if (ii >= CLOCKORBIT_NUMBIAS)
1583 break;
1584 phasebiasSat->NumberOfPhaseBiases += 1;
1585 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L2_CL;
1586 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1587 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1588 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1589 pbSig.wlInd;
1590 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1591 pbSig.discCount;
1592 }
1593 else if (pbSig.type == "2X") {
1594 int ii = phasebiasSat->NumberOfPhaseBiases;
1595 if (ii >= CLOCKORBIT_NUMBIAS)
1596 break;
1597 phasebiasSat->NumberOfPhaseBiases += 1;
1598 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L2_CML;
1599 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1600 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1601 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1602 pbSig.wlInd;
1603 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1604 pbSig.discCount;
1605 }
1606 else if (pbSig.type == "5I") {
1607 int ii = phasebiasSat->NumberOfPhaseBiases;
1608 if (ii >= CLOCKORBIT_NUMBIAS)
1609 break;
1610 phasebiasSat->NumberOfPhaseBiases += 1;
1611 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L5_I;
1612 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1613 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1614 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1615 pbSig.wlInd;
1616 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1617 pbSig.discCount;
1618 }
1619 else if (pbSig.type == "5Q") {
1620 int ii = phasebiasSat->NumberOfPhaseBiases;
1621 if (ii >= CLOCKORBIT_NUMBIAS)
1622 break;
1623 phasebiasSat->NumberOfPhaseBiases += 1;
1624 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L5_Q;
1625 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1626 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1627 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1628 pbSig.wlInd;
1629 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1630 pbSig.discCount;
1631 }
1632 else if (pbSig.type == "5X") {
1633 int ii = phasebiasSat->NumberOfPhaseBiases;
1634 if (ii >= CLOCKORBIT_NUMBIAS)
1635 break;
1636 phasebiasSat->NumberOfPhaseBiases += 1;
1637 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L5_IQ;
1638 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1639 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1640 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1641 pbSig.wlInd;
1642 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1643 pbSig.discCount;
1644 }
1645 else if (pbSig.type == "6S") {
1646 int ii = phasebiasSat->NumberOfPhaseBiases;
1647 if (ii >= CLOCKORBIT_NUMBIAS)
1648 break;
1649 phasebiasSat->NumberOfPhaseBiases += 1;
1650 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_LEX_S;
1651 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1652 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1653 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1654 pbSig.wlInd;
1655 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1656 pbSig.discCount;
1657 }
1658 else if (pbSig.type == "6L") {
1659 int ii = phasebiasSat->NumberOfPhaseBiases;
1660 if (ii >= CLOCKORBIT_NUMBIAS)
1661 break;
1662 phasebiasSat->NumberOfPhaseBiases += 1;
1663 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_LEX_L;
1664 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1665 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1666 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1667 pbSig.wlInd;
1668 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1669 pbSig.discCount;
1670 }
1671 else if (pbSig.type == "6X") {
1672 int ii = phasebiasSat->NumberOfPhaseBiases;
1673 if (ii >= CLOCKORBIT_NUMBIAS)
1674 break;
1675 phasebiasSat->NumberOfPhaseBiases += 1;
1676 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_LEX_SL;
1677 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1678 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1679 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1680 pbSig.wlInd;
1681 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1682 pbSig.discCount;
1683 }
1684 }
1685 }
1686 if (prn.system() == 'S') {
1687 QListIterator<phaseBiasSignal> it(phaseBiasList);
1688 while (it.hasNext()) {
1689 const phaseBiasSignal &pbSig = it.next();
1690 if (pbSig.type == "1C") {
1691 int ii = phasebiasSat->NumberOfPhaseBiases;
1692 if (ii >= CLOCKORBIT_NUMBIAS)
1693 break;
1694 phasebiasSat->NumberOfPhaseBiases += 1;
1695 phasebiasSat->Biases[ii].Type = CODETYPE_SBAS_L1_CA;
1696 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1697 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1698 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1699 pbSig.wlInd;
1700 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1701 pbSig.discCount;
1702 }
1703 else if (pbSig.type == "5I") {
1704 int ii = phasebiasSat->NumberOfPhaseBiases;
1705 if (ii >= CLOCKORBIT_NUMBIAS)
1706 break;
1707 phasebiasSat->NumberOfPhaseBiases += 1;
1708 phasebiasSat->Biases[ii].Type = CODETYPE_SBAS_L5_I;
1709 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1710 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1711 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1712 pbSig.wlInd;
1713 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1714 pbSig.discCount;
1715 }
1716 else if (pbSig.type == "5Q") {
1717 int ii = phasebiasSat->NumberOfPhaseBiases;
1718 if (ii >= CLOCKORBIT_NUMBIAS)
1719 break;
1720 phasebiasSat->NumberOfPhaseBiases += 1;
1721 phasebiasSat->Biases[ii].Type = CODETYPE_SBAS_L5_Q;
1722 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1723 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1724 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1725 pbSig.wlInd;
1726 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1727 pbSig.discCount;
1728 }
1729 else if (pbSig.type == "5X") {
1730 int ii = phasebiasSat->NumberOfPhaseBiases;
1731 if (ii >= CLOCKORBIT_NUMBIAS)
1732 break;
1733 phasebiasSat->NumberOfPhaseBiases += 1;
1734 phasebiasSat->Biases[ii].Type = CODETYPE_SBAS_L5_IQ;
1735 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1736 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1737 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1738 pbSig.wlInd;
1739 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1740 pbSig.discCount;
1741 }
1742 }
1743 }
1744 if (prn.system() == 'C') {
1745 QListIterator<phaseBiasSignal> it(phaseBiasList);
1746 while (it.hasNext()) {
1747 const phaseBiasSignal &pbSig = it.next();
1748 if (pbSig.type == "2I") {
1749 int ii = phasebiasSat->NumberOfPhaseBiases;
1750 if (ii >= CLOCKORBIT_NUMBIAS)
1751 break;
1752 phasebiasSat->NumberOfPhaseBiases += 1;
1753 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B1_I;
1754 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1755 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1756 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1757 pbSig.wlInd;
1758 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1759 pbSig.discCount;
1760 }
1761 else if (pbSig.type == "2Q") {
1762 int ii = phasebiasSat->NumberOfPhaseBiases;
1763 if (ii >= CLOCKORBIT_NUMBIAS)
1764 break;
1765 phasebiasSat->NumberOfPhaseBiases += 1;
1766 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B1_Q;
1767 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1768 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1769 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1770 pbSig.wlInd;
1771 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1772 pbSig.discCount;
1773 }
1774 else if (pbSig.type == "2X") {
1775 int ii = phasebiasSat->NumberOfPhaseBiases;
1776 if (ii >= CLOCKORBIT_NUMBIAS)
1777 break;
1778 phasebiasSat->NumberOfPhaseBiases += 1;
1779 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B1_IQ;
1780 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1781 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1782 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1783 pbSig.wlInd;
1784 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1785 pbSig.discCount;
1786 }
1787 else if (pbSig.type == "6I") {
1788 int ii = phasebiasSat->NumberOfPhaseBiases;
1789 if (ii >= CLOCKORBIT_NUMBIAS)
1790 break;
1791 phasebiasSat->NumberOfPhaseBiases += 1;
1792 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B2_Q;
1793 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1794 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1795 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1796 pbSig.wlInd;
1797 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1798 pbSig.discCount;
1799 }
1800 else if (pbSig.type == "6Q") {
1801 int ii = phasebiasSat->NumberOfPhaseBiases;
1802 if (ii >= CLOCKORBIT_NUMBIAS)
1803 break;
1804 phasebiasSat->NumberOfPhaseBiases += 1;
1805 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B2_I;
1806 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1807 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1808 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1809 pbSig.wlInd;
1810 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1811 pbSig.discCount;
1812 }
1813 else if (pbSig.type == "6X") {
1814 int ii = phasebiasSat->NumberOfPhaseBiases;
1815 if (ii >= CLOCKORBIT_NUMBIAS)
1816 break;
1817 phasebiasSat->NumberOfPhaseBiases += 1;
1818 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B2_IQ;
1819 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1820 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1821 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1822 pbSig.wlInd;
1823 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1824 pbSig.discCount;
1825 }
1826 else if (pbSig.type == "7I") {
1827 int ii = phasebiasSat->NumberOfPhaseBiases;
1828 if (ii >= CLOCKORBIT_NUMBIAS)
1829 break;
1830 phasebiasSat->NumberOfPhaseBiases += 1;
1831 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B3_Q;
1832 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1833 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1834 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1835 pbSig.wlInd;
1836 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1837 pbSig.discCount;
1838 }
1839 else if (pbSig.type == "7Q") {
1840 int ii = phasebiasSat->NumberOfPhaseBiases;
1841 if (ii >= CLOCKORBIT_NUMBIAS)
1842 break;
1843 phasebiasSat->NumberOfPhaseBiases += 1;
1844 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B3_I;
1845 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1846 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1847 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1848 pbSig.wlInd;
1849 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1850 pbSig.discCount;
1851 }
1852 else if (pbSig.type == "7X") {
1853 int ii = phasebiasSat->NumberOfPhaseBiases;
1854 if (ii >= CLOCKORBIT_NUMBIAS)
1855 break;
1856 phasebiasSat->NumberOfPhaseBiases += 1;
1857 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B3_IQ;
1858 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1859 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1860 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1861 pbSig.wlInd;
1862 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1863 pbSig.discCount;
1864 }
1865 }
1866 }
1867 }
1868 }
1869 }
1870
1871 QByteArray hlpBufferCo;
1872
1873 // Orbit and Clock Corrections together
1874 // ------------------------------------
1875 if (_samplRtcmEphCorr == 0.0) {
1876 if (co.NumberOfSat[CLOCKORBIT_SATGPS] > 0
1877 || co.NumberOfSat[CLOCKORBIT_SATGLONASS] > 0
1878 || co.NumberOfSat[CLOCKORBIT_SATGALILEO] > 0
1879 || co.NumberOfSat[CLOCKORBIT_SATQZSS] > 0
1880 || co.NumberOfSat[CLOCKORBIT_SATSBAS] > 0
1881 || co.NumberOfSat[CLOCKORBIT_SATBDS] > 0) {
1882 char obuffer[CLOCKORBIT_BUFFERSIZE];
1883 int len = MakeClockOrbit(&co, COTYPE_AUTO, 0, obuffer, sizeof(obuffer));
1884 if (len > 0) {
1885 hlpBufferCo = QByteArray(obuffer, len);
1886 }
1887 }
1888 }
1889
1890 // Orbit and Clock Corrections separately
1891 // --------------------------------------
1892 else {
1893 if (co.NumberOfSat[CLOCKORBIT_SATGPS] > 0) {
1894 char obuffer[CLOCKORBIT_BUFFERSIZE];
1895 if (fmod(epoTime.gpssec(), _samplRtcmEphCorr) == 0.0) {
1896 co.UpdateInterval = ephUpdInd;
1897 int len1 = MakeClockOrbit(&co, COTYPE_GPSORBIT, 1, obuffer,
1898 sizeof(obuffer));
1899 co.UpdateInterval = clkUpdInd;
1900 if (len1 > 0) {
1901 hlpBufferCo += QByteArray(obuffer, len1);
1902 }
1903 }
1904 int mmsg = (co.NumberOfSat[CLOCKORBIT_SATGLONASS] > 0) ? 1 : 0;
1905 int len2 = MakeClockOrbit(&co, COTYPE_GPSCLOCK, mmsg, obuffer,
1906 sizeof(obuffer));
1907 if (len2 > 0) {
1908 hlpBufferCo += QByteArray(obuffer, len2);
1909 }
1910 }
1911 if (co.NumberOfSat[CLOCKORBIT_SATGLONASS] > 0) {
1912 char obuffer[CLOCKORBIT_BUFFERSIZE];
1913 if (fmod(epoTime.gpssec(), _samplRtcmEphCorr) == 0.0) {
1914 co.UpdateInterval = ephUpdInd;
1915 int len1 = MakeClockOrbit(&co, COTYPE_GLONASSORBIT, 1, obuffer,
1916 sizeof(obuffer));
1917 co.UpdateInterval = clkUpdInd;
1918 if (len1 > 0) {
1919 hlpBufferCo += QByteArray(obuffer, len1);
1920 }
1921 }
1922 int mmsg = (co.NumberOfSat[CLOCKORBIT_SATGALILEO] > 0) ? 1 : 0;
1923 int len2 = MakeClockOrbit(&co, COTYPE_GLONASSCLOCK, mmsg, obuffer,
1924 sizeof(obuffer));
1925 if (len2 > 0) {
1926 hlpBufferCo += QByteArray(obuffer, len2);
1927 }
1928 }
1929 if (co.NumberOfSat[CLOCKORBIT_SATGALILEO] > 0) {
1930 char obuffer[CLOCKORBIT_BUFFERSIZE];
1931 if (fmod(epoTime.gpssec(), _samplRtcmEphCorr) == 0.0) {
1932 co.UpdateInterval = ephUpdInd;
1933 int len1 = MakeClockOrbit(&co, COTYPE_GALILEOORBIT, 1, obuffer,
1934 sizeof(obuffer));
1935 co.UpdateInterval = clkUpdInd;
1936 if (len1 > 0) {
1937 hlpBufferCo += QByteArray(obuffer, len1);
1938 }
1939 }
1940 int mmsg = (co.NumberOfSat[CLOCKORBIT_SATQZSS] > 0) ? 1 : 0;
1941 int len2 = MakeClockOrbit(&co, COTYPE_GALILEOCLOCK, mmsg, obuffer,
1942 sizeof(obuffer));
1943 if (len2 > 0) {
1944 hlpBufferCo += QByteArray(obuffer, len2);
1945 }
1946 }
1947 if (co.NumberOfSat[CLOCKORBIT_SATQZSS] > 0) {
1948 char obuffer[CLOCKORBIT_BUFFERSIZE];
1949 if (fmod(epoTime.gpssec(), _samplRtcmEphCorr) == 0.0) {
1950 co.UpdateInterval = ephUpdInd;
1951 int len1 = MakeClockOrbit(&co, COTYPE_QZSSORBIT, 1, obuffer,
1952 sizeof(obuffer));
1953 co.UpdateInterval = clkUpdInd;
1954 if (len1 > 0) {
1955 hlpBufferCo += QByteArray(obuffer, len1);
1956 }
1957 }
1958 int mmsg = (co.NumberOfSat[CLOCKORBIT_SATSBAS] > 0) ? 1 : 0;
1959 int len2 = MakeClockOrbit(&co, COTYPE_QZSSCLOCK, mmsg, obuffer,
1960 sizeof(obuffer));
1961 if (len2 > 0) {
1962 hlpBufferCo += QByteArray(obuffer, len2);
1963 }
1964 }
1965 if (co.NumberOfSat[CLOCKORBIT_SATSBAS] > 0) {
1966 char obuffer[CLOCKORBIT_BUFFERSIZE];
1967 if (fmod(epoTime.gpssec(), _samplRtcmEphCorr) == 0.0) {
1968 co.UpdateInterval = ephUpdInd;
1969 int len1 = MakeClockOrbit(&co, COTYPE_SBASORBIT, 1, obuffer,
1970 sizeof(obuffer));
1971 co.UpdateInterval = clkUpdInd;
1972 if (len1 > 0) {
1973 hlpBufferCo += QByteArray(obuffer, len1);
1974 }
1975 }
1976 int mmsg = (co.NumberOfSat[CLOCKORBIT_SATBDS] > 0) ? 1 : 0;
1977 int len2 = MakeClockOrbit(&co, COTYPE_SBASCLOCK, mmsg, obuffer,
1978 sizeof(obuffer));
1979 if (len2 > 0) {
1980 hlpBufferCo += QByteArray(obuffer, len2);
1981 }
1982 }
1983 if (co.NumberOfSat[CLOCKORBIT_SATBDS] > 0) {
1984 char obuffer[CLOCKORBIT_BUFFERSIZE];
1985 if (fmod(epoTime.gpssec(), _samplRtcmEphCorr) == 0.0) {
1986 co.UpdateInterval = ephUpdInd;
1987 int len1 = MakeClockOrbit(&co, COTYPE_BDSORBIT, 1, obuffer,
1988 sizeof(obuffer));
1989 co.UpdateInterval = clkUpdInd;
1990 if (len1 > 0) {
1991 hlpBufferCo += QByteArray(obuffer, len1);
1992 }
1993 }
1994 int len2 = MakeClockOrbit(&co, COTYPE_BDSCLOCK, 0, obuffer,
1995 sizeof(obuffer));
1996 if (len2 > 0) {
1997 hlpBufferCo += QByteArray(obuffer, len2);
1998 }
1999 }
2000 }
2001
2002 // Code Biases
2003 // -----------
2004 QByteArray hlpBufferBias;
2005 if (bias.NumberOfSat[CLOCKORBIT_SATGPS] > 0
2006 || bias.NumberOfSat[CLOCKORBIT_SATGLONASS] > 0
2007 || bias.NumberOfSat[CLOCKORBIT_SATGALILEO] > 0
2008 || bias.NumberOfSat[CLOCKORBIT_SATQZSS] > 0
2009 || bias.NumberOfSat[CLOCKORBIT_SATSBAS] > 0
2010 || bias.NumberOfSat[CLOCKORBIT_SATBDS] > 0) {
2011 char obuffer[CLOCKORBIT_BUFFERSIZE];
2012 int len = MakeCodeBias(&bias, BTYPE_AUTO, 0, obuffer, sizeof(obuffer));
2013 if (len > 0) {
2014 hlpBufferBias = QByteArray(obuffer, len);
2015 }
2016 }
2017
2018 // Phase Biases
2019 // ------------
2020 QByteArray hlpBufferPhaseBias;
2021 if (phasebias.NumberOfSat[CLOCKORBIT_SATGPS] > 0
2022 || phasebias.NumberOfSat[CLOCKORBIT_SATGLONASS] > 0
2023 || phasebias.NumberOfSat[CLOCKORBIT_SATGALILEO] > 0
2024 || phasebias.NumberOfSat[CLOCKORBIT_SATQZSS] > 0
2025 || phasebias.NumberOfSat[CLOCKORBIT_SATSBAS] > 0
2026 || phasebias.NumberOfSat[CLOCKORBIT_SATBDS] > 0) {
2027 char obuffer[CLOCKORBIT_BUFFERSIZE];
2028 int len = MakePhaseBias(&phasebias, PBTYPE_AUTO, 0, obuffer,
2029 sizeof(obuffer));
2030 if (len > 0) {
2031 hlpBufferPhaseBias = QByteArray(obuffer, len);
2032 }
2033 }
2034
2035 // VTEC
2036 // ----
2037 QByteArray hlpBufferVtec;
2038 if (vtec.NumLayers > 0) {
2039 char obuffer[CLOCKORBIT_BUFFERSIZE];
2040 int len = MakeVTEC(&vtec, 0, obuffer, sizeof(obuffer));
2041 if (len > 0) {
2042 hlpBufferVtec = QByteArray(obuffer, len);
2043 }
2044 }
2045
2046 _outBuffer += hlpBufferCo + hlpBufferBias + hlpBufferPhaseBias
2047 + hlpBufferVtec;
2048}
2049
2050//
2051////////////////////////////////////////////////////////////////////////////
2052void bncRtnetUploadCaster::processSatellite(const t_eph* eph, int GPSweek,
2053 double GPSweeks, const QString& prn, const ColumnVector& rtnAPC,
2054 double rtnClk, const ColumnVector& rtnVel, const ColumnVector& rtnCoM,
2055 struct ClockOrbit::SatData* sd, QString& outLine) {
2056
2057 // Broadcast Position and Velocity
2058 // -------------------------------
2059 ColumnVector xB(4);
2060 ColumnVector vB(3);
2061 eph->getCrd(bncTime(GPSweek, GPSweeks), xB, vB, false);
2062
2063 // Precise Position
2064 // ----------------
2065 ColumnVector xP = _CoM ? rtnCoM : rtnAPC;
2066
2067 double dc = 0.0;
2068 if (_crdTrafo != "IGS08") {
2069 crdTrafo(GPSweek, xP, dc);
2070 }
2071
2072 // Difference in xyz
2073 // -----------------
2074 ColumnVector dx = xB.Rows(1, 3) - xP;
2075 ColumnVector dv = vB - rtnVel;
2076
2077 // Difference in RSW
2078 // -----------------
2079 ColumnVector rsw(3);
2080 XYZ_to_RSW(xB.Rows(1, 3), vB, dx, rsw);
2081
2082 ColumnVector dotRsw(3);
2083 XYZ_to_RSW(xB.Rows(1, 3), vB, dv, dotRsw);
2084
2085 // Clock Correction
2086 // ----------------
2087 double dClk = rtnClk - (xB(4) - dc) * t_CST::c;
2088
2089 if (sd) {
2090 sd->ID = prn.mid(1).toInt();
2091 sd->IOD = eph->IOD();
2092 sd->Clock.DeltaA0 = dClk;
2093 sd->Clock.DeltaA1 = 0.0; // TODO
2094 sd->Clock.DeltaA2 = 0.0; // TODO
2095 sd->Orbit.DeltaRadial = rsw(1);
2096 sd->Orbit.DeltaAlongTrack = rsw(2);
2097 sd->Orbit.DeltaCrossTrack = rsw(3);
2098 sd->Orbit.DotDeltaRadial = dotRsw(1);
2099 sd->Orbit.DotDeltaAlongTrack = dotRsw(2);
2100 sd->Orbit.DotDeltaCrossTrack = dotRsw(3);
2101 }
2102
2103 outLine.sprintf("%d %.1f %s %lu %10.3f %8.3f %8.3f %8.3f\n", GPSweek,
2104 GPSweeks, eph->prn().toString().c_str(), eph->IOD(), dClk, rsw(1), rsw(2),
2105 rsw(3));
2106
2107 double relativity = -2.0 * DotProduct(xP, rtnVel) / t_CST::c;
2108 double sp3Clk = (rtnClk - relativity) / t_CST::c; // in seconds
2109
2110 if (_rnx) {
2111 _rnx->write(GPSweek, GPSweeks, prn, sp3Clk);
2112 }
2113 if (_sp3) {
2114 _sp3->write(GPSweek, GPSweeks, prn, rtnCoM, sp3Clk);
2115 }
2116}
2117
2118// Transform Coordinates
2119////////////////////////////////////////////////////////////////////////////
2120void bncRtnetUploadCaster::crdTrafo(int GPSWeek, ColumnVector& xyz,
2121 double& dc) {
2122
2123 // Current epoch minus 2000.0 in years
2124 // ------------------------------------
2125 double dt = (GPSWeek - (1042.0 + 6.0 / 7.0)) / 365.2422 * 7.0 + 2000.0 - _t0;
2126
2127 ColumnVector dx(3);
2128
2129 dx(1) = _dx + dt * _dxr;
2130 dx(2) = _dy + dt * _dyr;
2131 dx(3) = _dz + dt * _dzr;
2132
2133 static const double arcSec = 180.0 * 3600.0 / M_PI;
2134
2135 double ox = (_ox + dt * _oxr) / arcSec;
2136 double oy = (_oy + dt * _oyr) / arcSec;
2137 double oz = (_oz + dt * _ozr) / arcSec;
2138
2139 double sc = 1.0 + _sc * 1e-9 + dt * _scr * 1e-9;
2140
2141 // Specify approximate center of area
2142 // ----------------------------------
2143 ColumnVector meanSta(3);
2144
2145 if (_crdTrafo == "ETRF2000") {
2146 meanSta(1) = 3661090.0;
2147 meanSta(2) = 845230.0;
2148 meanSta(3) = 5136850.0;
2149 }
2150 else if (_crdTrafo == "NAD83") {
2151 meanSta(1) = -1092950.0;
2152 meanSta(2) = -4383600.0;
2153 meanSta(3) = 4487420.0;
2154 }
2155 else if (_crdTrafo == "GDA94") {
2156 meanSta(1) = -4052050.0;
2157 meanSta(2) = 4212840.0;
2158 meanSta(3) = -2545110.0;
2159 }
2160 else if (_crdTrafo == "SIRGAS2000") {
2161 meanSta(1) = 3740860.0;
2162 meanSta(2) = -4964290.0;
2163 meanSta(3) = -1425420.0;
2164 }
2165 else if (_crdTrafo == "SIRGAS95") {
2166 meanSta(1) = 3135390.0;
2167 meanSta(2) = -5017670.0;
2168 meanSta(3) = -2374440.0;
2169 }
2170 else if (_crdTrafo == "DREF91") {
2171 meanSta(1) = 3959579.0;
2172 meanSta(2) = 721719.0;
2173 meanSta(3) = 4931539.0;
2174 }
2175 else if (_crdTrafo == "Custom") {
2176 meanSta(1) = 0.0; // TODO
2177 meanSta(2) = 0.0; // TODO
2178 meanSta(3) = 0.0; // TODO
2179 }
2180
2181 // Clock correction proportional to topocentric distance to satellites
2182 // -------------------------------------------------------------------
2183 double rho = (xyz - meanSta).norm_Frobenius();
2184 dc = rho * (sc - 1.0) / sc / t_CST::c;
2185
2186 Matrix rMat(3, 3);
2187 rMat(1, 1) = 1.0;
2188 rMat(1, 2) = -oz;
2189 rMat(1, 3) = oy;
2190 rMat(2, 1) = oz;
2191 rMat(2, 2) = 1.0;
2192 rMat(2, 3) = -ox;
2193 rMat(3, 1) = -oy;
2194 rMat(3, 2) = ox;
2195 rMat(3, 3) = 1.0;
2196
2197 xyz = sc * rMat * xyz + dx;
2198}
2199
2200int bncRtnetUploadCaster::determineUpdateInd(double samplingRate) {
2201
2202 if (samplingRate == 10.0) {
2203 return 3;
2204 }
2205 else if (samplingRate == 15.0) {
2206 return 4;
2207 }
2208 else if (samplingRate == 30.0) {
2209 return 5;
2210 }
2211 else if (samplingRate == 60.0) {
2212 return 6;
2213 }
2214 else if (samplingRate == 120.0) {
2215 return 7;
2216 }
2217 else if (samplingRate == 240.0) {
2218 return 8;
2219 }
2220 else if (samplingRate == 300.0) {
2221 return 9;
2222 }
2223 else if (samplingRate == 600.0) {
2224 return 10;
2225 }
2226 else if (samplingRate == 900.0) {
2227 return 11;
2228 }
2229 else if (samplingRate == 1800.0) {
2230 return 12;
2231 }
2232 else if (samplingRate == 3600.0) {
2233 return 13;
2234 }
2235 else if (samplingRate == 7200.0) {
2236 return 14;
2237 }
2238 else if (samplingRate == 10800.0) {
2239 return 15;
2240 }
2241 return 2; // default
2242}
Note: See TracBrowser for help on using the repository browser.