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

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

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