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

Last change on this file since 7940 was 7940, checked in by stuerze, 8 years ago

some Galileo signal and tracking modes are added

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