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

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

Signal and tracking mode identifier are updated with respect to the latest ssr1 proposal

File size: 95.3 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 }
[8004]603 else if (it.key() == "1S") {
604 int ii = biasSat->NumberOfCodeBiases;
605 if (ii >= CLOCKORBIT_NUMBIAS)
606 break;
607 biasSat->NumberOfCodeBiases += 1;
608 biasSat->Biases[ii].Type = CODETYPEGPS_L1C_D;
609 biasSat->Biases[ii].Bias = it.value();
610 }
611 else if (it.key() == "1L") {
612 int ii = biasSat->NumberOfCodeBiases;
613 if (ii >= CLOCKORBIT_NUMBIAS)
614 break;
615 biasSat->NumberOfCodeBiases += 1;
616 biasSat->Biases[ii].Type = CODETYPEGPS_L1C_P;
617 biasSat->Biases[ii].Bias = it.value();
618 }
619 else if (it.key() == "1X") {
620 int ii = biasSat->NumberOfCodeBiases;
621 if (ii >= CLOCKORBIT_NUMBIAS)
622 break;
623 biasSat->NumberOfCodeBiases += 1;
624 biasSat->Biases[ii].Type = CODETYPEGPS_L1C_DP;
625 biasSat->Biases[ii].Bias = it.value();
626 }
[5504]627 else if (it.key() == "1P") {
[6877]628 int ii = biasSat->NumberOfCodeBiases;
629 if (ii >= CLOCKORBIT_NUMBIAS)
630 break;
[5503]631 biasSat->NumberOfCodeBiases += 1;
632 biasSat->Biases[ii].Type = CODETYPEGPS_L1_P;
633 biasSat->Biases[ii].Bias = it.value();
634 }
[5504]635 else if (it.key() == "1W") {
[6877]636 int ii = biasSat->NumberOfCodeBiases;
637 if (ii >= CLOCKORBIT_NUMBIAS)
638 break;
[5503]639 biasSat->NumberOfCodeBiases += 1;
640 biasSat->Biases[ii].Type = CODETYPEGPS_L1_Z;
641 biasSat->Biases[ii].Bias = it.value();
642 }
[5504]643 else if (it.key() == "2C") {
[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_CA;
649 biasSat->Biases[ii].Bias = it.value();
650 }
[5504]651 else if (it.key() == "2D") {
[6877]652 int ii = biasSat->NumberOfCodeBiases;
653 if (ii >= CLOCKORBIT_NUMBIAS)
654 break;
[5503]655 biasSat->NumberOfCodeBiases += 1;
656 biasSat->Biases[ii].Type = CODETYPEGPS_SEMI_CODELESS;
657 biasSat->Biases[ii].Bias = it.value();
658 }
[5504]659 else if (it.key() == "2S") {
[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_CM;
665 biasSat->Biases[ii].Bias = it.value();
666 }
[5504]667 else if (it.key() == "2L") {
[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_CL;
673 biasSat->Biases[ii].Bias = it.value();
674 }
[5504]675 else if (it.key() == "2X") {
[6877]676 int ii = biasSat->NumberOfCodeBiases;
677 if (ii >= CLOCKORBIT_NUMBIAS)
678 break;
[5503]679 biasSat->NumberOfCodeBiases += 1;
680 biasSat->Biases[ii].Type = CODETYPEGPS_L2_CML;
681 biasSat->Biases[ii].Bias = it.value();
682 }
[5504]683 else if (it.key() == "2P") {
[6877]684 int ii = biasSat->NumberOfCodeBiases;
685 if (ii >= CLOCKORBIT_NUMBIAS)
686 break;
[5503]687 biasSat->NumberOfCodeBiases += 1;
688 biasSat->Biases[ii].Type = CODETYPEGPS_L2_P;
689 biasSat->Biases[ii].Bias = it.value();
690 }
[5510]691 else if (it.key() == "2W") {
[6877]692 int ii = biasSat->NumberOfCodeBiases;
693 if (ii >= CLOCKORBIT_NUMBIAS)
694 break;
[5503]695 biasSat->NumberOfCodeBiases += 1;
696 biasSat->Biases[ii].Type = CODETYPEGPS_L2_Z;
697 biasSat->Biases[ii].Bias = it.value();
698 }
[5504]699 else if (it.key() == "5I") {
[6877]700 int ii = biasSat->NumberOfCodeBiases;
701 if (ii >= CLOCKORBIT_NUMBIAS)
702 break;
[5503]703 biasSat->NumberOfCodeBiases += 1;
704 biasSat->Biases[ii].Type = CODETYPEGPS_L5_I;
705 biasSat->Biases[ii].Bias = it.value();
706 }
[5504]707 else if (it.key() == "5Q") {
[6877]708 int ii = biasSat->NumberOfCodeBiases;
709 if (ii >= CLOCKORBIT_NUMBIAS)
710 break;
[5503]711 biasSat->NumberOfCodeBiases += 1;
712 biasSat->Biases[ii].Type = CODETYPEGPS_L5_Q;
713 biasSat->Biases[ii].Bias = it.value();
714 }
[6844]715 else if (it.key() == "5X") {
[6877]716 int ii = biasSat->NumberOfCodeBiases;
717 if (ii >= CLOCKORBIT_NUMBIAS)
718 break;
[6844]719 biasSat->NumberOfCodeBiases += 1;
720 biasSat->Biases[ii].Type = CODETYPEGPS_L5_IQ;
721 biasSat->Biases[ii].Bias = it.value();
722 }
[5503]723 }
[3222]724 }
[6876]725 else if (prn.system() == 'R') {
[5503]726 QMapIterator<QString, double> it(codeBiases);
727 while (it.hasNext()) {
728 it.next();
[6877]729 if (it.key() == "1C") {
730 int ii = biasSat->NumberOfCodeBiases;
731 if (ii >= CLOCKORBIT_NUMBIAS)
732 break;
[5503]733 biasSat->NumberOfCodeBiases += 1;
734 biasSat->Biases[ii].Type = CODETYPEGLONASS_L1_CA;
735 biasSat->Biases[ii].Bias = it.value();
736 }
[5504]737 else if (it.key() == "1P") {
[6877]738 int ii = biasSat->NumberOfCodeBiases;
739 if (ii >= CLOCKORBIT_NUMBIAS)
740 break;
[5503]741 biasSat->NumberOfCodeBiases += 1;
742 biasSat->Biases[ii].Type = CODETYPEGLONASS_L1_P;
743 biasSat->Biases[ii].Bias = it.value();
744 }
[5504]745 else if (it.key() == "2C") {
[6877]746 int ii = biasSat->NumberOfCodeBiases;
747 if (ii >= CLOCKORBIT_NUMBIAS)
748 break;
[5503]749 biasSat->NumberOfCodeBiases += 1;
750 biasSat->Biases[ii].Type = CODETYPEGLONASS_L2_CA;
751 biasSat->Biases[ii].Bias = it.value();
752 }
[5504]753 else if (it.key() == "2P") {
[6877]754 int ii = biasSat->NumberOfCodeBiases;
755 if (ii >= CLOCKORBIT_NUMBIAS)
756 break;
[5503]757 biasSat->NumberOfCodeBiases += 1;
758 biasSat->Biases[ii].Type = CODETYPEGLONASS_L2_P;
759 biasSat->Biases[ii].Bias = it.value();
760 }
761 }
[3222]762 }
[6876]763 else if (prn.system() == 'E') {
[6844]764 QMapIterator<QString, double> it(codeBiases);
765 while (it.hasNext()) {
766 it.next();
[6877]767 if (it.key() == "1A") {
768 int ii = biasSat->NumberOfCodeBiases;
769 if (ii >= CLOCKORBIT_NUMBIAS)
770 break;
[6844]771 biasSat->NumberOfCodeBiases += 1;
772 biasSat->Biases[ii].Type = CODETYPEGALILEO_E1_A;
773 biasSat->Biases[ii].Bias = it.value();
774 }
775 else if (it.key() == "1B") {
[6877]776 int ii = biasSat->NumberOfCodeBiases;
777 if (ii >= CLOCKORBIT_NUMBIAS)
778 break;
[6844]779 biasSat->NumberOfCodeBiases += 1;
780 biasSat->Biases[ii].Type = CODETYPEGALILEO_E1_B;
781 biasSat->Biases[ii].Bias = it.value();
782 }
783 else if (it.key() == "1C") {
[6877]784 int ii = biasSat->NumberOfCodeBiases;
785 if (ii >= CLOCKORBIT_NUMBIAS)
786 break;
[6844]787 biasSat->NumberOfCodeBiases += 1;
788 biasSat->Biases[ii].Type = CODETYPEGALILEO_E1_C;
789 biasSat->Biases[ii].Bias = it.value();
790 }
[7940]791 else if (it.key() == "1X") {
792 int ii = biasSat->NumberOfCodeBiases;
793 if (ii >= CLOCKORBIT_NUMBIAS)
794 break;
795 biasSat->NumberOfCodeBiases += 1;
796 biasSat->Biases[ii].Type = CODETYPEGALILEO_E1_BC;
797 biasSat->Biases[ii].Bias = it.value();
798 }
799 else if (it.key() == "1Z") {
800 int ii = biasSat->NumberOfCodeBiases;
801 if (ii >= CLOCKORBIT_NUMBIAS)
802 break;
803 biasSat->NumberOfCodeBiases += 1;
804 biasSat->Biases[ii].Type = CODETYPEGALILEO_E1_ABC;
805 biasSat->Biases[ii].Bias = it.value();
806 }
[6844]807 else if (it.key() == "5I") {
[6877]808 int ii = biasSat->NumberOfCodeBiases;
809 if (ii >= CLOCKORBIT_NUMBIAS)
810 break;
[6844]811 biasSat->NumberOfCodeBiases += 1;
812 biasSat->Biases[ii].Type = CODETYPEGALILEO_E5A_I;
813 biasSat->Biases[ii].Bias = it.value();
814 }
815 else if (it.key() == "5Q") {
[6877]816 int ii = biasSat->NumberOfCodeBiases;
817 if (ii >= CLOCKORBIT_NUMBIAS)
818 break;
[6844]819 biasSat->NumberOfCodeBiases += 1;
820 biasSat->Biases[ii].Type = CODETYPEGALILEO_E5A_Q;
821 biasSat->Biases[ii].Bias = it.value();
822 }
[7940]823 else if (it.key() == "5X") {
824 int ii = biasSat->NumberOfCodeBiases;
825 if (ii >= CLOCKORBIT_NUMBIAS)
826 break;
827 biasSat->NumberOfCodeBiases += 1;
828 biasSat->Biases[ii].Type = CODETYPEGALILEO_E5A_IQ;
829 biasSat->Biases[ii].Bias = it.value();
830 }
[6844]831 else if (it.key() == "7I") {
[6877]832 int ii = biasSat->NumberOfCodeBiases;
833 if (ii >= CLOCKORBIT_NUMBIAS)
834 break;
[6844]835 biasSat->NumberOfCodeBiases += 1;
836 biasSat->Biases[ii].Type = CODETYPEGALILEO_E5B_I;
837 biasSat->Biases[ii].Bias = it.value();
838 }
839 else if (it.key() == "7Q") {
[6877]840 int ii = biasSat->NumberOfCodeBiases;
841 if (ii >= CLOCKORBIT_NUMBIAS)
842 break;
[6844]843 biasSat->NumberOfCodeBiases += 1;
844 biasSat->Biases[ii].Type = CODETYPEGALILEO_E5B_Q;
845 biasSat->Biases[ii].Bias = it.value();
846 }
[7940]847 else if (it.key() == "7X") {
848 int ii = biasSat->NumberOfCodeBiases;
849 if (ii >= CLOCKORBIT_NUMBIAS)
850 break;
851 biasSat->NumberOfCodeBiases += 1;
852 biasSat->Biases[ii].Type = CODETYPEGALILEO_E5B_IQ;
853 biasSat->Biases[ii].Bias = it.value();
854 }
[6844]855 else if (it.key() == "8I") {
[6877]856 int ii = biasSat->NumberOfCodeBiases;
857 if (ii >= CLOCKORBIT_NUMBIAS)
858 break;
[6844]859 biasSat->NumberOfCodeBiases += 1;
860 biasSat->Biases[ii].Type = CODETYPEGALILEO_E5_I;
861 biasSat->Biases[ii].Bias = it.value();
862 }
863 else if (it.key() == "8Q") {
[6877]864 int ii = biasSat->NumberOfCodeBiases;
865 if (ii >= CLOCKORBIT_NUMBIAS)
866 break;
[6844]867 biasSat->NumberOfCodeBiases += 1;
868 biasSat->Biases[ii].Type = CODETYPEGALILEO_E5_Q;
869 biasSat->Biases[ii].Bias = it.value();
870 }
[7940]871 else if (it.key() == "8X") {
872 int ii = biasSat->NumberOfCodeBiases;
873 if (ii >= CLOCKORBIT_NUMBIAS)
874 break;
875 biasSat->NumberOfCodeBiases += 1;
876 biasSat->Biases[ii].Type = CODETYPEGALILEO_E5_IQ;
877 biasSat->Biases[ii].Bias = it.value();
878 }
[6844]879 else if (it.key() == "6A") {
[6877]880 int ii = biasSat->NumberOfCodeBiases;
881 if (ii >= CLOCKORBIT_NUMBIAS)
882 break;
[6844]883 biasSat->NumberOfCodeBiases += 1;
884 biasSat->Biases[ii].Type = CODETYPEGALILEO_E6_A;
885 biasSat->Biases[ii].Bias = it.value();
886 }
887 else if (it.key() == "6B") {
[6877]888 int ii = biasSat->NumberOfCodeBiases;
889 if (ii >= CLOCKORBIT_NUMBIAS)
890 break;
[6844]891 biasSat->NumberOfCodeBiases += 1;
892 biasSat->Biases[ii].Type = CODETYPEGALILEO_E6_B;
893 biasSat->Biases[ii].Bias = it.value();
894 }
895 else if (it.key() == "6C") {
[6877]896 int ii = biasSat->NumberOfCodeBiases;
897 if (ii >= CLOCKORBIT_NUMBIAS)
898 break;
[6844]899 biasSat->NumberOfCodeBiases += 1;
900 biasSat->Biases[ii].Type = CODETYPEGALILEO_E6_C;
901 biasSat->Biases[ii].Bias = it.value();
902 }
[7940]903 else if (it.key() == "6X") {
904 int ii = biasSat->NumberOfCodeBiases;
905 if (ii >= CLOCKORBIT_NUMBIAS)
906 break;
907 biasSat->NumberOfCodeBiases += 1;
908 biasSat->Biases[ii].Type = CODETYPEGALILEO_E6_BC;
909 biasSat->Biases[ii].Bias = it.value();
910 }
911 else if (it.key() == "6Z") {
912 int ii = biasSat->NumberOfCodeBiases;
913 if (ii >= CLOCKORBIT_NUMBIAS)
914 break;
915 biasSat->NumberOfCodeBiases += 1;
916 biasSat->Biases[ii].Type = CODETYPEGALILEO_E6_ABC;
917 biasSat->Biases[ii].Bias = it.value();
918 }
[6844]919 }
920 }
[6876]921 else if (prn.system() == 'J') {
[6844]922 QMapIterator<QString, double> it(codeBiases);
923 while (it.hasNext()) {
924 it.next();
[6877]925 if (it.key() == "1C") {
926 int ii = biasSat->NumberOfCodeBiases;
927 if (ii >= CLOCKORBIT_NUMBIAS)
928 break;
[6844]929 biasSat->NumberOfCodeBiases += 1;
930 biasSat->Biases[ii].Type = CODETYPEQZSS_L1_CA;
931 biasSat->Biases[ii].Bias = it.value();
932 }
933 else if (it.key() == "1S") {
[6877]934 int ii = biasSat->NumberOfCodeBiases;
935 if (ii >= CLOCKORBIT_NUMBIAS)
936 break;
[6844]937 biasSat->NumberOfCodeBiases += 1;
938 biasSat->Biases[ii].Type = CODETYPEQZSS_L1C_D;
939 biasSat->Biases[ii].Bias = it.value();
940 }
941 else if (it.key() == "1L") {
[6877]942 int ii = biasSat->NumberOfCodeBiases;
943 if (ii >= CLOCKORBIT_NUMBIAS)
944 break;
[6844]945 biasSat->NumberOfCodeBiases += 1;
946 biasSat->Biases[ii].Type = CODETYPEQZSS_L1C_P;
947 biasSat->Biases[ii].Bias = it.value();
948 }
949 else if (it.key() == "1X") {
[6877]950 int ii = biasSat->NumberOfCodeBiases;
951 if (ii >= CLOCKORBIT_NUMBIAS)
952 break;
[6844]953 biasSat->NumberOfCodeBiases += 1;
954 biasSat->Biases[ii].Type = CODETYPEQZSS_L1C_DP;
955 biasSat->Biases[ii].Bias = it.value();
956 }
957 else if (it.key() == "2S") {
[6877]958 int ii = biasSat->NumberOfCodeBiases;
959 if (ii >= CLOCKORBIT_NUMBIAS)
960 break;
[6844]961 biasSat->NumberOfCodeBiases += 1;
[7940]962 biasSat->Biases[ii].Type = CODETYPEQZSS_L2C_M;
[6844]963 biasSat->Biases[ii].Bias = it.value();
964 }
965 else if (it.key() == "2L") {
[6877]966 int ii = biasSat->NumberOfCodeBiases;
967 if (ii >= CLOCKORBIT_NUMBIAS)
968 break;
[6844]969 biasSat->NumberOfCodeBiases += 1;
[7940]970 biasSat->Biases[ii].Type = CODETYPEQZSS_L2C_L;
[6844]971 biasSat->Biases[ii].Bias = it.value();
972 }
973 else if (it.key() == "2X") {
[6877]974 int ii = biasSat->NumberOfCodeBiases;
975 if (ii >= CLOCKORBIT_NUMBIAS)
976 break;
[6844]977 biasSat->NumberOfCodeBiases += 1;
[7940]978 biasSat->Biases[ii].Type = CODETYPEQZSS_L2C_ML;
[6844]979 biasSat->Biases[ii].Bias = it.value();
980 }
981 else if (it.key() == "5I") {
[6877]982 int ii = biasSat->NumberOfCodeBiases;
983 if (ii >= CLOCKORBIT_NUMBIAS)
984 break;
[6844]985 biasSat->NumberOfCodeBiases += 1;
986 biasSat->Biases[ii].Type = CODETYPEQZSS_L5_I;
987 biasSat->Biases[ii].Bias = it.value();
988 }
989 else if (it.key() == "5Q") {
[6877]990 int ii = biasSat->NumberOfCodeBiases;
991 if (ii >= CLOCKORBIT_NUMBIAS)
992 break;
[6844]993 biasSat->NumberOfCodeBiases += 1;
994 biasSat->Biases[ii].Type = CODETYPEQZSS_L5_Q;
995 biasSat->Biases[ii].Bias = it.value();
996 }
997 else if (it.key() == "5X") {
[6877]998 int ii = biasSat->NumberOfCodeBiases;
999 if (ii >= CLOCKORBIT_NUMBIAS)
1000 break;
[6844]1001 biasSat->NumberOfCodeBiases += 1;
1002 biasSat->Biases[ii].Type = CODETYPEQZSS_L5_IQ;
1003 biasSat->Biases[ii].Bias = it.value();
1004 }
1005 else if (it.key() == "6S") {
[6877]1006 int ii = biasSat->NumberOfCodeBiases;
1007 if (ii >= CLOCKORBIT_NUMBIAS)
1008 break;
[6844]1009 biasSat->NumberOfCodeBiases += 1;
1010 biasSat->Biases[ii].Type = CODETYPEQZSS_LEX_S;
1011 biasSat->Biases[ii].Bias = it.value();
1012 }
1013 else if (it.key() == "6L") {
[6877]1014 int ii = biasSat->NumberOfCodeBiases;
1015 if (ii >= CLOCKORBIT_NUMBIAS)
1016 break;
[6844]1017 biasSat->NumberOfCodeBiases += 1;
1018 biasSat->Biases[ii].Type = CODETYPEQZSS_LEX_L;
1019 biasSat->Biases[ii].Bias = it.value();
1020 }
1021 else if (it.key() == "6X") {
[6877]1022 int ii = biasSat->NumberOfCodeBiases;
1023 if (ii >= CLOCKORBIT_NUMBIAS)
1024 break;
[6844]1025 biasSat->NumberOfCodeBiases += 1;
1026 biasSat->Biases[ii].Type = CODETYPEQZSS_LEX_SL;
1027 biasSat->Biases[ii].Bias = it.value();
1028 }
1029 }
1030 }
[6876]1031 else if (prn.system() == 'S') {
[6844]1032 QMapIterator<QString, double> it(codeBiases);
1033 while (it.hasNext()) {
1034 it.next();
[6877]1035 if (it.key() == "1C") {
1036 int ii = biasSat->NumberOfCodeBiases;
1037 if (ii >= CLOCKORBIT_NUMBIAS)
1038 break;
[6844]1039 biasSat->NumberOfCodeBiases += 1;
1040 biasSat->Biases[ii].Type = CODETYPE_SBAS_L1_CA;
1041 biasSat->Biases[ii].Bias = it.value();
1042 }
1043 else if (it.key() == "5I") {
[6877]1044 int ii = biasSat->NumberOfCodeBiases;
1045 if (ii >= CLOCKORBIT_NUMBIAS)
1046 break;
[6844]1047 biasSat->NumberOfCodeBiases += 1;
1048 biasSat->Biases[ii].Type = CODETYPE_SBAS_L5_I;
1049 biasSat->Biases[ii].Bias = it.value();
1050 }
1051 else if (it.key() == "5Q") {
[6877]1052 int ii = biasSat->NumberOfCodeBiases;
1053 if (ii >= CLOCKORBIT_NUMBIAS)
1054 break;
[6844]1055 biasSat->NumberOfCodeBiases += 1;
1056 biasSat->Biases[ii].Type = CODETYPE_SBAS_L5_Q;
1057 biasSat->Biases[ii].Bias = it.value();
1058 }
1059 else if (it.key() == "5X") {
[6877]1060 int ii = biasSat->NumberOfCodeBiases;
1061 if (ii >= CLOCKORBIT_NUMBIAS)
1062 break;
[6844]1063 biasSat->NumberOfCodeBiases += 1;
1064 biasSat->Biases[ii].Type = CODETYPE_SBAS_L5_IQ;
1065 biasSat->Biases[ii].Bias = it.value();
1066 }
1067 }
1068 }
[6876]1069 else if (prn.system() == 'C') {
[6844]1070 QMapIterator<QString, double> it(codeBiases);
1071 while (it.hasNext()) {
1072 it.next();
[6877]1073 if (it.key() == "2I") {
1074 int ii = biasSat->NumberOfCodeBiases;
1075 if (ii >= CLOCKORBIT_NUMBIAS)
1076 break;
[6844]1077 biasSat->NumberOfCodeBiases += 1;
1078 biasSat->Biases[ii].Type = CODETYPE_BDS_B1_I;
1079 biasSat->Biases[ii].Bias = it.value();
1080 }
1081 else if (it.key() == "2Q") {
[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_B1_Q;
1087 biasSat->Biases[ii].Bias = it.value();
1088 }
1089 else if (it.key() == "2X") {
[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_B1_IQ;
1095 biasSat->Biases[ii].Bias = it.value();
1096 }
1097 else if (it.key() == "6I") {
[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_B3_I;
1103 biasSat->Biases[ii].Bias = it.value();
1104 }
1105 else if (it.key() == "6Q") {
[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_B3_Q;
1111 biasSat->Biases[ii].Bias = it.value();
1112 }
1113 else if (it.key() == "6X") {
[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_B3_IQ;
1119 biasSat->Biases[ii].Bias = it.value();
1120 }
1121 else if (it.key() == "7I") {
[6877]1122 int ii = biasSat->NumberOfCodeBiases;
1123 if (ii >= CLOCKORBIT_NUMBIAS)
1124 break;
[6844]1125 biasSat->NumberOfCodeBiases += 1;
1126 biasSat->Biases[ii].Type = CODETYPE_BDS_B2_I;
1127 biasSat->Biases[ii].Bias = it.value();
1128 }
1129 else if (it.key() == "7Q") {
[6877]1130 int ii = biasSat->NumberOfCodeBiases;
1131 if (ii >= CLOCKORBIT_NUMBIAS)
1132 break;
[6844]1133 biasSat->NumberOfCodeBiases += 1;
1134 biasSat->Biases[ii].Type = CODETYPE_BDS_B2_Q;
1135 biasSat->Biases[ii].Bias = it.value();
1136 }
1137 else if (it.key() == "7X") {
[6877]1138 int ii = biasSat->NumberOfCodeBiases;
1139 if (ii >= CLOCKORBIT_NUMBIAS)
1140 break;
[6844]1141 biasSat->NumberOfCodeBiases += 1;
1142 biasSat->Biases[ii].Type = CODETYPE_BDS_B2_IQ;
1143 biasSat->Biases[ii].Bias = it.value();
1144 }
1145 }
1146 }
[3222]1147 }
[6850]1148 // Phase Biases
1149 // ------------
1150 struct PhaseBias::PhaseBiasSat* phasebiasSat = 0;
[6877]1151 if (!phaseBiasList.isEmpty()) {
1152 if (prn.system() == 'G') {
1153 phasebiasSat = phasebias.Sat
1154 + phasebias.NumberOfSat[CLOCKORBIT_SATGPS];
1155 ++phasebias.NumberOfSat[CLOCKORBIT_SATGPS];
1156 }
1157 else if (prn.system() == 'R') {
1158 phasebiasSat = phasebias.Sat + CLOCKORBIT_NUMGPS
1159 + phasebias.NumberOfSat[CLOCKORBIT_SATGLONASS];
1160 ++phasebias.NumberOfSat[CLOCKORBIT_SATGLONASS];
1161 }
1162 else if (prn.system() == 'E') {
1163 phasebiasSat = phasebias.Sat + CLOCKORBIT_NUMGPS
1164 + CLOCKORBIT_NUMGLONASS
1165 + phasebias.NumberOfSat[CLOCKORBIT_SATGALILEO];
1166 ++phasebias.NumberOfSat[CLOCKORBIT_SATGALILEO];
1167 }
1168 else if (prn.system() == 'J') {
1169 phasebiasSat = phasebias.Sat + CLOCKORBIT_NUMGPS
1170 + CLOCKORBIT_NUMGLONASS + CLOCKORBIT_NUMGALILEO
1171 + phasebias.NumberOfSat[CLOCKORBIT_SATQZSS];
1172 ++phasebias.NumberOfSat[CLOCKORBIT_SATQZSS];
1173 }
1174 else if (prn.system() == 'S') {
1175 phasebiasSat = phasebias.Sat + CLOCKORBIT_NUMGPS
1176 + CLOCKORBIT_NUMGLONASS + CLOCKORBIT_NUMGALILEO
1177 + CLOCKORBIT_NUMQZSS + phasebias.NumberOfSat[CLOCKORBIT_SATSBAS];
1178 ++phasebias.NumberOfSat[CLOCKORBIT_SATSBAS];
1179 }
1180 else if (prn.system() == 'C') {
1181 phasebiasSat = phasebias.Sat + CLOCKORBIT_NUMGPS
1182 + CLOCKORBIT_NUMGLONASS + CLOCKORBIT_NUMGALILEO
1183 + CLOCKORBIT_NUMQZSS + CLOCKORBIT_NUMSBAS
1184 + phasebias.NumberOfSat[CLOCKORBIT_SATBDS];
1185 ++phasebias.NumberOfSat[CLOCKORBIT_SATBDS];
1186 }
[6850]1187 }
1188
1189 if (phasebiasSat) {
[6860]1190 phasebias.DispersiveBiasConsistencyIndicator = dispInd;
1191 phasebias.MWConsistencyIndicator = mwInd;
[6876]1192 phasebiasSat->ID = prn.number();
[6850]1193 phasebiasSat->NumberOfPhaseBiases = 0;
[6851]1194 phasebiasSat->YawAngle = pbSat.yA;
1195 phasebiasSat->YawRate = pbSat.yR;
[6877]1196 if (prn.system() == 'G') {
[6851]1197 QListIterator<phaseBiasSignal> it(phaseBiasList);
[6850]1198 while (it.hasNext()) {
[6851]1199 const phaseBiasSignal &pbSig = it.next();
[6877]1200 if (pbSig.type == "1C") {
1201 int ii = phasebiasSat->NumberOfPhaseBiases;
1202 if (ii >= CLOCKORBIT_NUMBIAS)
1203 break;
[6850]1204 phasebiasSat->NumberOfPhaseBiases += 1;
1205 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L1_CA;
[6851]1206 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1207 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1208 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1209 pbSig.wlInd;
1210 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1211 pbSig.discCount;
[6850]1212 }
[8004]1213 else if (pbSig.type == "1S") {
1214 int ii = phasebiasSat->NumberOfPhaseBiases;
1215 if (ii >= CLOCKORBIT_NUMBIAS)
1216 break;
1217 phasebiasSat->NumberOfPhaseBiases += 1;
1218 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L1C_D;
1219 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1220 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1221 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1222 pbSig.wlInd;
1223 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1224 pbSig.discCount;
1225 }
1226 else if (pbSig.type == "1L") {
1227 int ii = phasebiasSat->NumberOfPhaseBiases;
1228 if (ii >= CLOCKORBIT_NUMBIAS)
1229 break;
1230 phasebiasSat->NumberOfPhaseBiases += 1;
1231 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L1C_P;
1232 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1233 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1234 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1235 pbSig.wlInd;
1236 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1237 pbSig.discCount;
1238 }
1239 else if (pbSig.type == "1X") {
1240 int ii = phasebiasSat->NumberOfPhaseBiases;
1241 if (ii >= CLOCKORBIT_NUMBIAS)
1242 break;
1243 phasebiasSat->NumberOfPhaseBiases += 1;
1244 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L1C_P;
1245 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1246 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1247 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1248 pbSig.wlInd;
1249 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1250 pbSig.discCount;
1251 }
[6851]1252 else if (pbSig.type == "1P") {
[6877]1253 int ii = phasebiasSat->NumberOfPhaseBiases;
1254 if (ii >= CLOCKORBIT_NUMBIAS)
1255 break;
[6850]1256 phasebiasSat->NumberOfPhaseBiases += 1;
1257 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L1_P;
[6851]1258 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1259 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1260 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1261 pbSig.wlInd;
1262 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1263 pbSig.discCount;
[6850]1264 }
[6851]1265 else if (pbSig.type == "1W") {
[6877]1266 int ii = phasebiasSat->NumberOfPhaseBiases;
1267 if (ii >= CLOCKORBIT_NUMBIAS)
1268 break;
[6850]1269 phasebiasSat->NumberOfPhaseBiases += 1;
1270 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L1_Z;
[6851]1271 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1272 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1273 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1274 pbSig.wlInd;
1275 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1276 pbSig.discCount;
[6850]1277 }
[6851]1278 else if (pbSig.type == "2C") {
[6877]1279 int ii = phasebiasSat->NumberOfPhaseBiases;
1280 if (ii >= CLOCKORBIT_NUMBIAS)
1281 break;
[6850]1282 phasebiasSat->NumberOfPhaseBiases += 1;
1283 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L2_CA;
[6851]1284 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1285 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1286 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1287 pbSig.wlInd;
1288 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1289 pbSig.discCount;
[6850]1290 }
[6851]1291 else if (pbSig.type == "2D") {
[6877]1292 int ii = phasebiasSat->NumberOfPhaseBiases;
1293 if (ii >= CLOCKORBIT_NUMBIAS)
1294 break;
[6850]1295 phasebiasSat->NumberOfPhaseBiases += 1;
1296 phasebiasSat->Biases[ii].Type = CODETYPEGPS_SEMI_CODELESS;
[6851]1297 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1298 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1299 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1300 pbSig.wlInd;
1301 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1302 pbSig.discCount;
[6850]1303 }
[6851]1304 else if (pbSig.type == "2S") {
[6877]1305 int ii = phasebiasSat->NumberOfPhaseBiases;
1306 if (ii >= CLOCKORBIT_NUMBIAS)
1307 break;
[6850]1308 phasebiasSat->NumberOfPhaseBiases += 1;
1309 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L2_CM;
[6851]1310 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1311 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1312 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1313 pbSig.wlInd;
1314 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1315 pbSig.discCount;
[6850]1316 }
[6851]1317 else if (pbSig.type == "2L") {
[6877]1318 int ii = phasebiasSat->NumberOfPhaseBiases;
1319 if (ii >= CLOCKORBIT_NUMBIAS)
1320 break;
[6850]1321 phasebiasSat->NumberOfPhaseBiases += 1;
1322 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L2_CL;
[6851]1323 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1324 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1325 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1326 pbSig.wlInd;
1327 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1328 pbSig.discCount;
[6850]1329 }
[6851]1330 else if (pbSig.type == "2X") {
[6877]1331 int ii = phasebiasSat->NumberOfPhaseBiases;
1332 if (ii >= CLOCKORBIT_NUMBIAS)
1333 break;
[6850]1334 phasebiasSat->NumberOfPhaseBiases += 1;
1335 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L2_CML;
[6851]1336 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1337 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1338 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1339 pbSig.wlInd;
1340 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1341 pbSig.discCount;
[6850]1342 }
[6851]1343 else if (pbSig.type == "2P") {
[6877]1344 int ii = phasebiasSat->NumberOfPhaseBiases;
1345 if (ii >= CLOCKORBIT_NUMBIAS)
1346 break;
[6850]1347 phasebiasSat->NumberOfPhaseBiases += 1;
1348 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L2_P;
[6851]1349 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1350 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1351 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1352 pbSig.wlInd;
1353 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1354 pbSig.discCount;
[6850]1355 }
[6851]1356 else if (pbSig.type == "2W") {
[6877]1357 int ii = phasebiasSat->NumberOfPhaseBiases;
1358 if (ii >= CLOCKORBIT_NUMBIAS)
1359 break;
[6850]1360 phasebiasSat->NumberOfPhaseBiases += 1;
1361 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L2_Z;
[6851]1362 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1363 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1364 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1365 pbSig.wlInd;
1366 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1367 pbSig.discCount;
[6850]1368 }
[6851]1369 else if (pbSig.type == "5I") {
[6877]1370 int ii = phasebiasSat->NumberOfPhaseBiases;
1371 if (ii >= CLOCKORBIT_NUMBIAS)
1372 break;
[6850]1373 phasebiasSat->NumberOfPhaseBiases += 1;
1374 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L5_I;
[6851]1375 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1376 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1377 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1378 pbSig.wlInd;
1379 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1380 pbSig.discCount;
[6850]1381 }
[6851]1382 else if (pbSig.type == "5Q") {
[6877]1383 int ii = phasebiasSat->NumberOfPhaseBiases;
1384 if (ii >= CLOCKORBIT_NUMBIAS)
1385 break;
[6850]1386 phasebiasSat->NumberOfPhaseBiases += 1;
1387 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L5_Q;
[6851]1388 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1389 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1390 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1391 pbSig.wlInd;
1392 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1393 pbSig.discCount;
[6850]1394 }
[6851]1395 else if (pbSig.type == "5X") {
[6877]1396 int ii = phasebiasSat->NumberOfPhaseBiases;
1397 if (ii >= CLOCKORBIT_NUMBIAS)
1398 break;
[6850]1399 phasebiasSat->NumberOfPhaseBiases += 1;
1400 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L5_IQ;
[6851]1401 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1402 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1403 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1404 pbSig.wlInd;
1405 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1406 pbSig.discCount;
[6850]1407 }
1408 }
1409 }
[6877]1410 if (prn.system() == 'R') {
[6851]1411 QListIterator<phaseBiasSignal> it(phaseBiasList);
[6850]1412 while (it.hasNext()) {
[6851]1413 const phaseBiasSignal &pbSig = it.next();
[6877]1414 if (pbSig.type == "1C") {
1415 int ii = phasebiasSat->NumberOfPhaseBiases;
1416 if (ii >= CLOCKORBIT_NUMBIAS)
1417 break;
[6850]1418 phasebiasSat->NumberOfPhaseBiases += 1;
1419 phasebiasSat->Biases[ii].Type = CODETYPEGLONASS_L1_CA;
[6851]1420 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1421 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1422 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1423 pbSig.wlInd;
1424 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1425 pbSig.discCount;
[6850]1426 }
[6851]1427 else if (pbSig.type == "1P") {
[6877]1428 int ii = phasebiasSat->NumberOfPhaseBiases;
1429 if (ii >= CLOCKORBIT_NUMBIAS)
1430 break;
[6850]1431 phasebiasSat->NumberOfPhaseBiases += 1;
1432 phasebiasSat->Biases[ii].Type = CODETYPEGLONASS_L1_P;
[6851]1433 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1434 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1435 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1436 pbSig.wlInd;
1437 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1438 pbSig.discCount;
[6850]1439 }
[6851]1440 else if (pbSig.type == "2C") {
[6877]1441 int ii = phasebiasSat->NumberOfPhaseBiases;
1442 if (ii >= CLOCKORBIT_NUMBIAS)
1443 break;
[6850]1444 phasebiasSat->NumberOfPhaseBiases += 1;
1445 phasebiasSat->Biases[ii].Type = CODETYPEGLONASS_L2_CA;
[6851]1446 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1447 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1448 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1449 pbSig.wlInd;
1450 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1451 pbSig.discCount;
[6850]1452 }
[6851]1453 else if (pbSig.type == "2P") {
[6877]1454 int ii = phasebiasSat->NumberOfPhaseBiases;
1455 if (ii >= CLOCKORBIT_NUMBIAS)
1456 break;
[6850]1457 phasebiasSat->NumberOfPhaseBiases += 1;
1458 phasebiasSat->Biases[ii].Type = CODETYPEGLONASS_L2_P;
[6851]1459 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1460 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1461 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1462 pbSig.wlInd;
1463 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1464 pbSig.discCount;
[6850]1465 }
1466 }
1467 }
[6877]1468 if (prn.system() == 'E') {
[6851]1469 QListIterator<phaseBiasSignal> it(phaseBiasList);
[6850]1470 while (it.hasNext()) {
[6851]1471 const phaseBiasSignal &pbSig = it.next();
[6877]1472 if (pbSig.type == "1A") {
1473 int ii = phasebiasSat->NumberOfPhaseBiases;
1474 if (ii >= CLOCKORBIT_NUMBIAS)
1475 break;
[6850]1476 phasebiasSat->NumberOfPhaseBiases += 1;
1477 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E1_A;
[6851]1478 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1479 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1480 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1481 pbSig.wlInd;
1482 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1483 pbSig.discCount;
[6850]1484 }
[6851]1485 else if (pbSig.type == "1B") {
[6877]1486 int ii = phasebiasSat->NumberOfPhaseBiases;
1487 if (ii >= CLOCKORBIT_NUMBIAS)
1488 break;
[6850]1489 phasebiasSat->NumberOfPhaseBiases += 1;
1490 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E1_B;
[6851]1491 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1492 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1493 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1494 pbSig.wlInd;
1495 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1496 pbSig.discCount;
[6850]1497 }
[6851]1498 else if (pbSig.type == "1C") {
[6877]1499 int ii = phasebiasSat->NumberOfPhaseBiases;
1500 if (ii >= CLOCKORBIT_NUMBIAS)
1501 break;
[6850]1502 phasebiasSat->NumberOfPhaseBiases += 1;
1503 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E1_C;
[6851]1504 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1505 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1506 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1507 pbSig.wlInd;
1508 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1509 pbSig.discCount;
[6850]1510 }
[7940]1511 else if (pbSig.type == "1X") {
1512 int ii = phasebiasSat->NumberOfPhaseBiases;
1513 if (ii >= CLOCKORBIT_NUMBIAS)
1514 break;
1515 phasebiasSat->NumberOfPhaseBiases += 1;
1516 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E1_BC;
1517 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1518 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1519 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1520 pbSig.wlInd;
1521 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1522 pbSig.discCount;
1523 }
1524 else if (pbSig.type == "1Z") {
1525 int ii = phasebiasSat->NumberOfPhaseBiases;
1526 if (ii >= CLOCKORBIT_NUMBIAS)
1527 break;
1528 phasebiasSat->NumberOfPhaseBiases += 1;
1529 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E1_ABC;
1530 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1531 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1532 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1533 pbSig.wlInd;
1534 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1535 pbSig.discCount;
1536 }
[6851]1537 else if (pbSig.type == "5I") {
[6877]1538 int ii = phasebiasSat->NumberOfPhaseBiases;
1539 if (ii >= CLOCKORBIT_NUMBIAS)
1540 break;
[6850]1541 phasebiasSat->NumberOfPhaseBiases += 1;
1542 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E5A_I;
[6851]1543 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1544 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1545 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1546 pbSig.wlInd;
1547 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1548 pbSig.discCount;
[6850]1549 }
[6851]1550 else if (pbSig.type == "5Q") {
[6877]1551 int ii = phasebiasSat->NumberOfPhaseBiases;
1552 if (ii >= CLOCKORBIT_NUMBIAS)
1553 break;
[6850]1554 phasebiasSat->NumberOfPhaseBiases += 1;
1555 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E5A_Q;
[6851]1556 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1557 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1558 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1559 pbSig.wlInd;
1560 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1561 pbSig.discCount;
[6850]1562 }
[7940]1563 else if (pbSig.type == "5X") {
1564 int ii = phasebiasSat->NumberOfPhaseBiases;
1565 if (ii >= CLOCKORBIT_NUMBIAS)
1566 break;
1567 phasebiasSat->NumberOfPhaseBiases += 1;
1568 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E5A_IQ;
1569 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1570 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1571 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1572 pbSig.wlInd;
1573 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1574 pbSig.discCount;
1575 }
[6851]1576 else if (pbSig.type == "7I") {
[6877]1577 int ii = phasebiasSat->NumberOfPhaseBiases;
1578 if (ii >= CLOCKORBIT_NUMBIAS)
1579 break;
[6850]1580 phasebiasSat->NumberOfPhaseBiases += 1;
1581 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E5B_I;
[6851]1582 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1583 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1584 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1585 pbSig.wlInd;
1586 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1587 pbSig.discCount;
[6850]1588 }
[6851]1589 else if (pbSig.type == "7Q") {
[6877]1590 int ii = phasebiasSat->NumberOfPhaseBiases;
1591 if (ii >= CLOCKORBIT_NUMBIAS)
1592 break;
[6850]1593 phasebiasSat->NumberOfPhaseBiases += 1;
1594 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E5B_Q;
[6851]1595 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1596 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1597 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1598 pbSig.wlInd;
1599 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1600 pbSig.discCount;
[6850]1601 }
[7940]1602 else if (pbSig.type == "7X") {
1603 int ii = phasebiasSat->NumberOfPhaseBiases;
1604 if (ii >= CLOCKORBIT_NUMBIAS)
1605 break;
1606 phasebiasSat->NumberOfPhaseBiases += 1;
1607 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E5B_IQ;
1608 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1609 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1610 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1611 pbSig.wlInd;
1612 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1613 pbSig.discCount;
1614 }
[6851]1615 else if (pbSig.type == "8I") {
[6877]1616 int ii = phasebiasSat->NumberOfPhaseBiases;
1617 if (ii >= CLOCKORBIT_NUMBIAS)
1618 break;
[6850]1619 phasebiasSat->NumberOfPhaseBiases += 1;
1620 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E5_I;
[6851]1621 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1622 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1623 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1624 pbSig.wlInd;
1625 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1626 pbSig.discCount;
[6850]1627 }
[6851]1628 else if (pbSig.type == "8Q") {
[6877]1629 int ii = phasebiasSat->NumberOfPhaseBiases;
1630 if (ii >= CLOCKORBIT_NUMBIAS)
1631 break;
[6850]1632 phasebiasSat->NumberOfPhaseBiases += 1;
1633 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E5_Q;
[6851]1634 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1635 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1636 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1637 pbSig.wlInd;
1638 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1639 pbSig.discCount;
[6850]1640 }
[7940]1641 else if (pbSig.type == "8X") {
1642 int ii = phasebiasSat->NumberOfPhaseBiases;
1643 if (ii >= CLOCKORBIT_NUMBIAS)
1644 break;
1645 phasebiasSat->NumberOfPhaseBiases += 1;
1646 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E5_IQ;
1647 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1648 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1649 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1650 pbSig.wlInd;
1651 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1652 pbSig.discCount;
1653 }
[6851]1654 else if (pbSig.type == "6A") {
[6877]1655 int ii = phasebiasSat->NumberOfPhaseBiases;
1656 if (ii >= CLOCKORBIT_NUMBIAS)
1657 break;
[6850]1658 phasebiasSat->NumberOfPhaseBiases += 1;
1659 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E6_A;
[6851]1660 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1661 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1662 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1663 pbSig.wlInd;
1664 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1665 pbSig.discCount;
[6850]1666 }
[6851]1667 else if (pbSig.type == "6B") {
[6877]1668 int ii = phasebiasSat->NumberOfPhaseBiases;
1669 if (ii >= CLOCKORBIT_NUMBIAS)
1670 break;
[6850]1671 phasebiasSat->NumberOfPhaseBiases += 1;
1672 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E6_B;
[6851]1673 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1674 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1675 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1676 pbSig.wlInd;
1677 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1678 pbSig.discCount;
[6850]1679 }
[6851]1680 else if (pbSig.type == "6C") {
[6877]1681 int ii = phasebiasSat->NumberOfPhaseBiases;
1682 if (ii >= CLOCKORBIT_NUMBIAS)
1683 break;
[6850]1684 phasebiasSat->NumberOfPhaseBiases += 1;
1685 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E6_C;
[6851]1686 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1687 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1688 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1689 pbSig.wlInd;
1690 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1691 pbSig.discCount;
[6850]1692 }
[7940]1693 else if (pbSig.type == "6X") {
1694 int ii = phasebiasSat->NumberOfPhaseBiases;
1695 if (ii >= CLOCKORBIT_NUMBIAS)
1696 break;
1697 phasebiasSat->NumberOfPhaseBiases += 1;
1698 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E6_BC;
1699 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1700 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1701 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1702 pbSig.wlInd;
1703 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1704 pbSig.discCount;
1705 }
1706 else if (pbSig.type == "6Z") {
1707 int ii = phasebiasSat->NumberOfPhaseBiases;
1708 if (ii >= CLOCKORBIT_NUMBIAS)
1709 break;
1710 phasebiasSat->NumberOfPhaseBiases += 1;
1711 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E6_ABC;
1712 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1713 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1714 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1715 pbSig.wlInd;
1716 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1717 pbSig.discCount;
1718 }
[6850]1719 }
1720 }
[6877]1721 if (prn.system() == 'J') {
[6851]1722 QListIterator<phaseBiasSignal> it(phaseBiasList);
[6850]1723 while (it.hasNext()) {
[6851]1724 const phaseBiasSignal &pbSig = it.next();
[6877]1725 if (pbSig.type == "1C") {
1726 int ii = phasebiasSat->NumberOfPhaseBiases;
1727 if (ii >= CLOCKORBIT_NUMBIAS)
1728 break;
[6850]1729 phasebiasSat->NumberOfPhaseBiases += 1;
1730 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L1_CA;
[6851]1731 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1732 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1733 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1734 pbSig.wlInd;
1735 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1736 pbSig.discCount;
[6850]1737 }
[6851]1738 else if (pbSig.type == "1S") {
[6877]1739 int ii = phasebiasSat->NumberOfPhaseBiases;
1740 if (ii >= CLOCKORBIT_NUMBIAS)
1741 break;
[6850]1742 phasebiasSat->NumberOfPhaseBiases += 1;
1743 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L1C_D;
[6851]1744 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1745 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1746 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1747 pbSig.wlInd;
1748 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1749 pbSig.discCount;
[6850]1750 }
[6851]1751 else if (pbSig.type == "1L") {
[6877]1752 int ii = phasebiasSat->NumberOfPhaseBiases;
1753 if (ii >= CLOCKORBIT_NUMBIAS)
1754 break;
[6850]1755 phasebiasSat->NumberOfPhaseBiases += 1;
1756 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L1C_P;
[6851]1757 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1758 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1759 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1760 pbSig.wlInd;
1761 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1762 pbSig.discCount;
[6850]1763 }
[6851]1764 else if (pbSig.type == "1X") {
[6877]1765 int ii = phasebiasSat->NumberOfPhaseBiases;
1766 if (ii >= CLOCKORBIT_NUMBIAS)
1767 break;
[6850]1768 phasebiasSat->NumberOfPhaseBiases += 1;
1769 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L1C_DP;
[6851]1770 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1771 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1772 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1773 pbSig.wlInd;
1774 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1775 pbSig.discCount;
[6850]1776 }
[6851]1777 else if (pbSig.type == "2S") {
[6877]1778 int ii = phasebiasSat->NumberOfPhaseBiases;
1779 if (ii >= CLOCKORBIT_NUMBIAS)
1780 break;
[6850]1781 phasebiasSat->NumberOfPhaseBiases += 1;
[7940]1782 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L2C_M;
[6851]1783 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1784 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1785 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1786 pbSig.wlInd;
1787 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1788 pbSig.discCount;
[6850]1789 }
[6851]1790 else if (pbSig.type == "2L") {
[6877]1791 int ii = phasebiasSat->NumberOfPhaseBiases;
1792 if (ii >= CLOCKORBIT_NUMBIAS)
1793 break;
[6850]1794 phasebiasSat->NumberOfPhaseBiases += 1;
[7940]1795 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L2C_L;
[6851]1796 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1797 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1798 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1799 pbSig.wlInd;
1800 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1801 pbSig.discCount;
[6850]1802 }
[6851]1803 else if (pbSig.type == "2X") {
[6877]1804 int ii = phasebiasSat->NumberOfPhaseBiases;
1805 if (ii >= CLOCKORBIT_NUMBIAS)
1806 break;
[6850]1807 phasebiasSat->NumberOfPhaseBiases += 1;
[7940]1808 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L2C_ML;
[6851]1809 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1810 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1811 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1812 pbSig.wlInd;
1813 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1814 pbSig.discCount;
[6850]1815 }
[6851]1816 else if (pbSig.type == "5I") {
[6877]1817 int ii = phasebiasSat->NumberOfPhaseBiases;
1818 if (ii >= CLOCKORBIT_NUMBIAS)
1819 break;
[6850]1820 phasebiasSat->NumberOfPhaseBiases += 1;
1821 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L5_I;
[6851]1822 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1823 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1824 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1825 pbSig.wlInd;
1826 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1827 pbSig.discCount;
[6850]1828 }
[6851]1829 else if (pbSig.type == "5Q") {
[6877]1830 int ii = phasebiasSat->NumberOfPhaseBiases;
1831 if (ii >= CLOCKORBIT_NUMBIAS)
1832 break;
[6850]1833 phasebiasSat->NumberOfPhaseBiases += 1;
1834 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L5_Q;
[6851]1835 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1836 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1837 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1838 pbSig.wlInd;
1839 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1840 pbSig.discCount;
[6850]1841 }
[6851]1842 else if (pbSig.type == "5X") {
[6877]1843 int ii = phasebiasSat->NumberOfPhaseBiases;
1844 if (ii >= CLOCKORBIT_NUMBIAS)
1845 break;
[6850]1846 phasebiasSat->NumberOfPhaseBiases += 1;
1847 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L5_IQ;
[6851]1848 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1849 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1850 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1851 pbSig.wlInd;
1852 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1853 pbSig.discCount;
[6850]1854 }
[6851]1855 else if (pbSig.type == "6S") {
[6877]1856 int ii = phasebiasSat->NumberOfPhaseBiases;
1857 if (ii >= CLOCKORBIT_NUMBIAS)
1858 break;
[6850]1859 phasebiasSat->NumberOfPhaseBiases += 1;
1860 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_LEX_S;
[6851]1861 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1862 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1863 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1864 pbSig.wlInd;
1865 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1866 pbSig.discCount;
[6850]1867 }
[6851]1868 else if (pbSig.type == "6L") {
[6877]1869 int ii = phasebiasSat->NumberOfPhaseBiases;
1870 if (ii >= CLOCKORBIT_NUMBIAS)
1871 break;
[6850]1872 phasebiasSat->NumberOfPhaseBiases += 1;
1873 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_LEX_L;
[6851]1874 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1875 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1876 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1877 pbSig.wlInd;
1878 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1879 pbSig.discCount;
[6850]1880 }
[6851]1881 else if (pbSig.type == "6X") {
[6877]1882 int ii = phasebiasSat->NumberOfPhaseBiases;
1883 if (ii >= CLOCKORBIT_NUMBIAS)
1884 break;
[6850]1885 phasebiasSat->NumberOfPhaseBiases += 1;
1886 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_LEX_SL;
[6851]1887 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1888 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1889 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1890 pbSig.wlInd;
1891 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1892 pbSig.discCount;
[6850]1893 }
1894 }
1895 }
[6877]1896 if (prn.system() == 'S') {
[6851]1897 QListIterator<phaseBiasSignal> it(phaseBiasList);
[6850]1898 while (it.hasNext()) {
[6851]1899 const phaseBiasSignal &pbSig = it.next();
[6877]1900 if (pbSig.type == "1C") {
1901 int ii = phasebiasSat->NumberOfPhaseBiases;
1902 if (ii >= CLOCKORBIT_NUMBIAS)
1903 break;
[6850]1904 phasebiasSat->NumberOfPhaseBiases += 1;
1905 phasebiasSat->Biases[ii].Type = CODETYPE_SBAS_L1_CA;
[6851]1906 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1907 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1908 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1909 pbSig.wlInd;
1910 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1911 pbSig.discCount;
[6850]1912 }
[6851]1913 else if (pbSig.type == "5I") {
[6877]1914 int ii = phasebiasSat->NumberOfPhaseBiases;
1915 if (ii >= CLOCKORBIT_NUMBIAS)
1916 break;
[6850]1917 phasebiasSat->NumberOfPhaseBiases += 1;
1918 phasebiasSat->Biases[ii].Type = CODETYPE_SBAS_L5_I;
[6851]1919 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1920 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1921 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1922 pbSig.wlInd;
1923 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1924 pbSig.discCount;
[6850]1925 }
[6851]1926 else if (pbSig.type == "5Q") {
[6877]1927 int ii = phasebiasSat->NumberOfPhaseBiases;
1928 if (ii >= CLOCKORBIT_NUMBIAS)
1929 break;
[6850]1930 phasebiasSat->NumberOfPhaseBiases += 1;
1931 phasebiasSat->Biases[ii].Type = CODETYPE_SBAS_L5_Q;
[6851]1932 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1933 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1934 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1935 pbSig.wlInd;
1936 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1937 pbSig.discCount;
[6850]1938 }
[6851]1939 else if (pbSig.type == "5X") {
[6877]1940 int ii = phasebiasSat->NumberOfPhaseBiases;
1941 if (ii >= CLOCKORBIT_NUMBIAS)
1942 break;
[6850]1943 phasebiasSat->NumberOfPhaseBiases += 1;
1944 phasebiasSat->Biases[ii].Type = CODETYPE_SBAS_L5_IQ;
[6851]1945 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1946 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1947 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1948 pbSig.wlInd;
1949 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1950 pbSig.discCount;
[6850]1951 }
1952 }
1953 }
[6877]1954 if (prn.system() == 'C') {
[6851]1955 QListIterator<phaseBiasSignal> it(phaseBiasList);
[6850]1956 while (it.hasNext()) {
[6851]1957 const phaseBiasSignal &pbSig = it.next();
[6877]1958 if (pbSig.type == "2I") {
1959 int ii = phasebiasSat->NumberOfPhaseBiases;
1960 if (ii >= CLOCKORBIT_NUMBIAS)
1961 break;
[6850]1962 phasebiasSat->NumberOfPhaseBiases += 1;
1963 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B1_I;
[6851]1964 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1965 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1966 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1967 pbSig.wlInd;
1968 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1969 pbSig.discCount;
[6850]1970 }
[6851]1971 else if (pbSig.type == "2Q") {
[6877]1972 int ii = phasebiasSat->NumberOfPhaseBiases;
1973 if (ii >= CLOCKORBIT_NUMBIAS)
1974 break;
[6850]1975 phasebiasSat->NumberOfPhaseBiases += 1;
1976 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B1_Q;
[6851]1977 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1978 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1979 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1980 pbSig.wlInd;
1981 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1982 pbSig.discCount;
[6850]1983 }
[6851]1984 else if (pbSig.type == "2X") {
[6877]1985 int ii = phasebiasSat->NumberOfPhaseBiases;
1986 if (ii >= CLOCKORBIT_NUMBIAS)
1987 break;
[6850]1988 phasebiasSat->NumberOfPhaseBiases += 1;
1989 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B1_IQ;
[6851]1990 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]1991 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1992 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
1993 pbSig.wlInd;
1994 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
1995 pbSig.discCount;
[6850]1996 }
[6851]1997 else if (pbSig.type == "6I") {
[6877]1998 int ii = phasebiasSat->NumberOfPhaseBiases;
1999 if (ii >= CLOCKORBIT_NUMBIAS)
2000 break;
[6850]2001 phasebiasSat->NumberOfPhaseBiases += 1;
[7781]2002 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B3_I;
[6851]2003 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]2004 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
2005 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
2006 pbSig.wlInd;
2007 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
2008 pbSig.discCount;
[6850]2009 }
[6851]2010 else if (pbSig.type == "6Q") {
[6877]2011 int ii = phasebiasSat->NumberOfPhaseBiases;
2012 if (ii >= CLOCKORBIT_NUMBIAS)
2013 break;
[6850]2014 phasebiasSat->NumberOfPhaseBiases += 1;
[7781]2015 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B3_Q;
[6851]2016 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]2017 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
2018 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
2019 pbSig.wlInd;
2020 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
2021 pbSig.discCount;
[6850]2022 }
[6851]2023 else if (pbSig.type == "6X") {
[6877]2024 int ii = phasebiasSat->NumberOfPhaseBiases;
2025 if (ii >= CLOCKORBIT_NUMBIAS)
2026 break;
[6850]2027 phasebiasSat->NumberOfPhaseBiases += 1;
[7774]2028 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B3_IQ;
[6851]2029 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]2030 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
2031 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
2032 pbSig.wlInd;
2033 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
2034 pbSig.discCount;
[6850]2035 }
[6851]2036 else if (pbSig.type == "7I") {
[6877]2037 int ii = phasebiasSat->NumberOfPhaseBiases;
2038 if (ii >= CLOCKORBIT_NUMBIAS)
2039 break;
[6850]2040 phasebiasSat->NumberOfPhaseBiases += 1;
[7781]2041 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B2_I;
[6851]2042 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]2043 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
2044 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
2045 pbSig.wlInd;
2046 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
2047 pbSig.discCount;
[6850]2048 }
[6851]2049 else if (pbSig.type == "7Q") {
[6877]2050 int ii = phasebiasSat->NumberOfPhaseBiases;
2051 if (ii >= CLOCKORBIT_NUMBIAS)
2052 break;
[6850]2053 phasebiasSat->NumberOfPhaseBiases += 1;
[7781]2054 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B2_Q;
[6851]2055 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]2056 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
2057 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
2058 pbSig.wlInd;
2059 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
2060 pbSig.discCount;
[6850]2061 }
[6851]2062 else if (pbSig.type == "7X") {
[6877]2063 int ii = phasebiasSat->NumberOfPhaseBiases;
2064 if (ii >= CLOCKORBIT_NUMBIAS)
2065 break;
[6850]2066 phasebiasSat->NumberOfPhaseBiases += 1;
[7774]2067 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B2_IQ;
[6851]2068 phasebiasSat->Biases[ii].Bias = pbSig.bias;
[6877]2069 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
2070 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator =
2071 pbSig.wlInd;
2072 phasebiasSat->Biases[ii].SignalDiscontinuityCounter =
2073 pbSig.discCount;
[6850]2074 }
2075 }
2076 }
2077 }
[3222]2078 }
2079 }
[3227]2080
[5662]2081 QByteArray hlpBufferCo;
[3493]2082
2083 // Orbit and Clock Corrections together
2084 // ------------------------------------
[4174]2085 if (_samplRtcmEphCorr == 0.0) {
[6877]2086 if (co.NumberOfSat[CLOCKORBIT_SATGPS] > 0
2087 || co.NumberOfSat[CLOCKORBIT_SATGLONASS] > 0
2088 || co.NumberOfSat[CLOCKORBIT_SATGALILEO] > 0
2089 || co.NumberOfSat[CLOCKORBIT_SATQZSS] > 0
2090 || co.NumberOfSat[CLOCKORBIT_SATSBAS] > 0
2091 || co.NumberOfSat[CLOCKORBIT_SATBDS] > 0) {
[3493]2092 char obuffer[CLOCKORBIT_BUFFERSIZE];
2093 int len = MakeClockOrbit(&co, COTYPE_AUTO, 0, obuffer, sizeof(obuffer));
2094 if (len > 0) {
2095 hlpBufferCo = QByteArray(obuffer, len);
2096 }
[3222]2097 }
2098 }
[3493]2099
2100 // Orbit and Clock Corrections separately
2101 // --------------------------------------
2102 else {
[5666]2103 if (co.NumberOfSat[CLOCKORBIT_SATGPS] > 0) {
[3493]2104 char obuffer[CLOCKORBIT_BUFFERSIZE];
[4174]2105 if (fmod(epoTime.gpssec(), _samplRtcmEphCorr) == 0.0) {
[4754]2106 co.UpdateInterval = ephUpdInd;
[6877]2107 int len1 = MakeClockOrbit(&co, COTYPE_GPSORBIT, 1, obuffer,
2108 sizeof(obuffer));
[4754]2109 co.UpdateInterval = clkUpdInd;
[3493]2110 if (len1 > 0) {
2111 hlpBufferCo += QByteArray(obuffer, len1);
2112 }
2113 }
[5666]2114 int mmsg = (co.NumberOfSat[CLOCKORBIT_SATGLONASS] > 0) ? 1 : 0;
[6877]2115 int len2 = MakeClockOrbit(&co, COTYPE_GPSCLOCK, mmsg, obuffer,
2116 sizeof(obuffer));
[3493]2117 if (len2 > 0) {
2118 hlpBufferCo += QByteArray(obuffer, len2);
2119 }
2120 }
[5666]2121 if (co.NumberOfSat[CLOCKORBIT_SATGLONASS] > 0) {
[3493]2122 char obuffer[CLOCKORBIT_BUFFERSIZE];
[4174]2123 if (fmod(epoTime.gpssec(), _samplRtcmEphCorr) == 0.0) {
[4754]2124 co.UpdateInterval = ephUpdInd;
[6877]2125 int len1 = MakeClockOrbit(&co, COTYPE_GLONASSORBIT, 1, obuffer,
2126 sizeof(obuffer));
[4754]2127 co.UpdateInterval = clkUpdInd;
[3493]2128 if (len1 > 0) {
2129 hlpBufferCo += QByteArray(obuffer, len1);
2130 }
2131 }
[6844]2132 int mmsg = (co.NumberOfSat[CLOCKORBIT_SATGALILEO] > 0) ? 1 : 0;
[6877]2133 int len2 = MakeClockOrbit(&co, COTYPE_GLONASSCLOCK, mmsg, obuffer,
2134 sizeof(obuffer));
[3493]2135 if (len2 > 0) {
2136 hlpBufferCo += QByteArray(obuffer, len2);
2137 }
2138 }
[6844]2139 if (co.NumberOfSat[CLOCKORBIT_SATGALILEO] > 0) {
2140 char obuffer[CLOCKORBIT_BUFFERSIZE];
2141 if (fmod(epoTime.gpssec(), _samplRtcmEphCorr) == 0.0) {
2142 co.UpdateInterval = ephUpdInd;
[6877]2143 int len1 = MakeClockOrbit(&co, COTYPE_GALILEOORBIT, 1, obuffer,
2144 sizeof(obuffer));
[6844]2145 co.UpdateInterval = clkUpdInd;
2146 if (len1 > 0) {
2147 hlpBufferCo += QByteArray(obuffer, len1);
2148 }
2149 }
2150 int mmsg = (co.NumberOfSat[CLOCKORBIT_SATQZSS] > 0) ? 1 : 0;
[6877]2151 int len2 = MakeClockOrbit(&co, COTYPE_GALILEOCLOCK, mmsg, obuffer,
2152 sizeof(obuffer));
[6844]2153 if (len2 > 0) {
2154 hlpBufferCo += QByteArray(obuffer, len2);
2155 }
2156 }
2157 if (co.NumberOfSat[CLOCKORBIT_SATQZSS] > 0) {
2158 char obuffer[CLOCKORBIT_BUFFERSIZE];
2159 if (fmod(epoTime.gpssec(), _samplRtcmEphCorr) == 0.0) {
2160 co.UpdateInterval = ephUpdInd;
[6877]2161 int len1 = MakeClockOrbit(&co, COTYPE_QZSSORBIT, 1, obuffer,
2162 sizeof(obuffer));
[6844]2163 co.UpdateInterval = clkUpdInd;
2164 if (len1 > 0) {
2165 hlpBufferCo += QByteArray(obuffer, len1);
2166 }
2167 }
2168 int mmsg = (co.NumberOfSat[CLOCKORBIT_SATSBAS] > 0) ? 1 : 0;
[6877]2169 int len2 = MakeClockOrbit(&co, COTYPE_QZSSCLOCK, mmsg, obuffer,
2170 sizeof(obuffer));
[6844]2171 if (len2 > 0) {
2172 hlpBufferCo += QByteArray(obuffer, len2);
2173 }
2174 }
2175 if (co.NumberOfSat[CLOCKORBIT_SATSBAS] > 0) {
2176 char obuffer[CLOCKORBIT_BUFFERSIZE];
2177 if (fmod(epoTime.gpssec(), _samplRtcmEphCorr) == 0.0) {
2178 co.UpdateInterval = ephUpdInd;
[6877]2179 int len1 = MakeClockOrbit(&co, COTYPE_SBASORBIT, 1, obuffer,
2180 sizeof(obuffer));
[6844]2181 co.UpdateInterval = clkUpdInd;
2182 if (len1 > 0) {
2183 hlpBufferCo += QByteArray(obuffer, len1);
2184 }
2185 }
2186 int mmsg = (co.NumberOfSat[CLOCKORBIT_SATBDS] > 0) ? 1 : 0;
[6877]2187 int len2 = MakeClockOrbit(&co, COTYPE_SBASCLOCK, mmsg, obuffer,
2188 sizeof(obuffer));
[6844]2189 if (len2 > 0) {
2190 hlpBufferCo += QByteArray(obuffer, len2);
2191 }
2192 }
2193 if (co.NumberOfSat[CLOCKORBIT_SATBDS] > 0) {
2194 char obuffer[CLOCKORBIT_BUFFERSIZE];
2195 if (fmod(epoTime.gpssec(), _samplRtcmEphCorr) == 0.0) {
2196 co.UpdateInterval = ephUpdInd;
[6877]2197 int len1 = MakeClockOrbit(&co, COTYPE_BDSORBIT, 1, obuffer,
2198 sizeof(obuffer));
[6844]2199 co.UpdateInterval = clkUpdInd;
2200 if (len1 > 0) {
2201 hlpBufferCo += QByteArray(obuffer, len1);
2202 }
2203 }
[6877]2204 int len2 = MakeClockOrbit(&co, COTYPE_BDSCLOCK, 0, obuffer,
2205 sizeof(obuffer));
[6844]2206 if (len2 > 0) {
2207 hlpBufferCo += QByteArray(obuffer, len2);
2208 }
2209 }
[3493]2210 }
[5662]2211
[6850]2212 // Code Biases
2213 // -----------
[5662]2214 QByteArray hlpBufferBias;
[6877]2215 if (bias.NumberOfSat[CLOCKORBIT_SATGPS] > 0
2216 || bias.NumberOfSat[CLOCKORBIT_SATGLONASS] > 0
2217 || bias.NumberOfSat[CLOCKORBIT_SATGALILEO] > 0
2218 || bias.NumberOfSat[CLOCKORBIT_SATQZSS] > 0
2219 || bias.NumberOfSat[CLOCKORBIT_SATSBAS] > 0
2220 || bias.NumberOfSat[CLOCKORBIT_SATBDS] > 0) {
[3222]2221 char obuffer[CLOCKORBIT_BUFFERSIZE];
[5666]2222 int len = MakeCodeBias(&bias, BTYPE_AUTO, 0, obuffer, sizeof(obuffer));
[3222]2223 if (len > 0) {
[3227]2224 hlpBufferBias = QByteArray(obuffer, len);
[3222]2225 }
2226 }
[3227]2227
[6850]2228 // Phase Biases
2229 // ------------
2230 QByteArray hlpBufferPhaseBias;
[6877]2231 if (phasebias.NumberOfSat[CLOCKORBIT_SATGPS] > 0
2232 || phasebias.NumberOfSat[CLOCKORBIT_SATGLONASS] > 0
2233 || phasebias.NumberOfSat[CLOCKORBIT_SATGALILEO] > 0
2234 || phasebias.NumberOfSat[CLOCKORBIT_SATQZSS] > 0
2235 || phasebias.NumberOfSat[CLOCKORBIT_SATSBAS] > 0
2236 || phasebias.NumberOfSat[CLOCKORBIT_SATBDS] > 0) {
[6850]2237 char obuffer[CLOCKORBIT_BUFFERSIZE];
[6877]2238 int len = MakePhaseBias(&phasebias, PBTYPE_AUTO, 0, obuffer,
2239 sizeof(obuffer));
[6850]2240 if (len > 0) {
2241 hlpBufferPhaseBias = QByteArray(obuffer, len);
2242 }
2243 }
2244
2245 // VTEC
2246 // ----
2247 QByteArray hlpBufferVtec;
[6860]2248 if (vtec.NumLayers > 0) {
2249 char obuffer[CLOCKORBIT_BUFFERSIZE];
2250 int len = MakeVTEC(&vtec, 0, obuffer, sizeof(obuffer));
2251 if (len > 0) {
2252 hlpBufferVtec = QByteArray(obuffer, len);
2253 }
2254 }
[6850]2255
[6877]2256 _outBuffer += hlpBufferCo + hlpBufferBias + hlpBufferPhaseBias
2257 + hlpBufferVtec;
[3222]2258}
2259
[5662]2260//
[3222]2261////////////////////////////////////////////////////////////////////////////
[6442]2262void bncRtnetUploadCaster::processSatellite(const t_eph* eph, int GPSweek,
[6877]2263 double GPSweeks, const QString& prn, const ColumnVector& rtnAPC,
2264 double rtnClk, const ColumnVector& rtnVel, const ColumnVector& rtnCoM,
2265 struct ClockOrbit::SatData* sd, QString& outLine) {
[3222]2266
[4930]2267 // Broadcast Position and Velocity
2268 // -------------------------------
2269 ColumnVector xB(4);
2270 ColumnVector vB(3);
[6109]2271 eph->getCrd(bncTime(GPSweek, GPSweeks), xB, vB, false);
[5662]2272
[4991]2273 // Precise Position
2274 // ----------------
2275 ColumnVector xP = _CoM ? rtnCoM : rtnAPC;
[3222]2276
[5662]2277 double dc = 0.0;
[4930]2278 if (_crdTrafo != "IGS08") {
2279 crdTrafo(GPSweek, xP, dc);
2280 }
[5662]2281
[4930]2282 // Difference in xyz
2283 // -----------------
[6877]2284 ColumnVector dx = xB.Rows(1, 3) - xP;
2285 ColumnVector dv = vB - rtnVel;
[5662]2286
[4930]2287 // Difference in RSW
2288 // -----------------
[3222]2289 ColumnVector rsw(3);
[6877]2290 XYZ_to_RSW(xB.Rows(1, 3), vB, dx, rsw);
[3222]2291
[4930]2292 ColumnVector dotRsw(3);
[6877]2293 XYZ_to_RSW(xB.Rows(1, 3), vB, dv, dotRsw);
[3222]2294
[4930]2295 // Clock Correction
2296 // ----------------
[4991]2297 double dClk = rtnClk - (xB(4) - dc) * t_CST::c;
[3222]2298
2299 if (sd) {
[6877]2300 sd->ID = prn.mid(1).toInt();
2301 sd->IOD = eph->IOD();
2302 sd->Clock.DeltaA0 = dClk;
2303 sd->Clock.DeltaA1 = 0.0; // TODO
2304 sd->Clock.DeltaA2 = 0.0; // TODO
2305 sd->Orbit.DeltaRadial = rsw(1);
2306 sd->Orbit.DeltaAlongTrack = rsw(2);
2307 sd->Orbit.DeltaCrossTrack = rsw(3);
2308 sd->Orbit.DotDeltaRadial = dotRsw(1);
[4930]2309 sd->Orbit.DotDeltaAlongTrack = dotRsw(2);
2310 sd->Orbit.DotDeltaCrossTrack = dotRsw(3);
[3222]2311 }
2312
[7169]2313 outLine.sprintf("%d %.1f %s %u %10.3f %8.3f %8.3f %8.3f\n", GPSweek,
[6877]2314 GPSweeks, eph->prn().toString().c_str(), eph->IOD(), dClk, rsw(1), rsw(2),
2315 rsw(3));
[3222]2316
[4991]2317 double relativity = -2.0 * DotProduct(xP, rtnVel) / t_CST::c;
2318 double sp3Clk = (rtnClk - relativity) / t_CST::c; // in seconds
2319
[3222]2320 if (_rnx) {
[4991]2321 _rnx->write(GPSweek, GPSweeks, prn, sp3Clk);
[3222]2322 }
2323 if (_sp3) {
[4991]2324 _sp3->write(GPSweek, GPSweeks, prn, rtnCoM, sp3Clk);
[3222]2325 }
2326}
2327
2328// Transform Coordinates
2329////////////////////////////////////////////////////////////////////////////
[5662]2330void bncRtnetUploadCaster::crdTrafo(int GPSWeek, ColumnVector& xyz,
[6877]2331 double& dc) {
[3222]2332
2333 // Current epoch minus 2000.0 in years
2334 // ------------------------------------
[6877]2335 double dt = (GPSWeek - (1042.0 + 6.0 / 7.0)) / 365.2422 * 7.0 + 2000.0 - _t0;
[3222]2336
2337 ColumnVector dx(3);
2338
2339 dx(1) = _dx + dt * _dxr;
2340 dx(2) = _dy + dt * _dyr;
2341 dx(3) = _dz + dt * _dzr;
2342
2343 static const double arcSec = 180.0 * 3600.0 / M_PI;
2344
2345 double ox = (_ox + dt * _oxr) / arcSec;
2346 double oy = (_oy + dt * _oyr) / arcSec;
2347 double oz = (_oz + dt * _ozr) / arcSec;
2348
2349 double sc = 1.0 + _sc * 1e-9 + dt * _scr * 1e-9;
2350
[4912]2351 // Specify approximate center of area
2352 // ----------------------------------
2353 ColumnVector meanSta(3);
2354
[6877]2355 if (_crdTrafo == "ETRF2000") {
2356 meanSta(1) = 3661090.0;
2357 meanSta(2) = 845230.0;
2358 meanSta(3) = 5136850.0;
[4908]2359 }
[4912]2360 else if (_crdTrafo == "NAD83") {
[4973]2361 meanSta(1) = -1092950.0;
2362 meanSta(2) = -4383600.0;
[6877]2363 meanSta(3) = 4487420.0;
[4912]2364 }
2365 else if (_crdTrafo == "GDA94") {
[4973]2366 meanSta(1) = -4052050.0;
[6877]2367 meanSta(2) = 4212840.0;
[4973]2368 meanSta(3) = -2545110.0;
[4912]2369 }
2370 else if (_crdTrafo == "SIRGAS2000") {
[6877]2371 meanSta(1) = 3740860.0;
[4973]2372 meanSta(2) = -4964290.0;
2373 meanSta(3) = -1425420.0;
[4912]2374 }
2375 else if (_crdTrafo == "SIRGAS95") {
[6877]2376 meanSta(1) = 3135390.0;
[4973]2377 meanSta(2) = -5017670.0;
2378 meanSta(3) = -2374440.0;
[4912]2379 }
[5343]2380 else if (_crdTrafo == "DREF91") {
[6877]2381 meanSta(1) = 3959579.0;
2382 meanSta(2) = 721719.0;
2383 meanSta(3) = 4931539.0;
[5343]2384 }
[4912]2385 else if (_crdTrafo == "Custom") {
[6877]2386 meanSta(1) = 0.0; // TODO
2387 meanSta(2) = 0.0; // TODO
2388 meanSta(3) = 0.0; // TODO
[4912]2389 }
[4908]2390
[4912]2391 // Clock correction proportional to topocentric distance to satellites
2392 // -------------------------------------------------------------------
2393 double rho = (xyz - meanSta).norm_Frobenius();
[4913]2394 dc = rho * (sc - 1.0) / sc / t_CST::c;
[4908]2395
[6877]2396 Matrix rMat(3, 3);
2397 rMat(1, 1) = 1.0;
2398 rMat(1, 2) = -oz;
2399 rMat(1, 3) = oy;
2400 rMat(2, 1) = oz;
2401 rMat(2, 2) = 1.0;
2402 rMat(2, 3) = -ox;
2403 rMat(3, 1) = -oy;
2404 rMat(3, 2) = ox;
2405 rMat(3, 3) = 1.0;
[3222]2406
2407 xyz = sc * rMat * xyz + dx;
2408}
2409
[6557]2410int bncRtnetUploadCaster::determineUpdateInd(double samplingRate) {
2411
2412 if (samplingRate == 10.0) {
2413 return 3;
2414 }
2415 else if (samplingRate == 15.0) {
2416 return 4;
2417 }
2418 else if (samplingRate == 30.0) {
2419 return 5;
2420 }
2421 else if (samplingRate == 60.0) {
2422 return 6;
2423 }
2424 else if (samplingRate == 120.0) {
2425 return 7;
2426 }
2427 else if (samplingRate == 240.0) {
2428 return 8;
2429 }
2430 else if (samplingRate == 300.0) {
2431 return 9;
2432 }
2433 else if (samplingRate == 600.0) {
2434 return 10;
2435 }
2436 else if (samplingRate == 900.0) {
2437 return 11;
2438 }
2439 else if (samplingRate == 1800.0) {
2440 return 12;
2441 }
2442 else if (samplingRate == 3600.0) {
2443 return 13;
2444 }
2445 else if (samplingRate == 7200.0) {
2446 return 14;
2447 }
2448 else if (samplingRate == 10800.0) {
2449 return 15;
2450 }
[6877]2451 return 2; // default
[6557]2452}
Note: See TracBrowser for help on using the repository browser.