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

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

two phase bias parameters were added
File size: 80.0 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 == "DisInd") {
448 in >> numVal >> pbSat.dispInd;
449 }
450 else if (key == "MwInd") {
451 in >> numVal >> pbSat.mwInd;
452 }
453 else if (key == "PhaseBias") {
454 in >> numVal;
455 for (int ii = 0; ii < numVal; ii++) {
456 phaseBiasSignal pb;
457 in >> pb.type >> pb.bias >> pb.intInd >> pb.wlInd
458 >> pb.discCount;
459 phaseBiasList.append(pb);
460 }
461 }
462 else {
463 for (int ii = 0; ii < numVal; ii++) {
464 double dummy;
465 in >> dummy;
466 }
467 }
468 }
469
470 struct ClockOrbit::SatData* sd = 0;
471 if (prn[0] == 'G') {
472 sd = co.Sat + co.NumberOfSat[CLOCKORBIT_SATGPS];
473 ++co.NumberOfSat[CLOCKORBIT_SATGPS];
474 }
475 else if (prn[0] == 'R') {
476 sd = co.Sat + CLOCKORBIT_NUMGPS
477 + co.NumberOfSat[CLOCKORBIT_SATGLONASS];
478 ++co.NumberOfSat[CLOCKORBIT_SATGLONASS];
479 }
480 else if (prn[0] == 'E') {
481 sd = co.Sat + CLOCKORBIT_NUMGPS + CLOCKORBIT_NUMGLONASS
482 + co.NumberOfSat[CLOCKORBIT_SATGALILEO];
483 ++co.NumberOfSat[CLOCKORBIT_SATGALILEO];
484 }
485 else if (prn[0] == 'J') {
486 sd = co.Sat + CLOCKORBIT_NUMGPS + CLOCKORBIT_NUMGLONASS + CLOCKORBIT_NUMGALILEO
487 + co.NumberOfSat[CLOCKORBIT_SATQZSS];
488 ++co.NumberOfSat[CLOCKORBIT_SATQZSS];
489 }
490 else if (prn[0] == 'S') {
491 sd = co.Sat + CLOCKORBIT_NUMGPS + CLOCKORBIT_NUMGLONASS + CLOCKORBIT_NUMGALILEO
492 + CLOCKORBIT_NUMQZSS
493 + co.NumberOfSat[CLOCKORBIT_SATSBAS];
494 ++co.NumberOfSat[CLOCKORBIT_SATSBAS];
495 }
496 else if (prn[0] == 'C') {
497 sd = co.Sat + CLOCKORBIT_NUMGPS + CLOCKORBIT_NUMGLONASS + CLOCKORBIT_NUMGALILEO
498 + CLOCKORBIT_NUMQZSS + CLOCKORBIT_NUMSBAS
499 + co.NumberOfSat[CLOCKORBIT_SATBDS];
500 ++co.NumberOfSat[CLOCKORBIT_SATBDS];
501 }
502 if (sd) {
503 QString outLine;
504 processSatellite(eph, epoTime.gpsw(), epoTime.gpssec(), prn,
505 rtnAPC, rtnClk, rtnVel, rtnCoM, sd, outLine);
506 }
507
508 // Code Biases
509 // -----------
510 struct CodeBias::BiasSat* biasSat = 0;
511 if (prn[0] == 'G') {
512 biasSat = bias.Sat + bias.NumberOfSat[CLOCKORBIT_SATGPS];
513 ++bias.NumberOfSat[CLOCKORBIT_SATGPS];
514 }
515 else if (prn[0] == 'R') {
516 biasSat = bias.Sat + CLOCKORBIT_NUMGPS
517 + bias.NumberOfSat[CLOCKORBIT_SATGLONASS];
518 ++bias.NumberOfSat[CLOCKORBIT_SATGLONASS];
519 }
520 else if (prn[0] == 'E') {
521 biasSat = bias.Sat + CLOCKORBIT_NUMGPS + CLOCKORBIT_NUMGLONASS
522 + bias.NumberOfSat[CLOCKORBIT_SATGALILEO];
523 ++bias.NumberOfSat[CLOCKORBIT_SATGALILEO];
524 }
525 else if (prn[0] == 'J') {
526 biasSat = bias.Sat + CLOCKORBIT_NUMGPS + CLOCKORBIT_NUMGLONASS + CLOCKORBIT_NUMGALILEO
527 + bias.NumberOfSat[CLOCKORBIT_SATQZSS];
528 ++bias.NumberOfSat[CLOCKORBIT_SATQZSS];
529 }
530 else if (prn[0] == 'S') {
531 biasSat = bias.Sat + CLOCKORBIT_NUMGPS + CLOCKORBIT_NUMGLONASS + CLOCKORBIT_NUMGALILEO
532 + CLOCKORBIT_NUMQZSS
533 + bias.NumberOfSat[CLOCKORBIT_SATSBAS];
534 ++bias.NumberOfSat[CLOCKORBIT_SATSBAS];
535 }
536 else if (prn[0] == 'C') {
537 biasSat = bias.Sat + CLOCKORBIT_NUMGPS + CLOCKORBIT_NUMGLONASS + CLOCKORBIT_NUMGALILEO
538 + CLOCKORBIT_NUMQZSS + CLOCKORBIT_NUMSBAS
539 + bias.NumberOfSat[CLOCKORBIT_SATBDS];
540 ++bias.NumberOfSat[CLOCKORBIT_SATBDS];
541 }
542
543 if (biasSat) {
544 biasSat->ID = prn.mid(1).toInt();
545 biasSat->NumberOfCodeBiases = 0;
546 if (prn[0] == 'G') {
547 QMapIterator<QString, double> it(codeBiases);
548 while (it.hasNext()) {
549 it.next();
550 if (it.key() == "1C") {
551 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
552 biasSat->NumberOfCodeBiases += 1;
553 biasSat->Biases[ii].Type = CODETYPEGPS_L1_CA;
554 biasSat->Biases[ii].Bias = it.value();
555 }
556 else if (it.key() == "1P") {
557 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
558 biasSat->NumberOfCodeBiases += 1;
559 biasSat->Biases[ii].Type = CODETYPEGPS_L1_P;
560 biasSat->Biases[ii].Bias = it.value();
561 }
562 else if (it.key() == "1W") {
563 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
564 biasSat->NumberOfCodeBiases += 1;
565 biasSat->Biases[ii].Type = CODETYPEGPS_L1_Z;
566 biasSat->Biases[ii].Bias = it.value();
567 }
568 else if (it.key() == "2C") {
569 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
570 biasSat->NumberOfCodeBiases += 1;
571 biasSat->Biases[ii].Type = CODETYPEGPS_L2_CA;
572 biasSat->Biases[ii].Bias = it.value();
573 }
574 else if (it.key() == "2D") {
575 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
576 biasSat->NumberOfCodeBiases += 1;
577 biasSat->Biases[ii].Type = CODETYPEGPS_SEMI_CODELESS;
578 biasSat->Biases[ii].Bias = it.value();
579 }
580 else if (it.key() == "2S") {
581 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
582 biasSat->NumberOfCodeBiases += 1;
583 biasSat->Biases[ii].Type = CODETYPEGPS_L2_CM;
584 biasSat->Biases[ii].Bias = it.value();
585 }
586 else if (it.key() == "2L") {
587 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
588 biasSat->NumberOfCodeBiases += 1;
589 biasSat->Biases[ii].Type = CODETYPEGPS_L2_CL;
590 biasSat->Biases[ii].Bias = it.value();
591 }
592 else if (it.key() == "2X") {
593 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
594 biasSat->NumberOfCodeBiases += 1;
595 biasSat->Biases[ii].Type = CODETYPEGPS_L2_CML;
596 biasSat->Biases[ii].Bias = it.value();
597 }
598 else if (it.key() == "2P") {
599 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
600 biasSat->NumberOfCodeBiases += 1;
601 biasSat->Biases[ii].Type = CODETYPEGPS_L2_P;
602 biasSat->Biases[ii].Bias = it.value();
603 }
604 else if (it.key() == "2W") {
605 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
606 biasSat->NumberOfCodeBiases += 1;
607 biasSat->Biases[ii].Type = CODETYPEGPS_L2_Z;
608 biasSat->Biases[ii].Bias = it.value();
609 }
610 else if (it.key() == "5I") {
611 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
612 biasSat->NumberOfCodeBiases += 1;
613 biasSat->Biases[ii].Type = CODETYPEGPS_L5_I;
614 biasSat->Biases[ii].Bias = it.value();
615 }
616 else if (it.key() == "5Q") {
617 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
618 biasSat->NumberOfCodeBiases += 1;
619 biasSat->Biases[ii].Type = CODETYPEGPS_L5_Q;
620 biasSat->Biases[ii].Bias = it.value();
621 }
622 else if (it.key() == "5X") {
623 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
624 biasSat->NumberOfCodeBiases += 1;
625 biasSat->Biases[ii].Type = CODETYPEGPS_L5_IQ;
626 biasSat->Biases[ii].Bias = it.value();
627 }
628 }
629 }
630 else if (prn[0] == 'R') {
631 QMapIterator<QString, double> it(codeBiases);
632 while (it.hasNext()) {
633 it.next();
634 if (it.key() == "1C") {
635 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
636 biasSat->NumberOfCodeBiases += 1;
637 biasSat->Biases[ii].Type = CODETYPEGLONASS_L1_CA;
638 biasSat->Biases[ii].Bias = it.value();
639 }
640 else if (it.key() == "1P") {
641 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
642 biasSat->NumberOfCodeBiases += 1;
643 biasSat->Biases[ii].Type = CODETYPEGLONASS_L1_P;
644 biasSat->Biases[ii].Bias = it.value();
645 }
646 else if (it.key() == "2C") {
647 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
648 biasSat->NumberOfCodeBiases += 1;
649 biasSat->Biases[ii].Type = CODETYPEGLONASS_L2_CA;
650 biasSat->Biases[ii].Bias = it.value();
651 }
652 else if (it.key() == "2P") {
653 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
654 biasSat->NumberOfCodeBiases += 1;
655 biasSat->Biases[ii].Type = CODETYPEGLONASS_L2_P;
656 biasSat->Biases[ii].Bias = it.value();
657 }
658 }
659 }
660 else if (prn[0] == 'E') {
661 QMapIterator<QString, double> it(codeBiases);
662 while (it.hasNext()) {
663 it.next();
664 if (it.key() == "1A") {
665 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
666 biasSat->NumberOfCodeBiases += 1;
667 biasSat->Biases[ii].Type = CODETYPEGALILEO_E1_A;
668 biasSat->Biases[ii].Bias = it.value();
669 }
670 else if (it.key() == "1B") {
671 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
672 biasSat->NumberOfCodeBiases += 1;
673 biasSat->Biases[ii].Type = CODETYPEGALILEO_E1_B;
674 biasSat->Biases[ii].Bias = it.value();
675 }
676 else if (it.key() == "1C") {
677 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
678 biasSat->NumberOfCodeBiases += 1;
679 biasSat->Biases[ii].Type = CODETYPEGALILEO_E1_C;
680 biasSat->Biases[ii].Bias = it.value();
681 }
682 else if (it.key() == "5I") {
683 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
684 biasSat->NumberOfCodeBiases += 1;
685 biasSat->Biases[ii].Type = CODETYPEGALILEO_E5A_I;
686 biasSat->Biases[ii].Bias = it.value();
687 }
688 else if (it.key() == "5Q") {
689 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
690 biasSat->NumberOfCodeBiases += 1;
691 biasSat->Biases[ii].Type = CODETYPEGALILEO_E5A_Q;
692 biasSat->Biases[ii].Bias = it.value();
693 }
694 else if (it.key() == "7I") {
695 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
696 biasSat->NumberOfCodeBiases += 1;
697 biasSat->Biases[ii].Type = CODETYPEGALILEO_E5B_I;
698 biasSat->Biases[ii].Bias = it.value();
699 }
700 else if (it.key() == "7Q") {
701 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
702 biasSat->NumberOfCodeBiases += 1;
703 biasSat->Biases[ii].Type = CODETYPEGALILEO_E5B_Q;
704 biasSat->Biases[ii].Bias = it.value();
705 }
706 else if (it.key() == "8I") {
707 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
708 biasSat->NumberOfCodeBiases += 1;
709 biasSat->Biases[ii].Type = CODETYPEGALILEO_E5_I;
710 biasSat->Biases[ii].Bias = it.value();
711 }
712 else if (it.key() == "8Q") {
713 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
714 biasSat->NumberOfCodeBiases += 1;
715 biasSat->Biases[ii].Type = CODETYPEGALILEO_E5_Q;
716 biasSat->Biases[ii].Bias = it.value();
717 }
718 else if (it.key() == "6A") {
719 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
720 biasSat->NumberOfCodeBiases += 1;
721 biasSat->Biases[ii].Type = CODETYPEGALILEO_E6_A;
722 biasSat->Biases[ii].Bias = it.value();
723 }
724 else if (it.key() == "6B") {
725 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
726 biasSat->NumberOfCodeBiases += 1;
727 biasSat->Biases[ii].Type = CODETYPEGALILEO_E6_B;
728 biasSat->Biases[ii].Bias = it.value();
729 }
730 else if (it.key() == "6C") {
731 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
732 biasSat->NumberOfCodeBiases += 1;
733 biasSat->Biases[ii].Type = CODETYPEGALILEO_E6_C;
734 biasSat->Biases[ii].Bias = it.value();
735 }
736 }
737 }
738 else if (prn[0] == 'J') {
739 QMapIterator<QString, double> it(codeBiases);
740 while (it.hasNext()) {
741 it.next();
742 if (it.key() == "1C") {
743 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
744 biasSat->NumberOfCodeBiases += 1;
745 biasSat->Biases[ii].Type = CODETYPEQZSS_L1_CA;
746 biasSat->Biases[ii].Bias = it.value();
747 }
748 else if (it.key() == "1S") {
749 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
750 biasSat->NumberOfCodeBiases += 1;
751 biasSat->Biases[ii].Type = CODETYPEQZSS_L1C_D;
752 biasSat->Biases[ii].Bias = it.value();
753 }
754 else if (it.key() == "1L") {
755 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
756 biasSat->NumberOfCodeBiases += 1;
757 biasSat->Biases[ii].Type = CODETYPEQZSS_L1C_P;
758 biasSat->Biases[ii].Bias = it.value();
759 }
760 else if (it.key() == "1X") {
761 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
762 biasSat->NumberOfCodeBiases += 1;
763 biasSat->Biases[ii].Type = CODETYPEQZSS_L1C_DP;
764 biasSat->Biases[ii].Bias = it.value();
765 }
766 else if (it.key() == "2S") {
767 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
768 biasSat->NumberOfCodeBiases += 1;
769 biasSat->Biases[ii].Type = CODETYPEQZSS_L2_CM;
770 biasSat->Biases[ii].Bias = it.value();
771 }
772 else if (it.key() == "2L") {
773 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
774 biasSat->NumberOfCodeBiases += 1;
775 biasSat->Biases[ii].Type = CODETYPEQZSS_L2_CL;
776 biasSat->Biases[ii].Bias = it.value();
777 }
778 else if (it.key() == "2X") {
779 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
780 biasSat->NumberOfCodeBiases += 1;
781 biasSat->Biases[ii].Type = CODETYPEQZSS_L2_CML;
782 biasSat->Biases[ii].Bias = it.value();
783 }
784 else if (it.key() == "5I") {
785 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
786 biasSat->NumberOfCodeBiases += 1;
787 biasSat->Biases[ii].Type = CODETYPEQZSS_L5_I;
788 biasSat->Biases[ii].Bias = it.value();
789 }
790 else if (it.key() == "5Q") {
791 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
792 biasSat->NumberOfCodeBiases += 1;
793 biasSat->Biases[ii].Type = CODETYPEQZSS_L5_Q;
794 biasSat->Biases[ii].Bias = it.value();
795 }
796 else if (it.key() == "5X") {
797 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
798 biasSat->NumberOfCodeBiases += 1;
799 biasSat->Biases[ii].Type = CODETYPEQZSS_L5_IQ;
800 biasSat->Biases[ii].Bias = it.value();
801 }
802 else if (it.key() == "6S") {
803 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
804 biasSat->NumberOfCodeBiases += 1;
805 biasSat->Biases[ii].Type = CODETYPEQZSS_LEX_S;
806 biasSat->Biases[ii].Bias = it.value();
807 }
808 else if (it.key() == "6L") {
809 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
810 biasSat->NumberOfCodeBiases += 1;
811 biasSat->Biases[ii].Type = CODETYPEQZSS_LEX_L;
812 biasSat->Biases[ii].Bias = it.value();
813 }
814 else if (it.key() == "6X") {
815 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
816 biasSat->NumberOfCodeBiases += 1;
817 biasSat->Biases[ii].Type = CODETYPEQZSS_LEX_SL;
818 biasSat->Biases[ii].Bias = it.value();
819 }
820 }
821 }
822 else if (prn[0] == 'S') {
823 QMapIterator<QString, double> it(codeBiases);
824 while (it.hasNext()) {
825 it.next();
826 if (it.key() == "1C") {
827 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
828 biasSat->NumberOfCodeBiases += 1;
829 biasSat->Biases[ii].Type = CODETYPE_SBAS_L1_CA;
830 biasSat->Biases[ii].Bias = it.value();
831 }
832 else if (it.key() == "5I") {
833 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
834 biasSat->NumberOfCodeBiases += 1;
835 biasSat->Biases[ii].Type = CODETYPE_SBAS_L5_I;
836 biasSat->Biases[ii].Bias = it.value();
837 }
838 else if (it.key() == "5Q") {
839 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
840 biasSat->NumberOfCodeBiases += 1;
841 biasSat->Biases[ii].Type = CODETYPE_SBAS_L5_Q;
842 biasSat->Biases[ii].Bias = it.value();
843 }
844 else if (it.key() == "5X") {
845 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
846 biasSat->NumberOfCodeBiases += 1;
847 biasSat->Biases[ii].Type = CODETYPE_SBAS_L5_IQ;
848 biasSat->Biases[ii].Bias = it.value();
849 }
850 }
851 }
852 else if (prn[0] == 'C') {
853 QMapIterator<QString, double> it(codeBiases);
854 while (it.hasNext()) {
855 it.next();
856 if (it.key() == "2I") {
857 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
858 biasSat->NumberOfCodeBiases += 1;
859 biasSat->Biases[ii].Type = CODETYPE_BDS_B1_I;
860 biasSat->Biases[ii].Bias = it.value();
861 }
862 else if (it.key() == "2Q") {
863 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
864 biasSat->NumberOfCodeBiases += 1;
865 biasSat->Biases[ii].Type = CODETYPE_BDS_B1_Q;
866 biasSat->Biases[ii].Bias = it.value();
867 }
868 else if (it.key() == "2X") {
869 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
870 biasSat->NumberOfCodeBiases += 1;
871 biasSat->Biases[ii].Type = CODETYPE_BDS_B1_IQ;
872 biasSat->Biases[ii].Bias = it.value();
873 }
874 else if (it.key() == "6I") {
875 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
876 biasSat->NumberOfCodeBiases += 1;
877 biasSat->Biases[ii].Type = CODETYPE_BDS_B3_I;
878 biasSat->Biases[ii].Bias = it.value();
879 }
880 else if (it.key() == "6Q") {
881 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
882 biasSat->NumberOfCodeBiases += 1;
883 biasSat->Biases[ii].Type = CODETYPE_BDS_B3_Q;
884 biasSat->Biases[ii].Bias = it.value();
885 }
886 else if (it.key() == "6X") {
887 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
888 biasSat->NumberOfCodeBiases += 1;
889 biasSat->Biases[ii].Type = CODETYPE_BDS_B3_IQ;
890 biasSat->Biases[ii].Bias = it.value();
891 }
892 else if (it.key() == "7I") {
893 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
894 biasSat->NumberOfCodeBiases += 1;
895 biasSat->Biases[ii].Type = CODETYPE_BDS_B2_I;
896 biasSat->Biases[ii].Bias = it.value();
897 }
898 else if (it.key() == "7Q") {
899 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
900 biasSat->NumberOfCodeBiases += 1;
901 biasSat->Biases[ii].Type = CODETYPE_BDS_B2_Q;
902 biasSat->Biases[ii].Bias = it.value();
903 }
904 else if (it.key() == "7X") {
905 int ii = biasSat->NumberOfCodeBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
906 biasSat->NumberOfCodeBiases += 1;
907 biasSat->Biases[ii].Type = CODETYPE_BDS_B2_IQ;
908 biasSat->Biases[ii].Bias = it.value();
909 }
910 }
911 }
912 }
913 // Phase Biases
914 // ------------
915 struct PhaseBias::PhaseBiasSat* phasebiasSat = 0;
916 if (prn[0] == 'G') {
917 phasebiasSat = phasebias.Sat + phasebias.NumberOfSat[CLOCKORBIT_SATGPS];
918 ++phasebias.NumberOfSat[CLOCKORBIT_SATGPS];
919 }
920 else if (prn[0] == 'R') {
921 phasebiasSat = phasebias.Sat + CLOCKORBIT_NUMGPS
922 + phasebias.NumberOfSat[CLOCKORBIT_SATGLONASS];
923 ++phasebias.NumberOfSat[CLOCKORBIT_SATGLONASS];
924 }
925 else if (prn[0] == 'E') {
926 phasebiasSat = phasebias.Sat + CLOCKORBIT_NUMGPS + CLOCKORBIT_NUMGLONASS
927 + phasebias.NumberOfSat[CLOCKORBIT_SATGALILEO];
928 ++phasebias.NumberOfSat[CLOCKORBIT_SATGALILEO];
929 }
930 else if (prn[0] == 'J') {
931 phasebiasSat = phasebias.Sat + CLOCKORBIT_NUMGPS + CLOCKORBIT_NUMGLONASS + CLOCKORBIT_NUMGALILEO
932 + phasebias.NumberOfSat[CLOCKORBIT_SATQZSS];
933 ++phasebias.NumberOfSat[CLOCKORBIT_SATQZSS];
934 }
935 else if (prn[0] == 'S') {
936 phasebiasSat = phasebias.Sat + CLOCKORBIT_NUMGPS + CLOCKORBIT_NUMGLONASS + CLOCKORBIT_NUMGALILEO
937 + CLOCKORBIT_NUMQZSS
938 + phasebias.NumberOfSat[CLOCKORBIT_SATSBAS];
939 ++phasebias.NumberOfSat[CLOCKORBIT_SATSBAS];
940 }
941 else if (prn[0] == 'C') {
942 phasebiasSat = phasebias.Sat + CLOCKORBIT_NUMGPS + CLOCKORBIT_NUMGLONASS + CLOCKORBIT_NUMGALILEO
943 + CLOCKORBIT_NUMQZSS + CLOCKORBIT_NUMSBAS
944 + phasebias.NumberOfSat[CLOCKORBIT_SATBDS];
945 ++phasebias.NumberOfSat[CLOCKORBIT_SATBDS];
946 }
947
948 if (phasebiasSat) {
949 phasebias.DispersiveBiasConsistencyIndicator = pbSat.dispInd;
950 phasebias.MWConsistencyIndicator = pbSat.mwInd;
951 phasebiasSat->ID = prn.mid(1).toInt();
952 phasebiasSat->NumberOfPhaseBiases = 0;
953 phasebiasSat->YawAngle = pbSat.yA;
954 phasebiasSat->YawRate = pbSat.yR;
955 if (prn[0] == 'G') {
956 QListIterator<phaseBiasSignal> it(phaseBiasList);
957 while (it.hasNext()) {
958 const phaseBiasSignal &pbSig = it.next();
959 if (pbSig.type == "1C") {
960 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
961 phasebiasSat->NumberOfPhaseBiases += 1;
962 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L1_CA;
963 phasebiasSat->Biases[ii].Bias = pbSig.bias;
964 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
965 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
966 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
967 }
968 else if (pbSig.type == "1P") {
969 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
970 phasebiasSat->NumberOfPhaseBiases += 1;
971 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L1_P;
972 phasebiasSat->Biases[ii].Bias = pbSig.bias;
973 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
974 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
975 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
976 }
977 else if (pbSig.type == "1W") {
978 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
979 phasebiasSat->NumberOfPhaseBiases += 1;
980 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L1_Z;
981 phasebiasSat->Biases[ii].Bias = pbSig.bias;
982 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
983 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
984 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
985 }
986 else if (pbSig.type == "2C") {
987 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
988 phasebiasSat->NumberOfPhaseBiases += 1;
989 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L2_CA;
990 phasebiasSat->Biases[ii].Bias = pbSig.bias;
991 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
992 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
993 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
994 }
995 else if (pbSig.type == "2D") {
996 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
997 phasebiasSat->NumberOfPhaseBiases += 1;
998 phasebiasSat->Biases[ii].Type = CODETYPEGPS_SEMI_CODELESS;
999 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1000 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1001 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1002 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1003 }
1004 else if (pbSig.type == "2S") {
1005 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1006 phasebiasSat->NumberOfPhaseBiases += 1;
1007 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L2_CM;
1008 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1009 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1010 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1011 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1012 }
1013 else if (pbSig.type == "2L") {
1014 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1015 phasebiasSat->NumberOfPhaseBiases += 1;
1016 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L2_CL;
1017 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1018 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1019 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1020 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1021 }
1022 else if (pbSig.type == "2X") {
1023 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1024 phasebiasSat->NumberOfPhaseBiases += 1;
1025 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L2_CML;
1026 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1027 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1028 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1029 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1030 }
1031 else if (pbSig.type == "2P") {
1032 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1033 phasebiasSat->NumberOfPhaseBiases += 1;
1034 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L2_P;
1035 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1036 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1037 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1038 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1039 }
1040 else if (pbSig.type == "2W") {
1041 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1042 phasebiasSat->NumberOfPhaseBiases += 1;
1043 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L2_Z;
1044 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1045 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1046 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1047 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1048 }
1049 else if (pbSig.type == "5I") {
1050 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1051 phasebiasSat->NumberOfPhaseBiases += 1;
1052 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L5_I;
1053 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1054 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1055 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1056 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1057 }
1058 else if (pbSig.type == "5Q") {
1059 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1060 phasebiasSat->NumberOfPhaseBiases += 1;
1061 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L5_Q;
1062 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1063 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1064 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1065 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1066 }
1067 else if (pbSig.type == "5X") {
1068 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1069 phasebiasSat->NumberOfPhaseBiases += 1;
1070 phasebiasSat->Biases[ii].Type = CODETYPEGPS_L5_IQ;
1071 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1072 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1073 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1074 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1075 }
1076 }
1077 }
1078 if (prn[0] == 'R') {
1079 QListIterator<phaseBiasSignal> it(phaseBiasList);
1080 while (it.hasNext()) {
1081 const phaseBiasSignal &pbSig = it.next();
1082 if (pbSig.type == "1C") {
1083 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1084 phasebiasSat->NumberOfPhaseBiases += 1;
1085 phasebiasSat->Biases[ii].Type = CODETYPEGLONASS_L1_CA;
1086 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1087 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1088 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1089 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1090 }
1091 else if (pbSig.type == "1P") {
1092 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1093 phasebiasSat->NumberOfPhaseBiases += 1;
1094 phasebiasSat->Biases[ii].Type = CODETYPEGLONASS_L1_P;
1095 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1096 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1097 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1098 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1099 }
1100 else if (pbSig.type == "2C") {
1101 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1102 phasebiasSat->NumberOfPhaseBiases += 1;
1103 phasebiasSat->Biases[ii].Type = CODETYPEGLONASS_L2_CA;
1104 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1105 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1106 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1107 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1108 }
1109 else if (pbSig.type == "2P") {
1110 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1111 phasebiasSat->NumberOfPhaseBiases += 1;
1112 phasebiasSat->Biases[ii].Type = CODETYPEGLONASS_L2_P;
1113 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1114 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1115 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1116 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1117 }
1118 }
1119 }
1120 if (prn[0] == 'E') {
1121 QListIterator<phaseBiasSignal> it(phaseBiasList);
1122 while (it.hasNext()) {
1123 const phaseBiasSignal &pbSig = it.next();
1124 if (pbSig.type == "1A") {
1125 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1126 phasebiasSat->NumberOfPhaseBiases += 1;
1127 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E1_A;
1128 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1129 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1130 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1131 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1132 }
1133 else if (pbSig.type == "1B") {
1134 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1135 phasebiasSat->NumberOfPhaseBiases += 1;
1136 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E1_B;
1137 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1138 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1139 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1140 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1141 }
1142 else if (pbSig.type == "1C") {
1143 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1144 phasebiasSat->NumberOfPhaseBiases += 1;
1145 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E1_C;
1146 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1147 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1148 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1149 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1150 }
1151 else if (pbSig.type == "5I") {
1152 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1153 phasebiasSat->NumberOfPhaseBiases += 1;
1154 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E5A_I;
1155 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1156 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1157 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1158 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1159 }
1160 else if (pbSig.type == "5Q") {
1161 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1162 phasebiasSat->NumberOfPhaseBiases += 1;
1163 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E5A_Q;
1164 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1165 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1166 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1167 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1168 }
1169 else if (pbSig.type == "7I") {
1170 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1171 phasebiasSat->NumberOfPhaseBiases += 1;
1172 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E5B_I;
1173 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1174 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1175 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1176 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1177 }
1178 else if (pbSig.type == "7Q") {
1179 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1180 phasebiasSat->NumberOfPhaseBiases += 1;
1181 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E5B_Q;
1182 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1183 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1184 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1185 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1186 }
1187 else if (pbSig.type == "8I") {
1188 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1189 phasebiasSat->NumberOfPhaseBiases += 1;
1190 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E5_I;
1191 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1192 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1193 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1194 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1195 }
1196 else if (pbSig.type == "8Q") {
1197 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1198 phasebiasSat->NumberOfPhaseBiases += 1;
1199 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E5_Q;
1200 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1201 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1202 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1203 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1204 }
1205 else if (pbSig.type == "6A") {
1206 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1207 phasebiasSat->NumberOfPhaseBiases += 1;
1208 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E6_A;
1209 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1210 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1211 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1212 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1213 }
1214 else if (pbSig.type == "6B") {
1215 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1216 phasebiasSat->NumberOfPhaseBiases += 1;
1217 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E6_B;
1218 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1219 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1220 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1221 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1222 }
1223 else if (pbSig.type == "6C") {
1224 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1225 phasebiasSat->NumberOfPhaseBiases += 1;
1226 phasebiasSat->Biases[ii].Type = CODETYPEGALILEO_E6_C;
1227 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1228 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1229 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1230 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1231 }
1232 }
1233 }
1234 if (prn[0] == 'J') {
1235 QListIterator<phaseBiasSignal> it(phaseBiasList);
1236 while (it.hasNext()) {
1237 const phaseBiasSignal &pbSig = it.next();
1238 if (pbSig.type == "1C") {
1239 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1240 phasebiasSat->NumberOfPhaseBiases += 1;
1241 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L1_CA;
1242 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1243 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1244 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1245 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1246 }
1247 else if (pbSig.type == "1S") {
1248 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1249 phasebiasSat->NumberOfPhaseBiases += 1;
1250 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L1C_D;
1251 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1252 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1253 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1254 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1255 }
1256 else if (pbSig.type == "1L") {
1257 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1258 phasebiasSat->NumberOfPhaseBiases += 1;
1259 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L1C_P;
1260 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1261 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1262 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1263 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1264 }
1265 else if (pbSig.type == "1X") {
1266 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1267 phasebiasSat->NumberOfPhaseBiases += 1;
1268 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L1C_DP;
1269 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1270 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1271 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1272 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1273 }
1274 else if (pbSig.type == "2S") {
1275 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1276 phasebiasSat->NumberOfPhaseBiases += 1;
1277 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L2_CM;
1278 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1279 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1280 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1281 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1282 }
1283 else if (pbSig.type == "2L") {
1284 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1285 phasebiasSat->NumberOfPhaseBiases += 1;
1286 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L2_CL;
1287 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1288 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1289 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1290 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1291 }
1292 else if (pbSig.type == "2X") {
1293 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1294 phasebiasSat->NumberOfPhaseBiases += 1;
1295 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L2_CML;
1296 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1297 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1298 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1299 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1300 }
1301 else if (pbSig.type == "5I") {
1302 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1303 phasebiasSat->NumberOfPhaseBiases += 1;
1304 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L5_I;
1305 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1306 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1307 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1308 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1309 }
1310 else if (pbSig.type == "5Q") {
1311 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1312 phasebiasSat->NumberOfPhaseBiases += 1;
1313 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L5_Q;
1314 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1315 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1316 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1317 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1318 }
1319 else if (pbSig.type == "5X") {
1320 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1321 phasebiasSat->NumberOfPhaseBiases += 1;
1322 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_L5_IQ;
1323 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1324 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1325 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1326 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1327 }
1328 else if (pbSig.type == "6S") {
1329 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1330 phasebiasSat->NumberOfPhaseBiases += 1;
1331 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_LEX_S;
1332 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1333 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1334 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1335 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1336 }
1337 else if (pbSig.type == "6L") {
1338 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1339 phasebiasSat->NumberOfPhaseBiases += 1;
1340 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_LEX_L;
1341 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1342 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1343 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1344 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1345 }
1346 else if (pbSig.type == "6X") {
1347 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1348 phasebiasSat->NumberOfPhaseBiases += 1;
1349 phasebiasSat->Biases[ii].Type = CODETYPEQZSS_LEX_SL;
1350 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1351 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1352 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1353 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1354 }
1355 }
1356 }
1357 if (prn[0] == 'S') {
1358 QListIterator<phaseBiasSignal> it(phaseBiasList);
1359 while (it.hasNext()) {
1360 const phaseBiasSignal &pbSig = it.next();
1361 if (pbSig.type == "1C") {
1362 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1363 phasebiasSat->NumberOfPhaseBiases += 1;
1364 phasebiasSat->Biases[ii].Type = CODETYPE_SBAS_L1_CA;
1365 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1366 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1367 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1368 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1369 }
1370 else if (pbSig.type == "5I") {
1371 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1372 phasebiasSat->NumberOfPhaseBiases += 1;
1373 phasebiasSat->Biases[ii].Type = CODETYPE_SBAS_L5_I;
1374 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1375 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1376 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1377 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1378 }
1379 else if (pbSig.type == "5Q") {
1380 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1381 phasebiasSat->NumberOfPhaseBiases += 1;
1382 phasebiasSat->Biases[ii].Type = CODETYPE_SBAS_L5_Q;
1383 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1384 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1385 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1386 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1387 }
1388 else if (pbSig.type == "5X") {
1389 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1390 phasebiasSat->NumberOfPhaseBiases += 1;
1391 phasebiasSat->Biases[ii].Type = CODETYPE_SBAS_L5_IQ;
1392 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1393 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1394 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1395 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1396 }
1397 }
1398 }
1399 if (prn[0] == 'C') {
1400 QListIterator<phaseBiasSignal> it(phaseBiasList);
1401 while (it.hasNext()) {
1402 const phaseBiasSignal &pbSig = it.next();
1403 if (pbSig.type == "2I") {
1404 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1405 phasebiasSat->NumberOfPhaseBiases += 1;
1406 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B1_I;
1407 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1408 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1409 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1410 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1411 }
1412 else if (pbSig.type == "2Q") {
1413 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1414 phasebiasSat->NumberOfPhaseBiases += 1;
1415 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B1_Q;
1416 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1417 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1418 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1419 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1420 }
1421 else if (pbSig.type == "2X") {
1422 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1423 phasebiasSat->NumberOfPhaseBiases += 1;
1424 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B1_IQ;
1425 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1426 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1427 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1428 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1429 }
1430 else if (pbSig.type == "6I") {
1431 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1432 phasebiasSat->NumberOfPhaseBiases += 1;
1433 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B2_Q;
1434 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1435 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1436 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1437 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1438 }
1439 else if (pbSig.type == "6Q") {
1440 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1441 phasebiasSat->NumberOfPhaseBiases += 1;
1442 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B2_I;
1443 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1444 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1445 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1446 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1447 }
1448 else if (pbSig.type == "6X") {
1449 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1450 phasebiasSat->NumberOfPhaseBiases += 1;
1451 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B2_IQ;
1452 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1453 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1454 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1455 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1456 }
1457 else if (pbSig.type == "7I") {
1458 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1459 phasebiasSat->NumberOfPhaseBiases += 1;
1460 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B3_Q;
1461 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1462 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1463 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1464 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1465 }
1466 else if (pbSig.type == "7Q") {
1467 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1468 phasebiasSat->NumberOfPhaseBiases += 1;
1469 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B3_I;
1470 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1471 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1472 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1473 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1474 }
1475 else if (pbSig.type == "7X") {
1476 int ii = phasebiasSat->NumberOfPhaseBiases; if (ii >= CLOCKORBIT_NUMBIAS) break;
1477 phasebiasSat->NumberOfPhaseBiases += 1;
1478 phasebiasSat->Biases[ii].Type = CODETYPE_BDS_B3_IQ;
1479 phasebiasSat->Biases[ii].Bias = pbSig.bias;
1480 phasebiasSat->Biases[ii].SignalIntegerIndicator = pbSig.intInd;
1481 phasebiasSat->Biases[ii].SignalsWideLaneIntegerIndicator = pbSig.wlInd;
1482 phasebiasSat->Biases[ii].SignalDiscontinuityCounter = pbSig.discCount;
1483 }
1484 }
1485 }
1486 }
1487 }
1488 }
1489
1490
1491 QByteArray hlpBufferCo;
1492
1493 // Orbit and Clock Corrections together
1494 // ------------------------------------
1495 if (_samplRtcmEphCorr == 0.0) {
1496 if (co.NumberOfSat[CLOCKORBIT_SATGPS] > 0 ||
1497 co.NumberOfSat[CLOCKORBIT_SATGLONASS] > 0 ||
1498 co.NumberOfSat[CLOCKORBIT_SATGALILEO] > 0 ||
1499 co.NumberOfSat[CLOCKORBIT_SATQZSS] > 0 ||
1500 co.NumberOfSat[CLOCKORBIT_SATSBAS] > 0 ||
1501 co.NumberOfSat[CLOCKORBIT_SATBDS] > 0) {
1502 char obuffer[CLOCKORBIT_BUFFERSIZE];
1503 int len = MakeClockOrbit(&co, COTYPE_AUTO, 0, obuffer, sizeof(obuffer));
1504 if (len > 0) {
1505 hlpBufferCo = QByteArray(obuffer, len);
1506 }
1507 }
1508 }
1509
1510 // Orbit and Clock Corrections separately
1511 // --------------------------------------
1512 else {
1513 if (co.NumberOfSat[CLOCKORBIT_SATGPS] > 0) {
1514 char obuffer[CLOCKORBIT_BUFFERSIZE];
1515 if (fmod(epoTime.gpssec(), _samplRtcmEphCorr) == 0.0) {
1516 co.UpdateInterval = ephUpdInd;
1517 int len1 = MakeClockOrbit(&co, COTYPE_GPSORBIT, 1, obuffer, sizeof(obuffer));
1518 co.UpdateInterval = clkUpdInd;
1519 if (len1 > 0) {
1520 hlpBufferCo += QByteArray(obuffer, len1);
1521 }
1522 }
1523 int mmsg = (co.NumberOfSat[CLOCKORBIT_SATGLONASS] > 0) ? 1 : 0;
1524 int len2 = MakeClockOrbit(&co, COTYPE_GPSCLOCK, mmsg, obuffer, sizeof(obuffer));
1525 if (len2 > 0) {
1526 hlpBufferCo += QByteArray(obuffer, len2);
1527 }
1528 }
1529 if (co.NumberOfSat[CLOCKORBIT_SATGLONASS] > 0) {
1530 char obuffer[CLOCKORBIT_BUFFERSIZE];
1531 if (fmod(epoTime.gpssec(), _samplRtcmEphCorr) == 0.0) {
1532 co.UpdateInterval = ephUpdInd;
1533 int len1 = MakeClockOrbit(&co, COTYPE_GLONASSORBIT, 1, obuffer, sizeof(obuffer));
1534 co.UpdateInterval = clkUpdInd;
1535 if (len1 > 0) {
1536 hlpBufferCo += QByteArray(obuffer, len1);
1537 }
1538 }
1539 int mmsg = (co.NumberOfSat[CLOCKORBIT_SATGALILEO] > 0) ? 1 : 0;
1540 int len2 = MakeClockOrbit(&co, COTYPE_GLONASSCLOCK, mmsg, obuffer, sizeof(obuffer));
1541 if (len2 > 0) {
1542 hlpBufferCo += QByteArray(obuffer, len2);
1543 }
1544 }
1545 if (co.NumberOfSat[CLOCKORBIT_SATGALILEO] > 0) {
1546 char obuffer[CLOCKORBIT_BUFFERSIZE];
1547 if (fmod(epoTime.gpssec(), _samplRtcmEphCorr) == 0.0) {
1548 co.UpdateInterval = ephUpdInd;
1549 int len1 = MakeClockOrbit(&co, COTYPE_GALILEOORBIT, 1, obuffer, sizeof(obuffer));
1550 co.UpdateInterval = clkUpdInd;
1551 if (len1 > 0) {
1552 hlpBufferCo += QByteArray(obuffer, len1);
1553 }
1554 }
1555 int mmsg = (co.NumberOfSat[CLOCKORBIT_SATQZSS] > 0) ? 1 : 0;
1556 int len2 = MakeClockOrbit(&co, COTYPE_GALILEOCLOCK, mmsg, obuffer, sizeof(obuffer));
1557 if (len2 > 0) {
1558 hlpBufferCo += QByteArray(obuffer, len2);
1559 }
1560 }
1561 if (co.NumberOfSat[CLOCKORBIT_SATQZSS] > 0) {
1562 char obuffer[CLOCKORBIT_BUFFERSIZE];
1563 if (fmod(epoTime.gpssec(), _samplRtcmEphCorr) == 0.0) {
1564 co.UpdateInterval = ephUpdInd;
1565 int len1 = MakeClockOrbit(&co, COTYPE_QZSSORBIT, 1, obuffer, sizeof(obuffer));
1566 co.UpdateInterval = clkUpdInd;
1567 if (len1 > 0) {
1568 hlpBufferCo += QByteArray(obuffer, len1);
1569 }
1570 }
1571 int mmsg = (co.NumberOfSat[CLOCKORBIT_SATSBAS] > 0) ? 1 : 0;
1572 int len2 = MakeClockOrbit(&co, COTYPE_QZSSCLOCK, mmsg, obuffer, sizeof(obuffer));
1573 if (len2 > 0) {
1574 hlpBufferCo += QByteArray(obuffer, len2);
1575 }
1576 }
1577 if (co.NumberOfSat[CLOCKORBIT_SATSBAS] > 0) {
1578 char obuffer[CLOCKORBIT_BUFFERSIZE];
1579 if (fmod(epoTime.gpssec(), _samplRtcmEphCorr) == 0.0) {
1580 co.UpdateInterval = ephUpdInd;
1581 int len1 = MakeClockOrbit(&co, COTYPE_SBASORBIT, 1, obuffer, sizeof(obuffer));
1582 co.UpdateInterval = clkUpdInd;
1583 if (len1 > 0) {
1584 hlpBufferCo += QByteArray(obuffer, len1);
1585 }
1586 }
1587 int mmsg = (co.NumberOfSat[CLOCKORBIT_SATBDS] > 0) ? 1 : 0;
1588 int len2 = MakeClockOrbit(&co, COTYPE_SBASCLOCK, mmsg, obuffer, sizeof(obuffer));
1589 if (len2 > 0) {
1590 hlpBufferCo += QByteArray(obuffer, len2);
1591 }
1592 }
1593 if (co.NumberOfSat[CLOCKORBIT_SATBDS] > 0) {
1594 char obuffer[CLOCKORBIT_BUFFERSIZE];
1595 if (fmod(epoTime.gpssec(), _samplRtcmEphCorr) == 0.0) {
1596 co.UpdateInterval = ephUpdInd;
1597 int len1 = MakeClockOrbit(&co, COTYPE_BDSORBIT, 1, obuffer, sizeof(obuffer));
1598 co.UpdateInterval = clkUpdInd;
1599 if (len1 > 0) {
1600 hlpBufferCo += QByteArray(obuffer, len1);
1601 }
1602 }
1603 int len2 = MakeClockOrbit(&co, COTYPE_BDSCLOCK, 0, obuffer, sizeof(obuffer));
1604 if (len2 > 0) {
1605 hlpBufferCo += QByteArray(obuffer, len2);
1606 }
1607 }
1608 }
1609
1610 // Code Biases
1611 // -----------
1612 QByteArray hlpBufferBias;
1613 if (bias.NumberOfSat[CLOCKORBIT_SATGPS] > 0 ||
1614 bias.NumberOfSat[CLOCKORBIT_SATGLONASS] > 0 ||
1615 bias.NumberOfSat[CLOCKORBIT_SATGALILEO] > 0 ||
1616 bias.NumberOfSat[CLOCKORBIT_SATQZSS] > 0 ||
1617 bias.NumberOfSat[CLOCKORBIT_SATSBAS] > 0 ||
1618 bias.NumberOfSat[CLOCKORBIT_SATBDS] > 0 ) {
1619 char obuffer[CLOCKORBIT_BUFFERSIZE];
1620 int len = MakeCodeBias(&bias, BTYPE_AUTO, 0, obuffer, sizeof(obuffer));
1621 if (len > 0) {
1622 hlpBufferBias = QByteArray(obuffer, len);
1623 }
1624 }
1625
1626 // Phase Biases
1627 // ------------
1628 QByteArray hlpBufferPhaseBias;
1629 if (phasebias.NumberOfSat[CLOCKORBIT_SATGPS] > 0 ||
1630 phasebias.NumberOfSat[CLOCKORBIT_SATGLONASS] > 0 ||
1631 phasebias.NumberOfSat[CLOCKORBIT_SATGALILEO] > 0 ||
1632 phasebias.NumberOfSat[CLOCKORBIT_SATQZSS] > 0 ||
1633 phasebias.NumberOfSat[CLOCKORBIT_SATSBAS] > 0 ||
1634 phasebias.NumberOfSat[CLOCKORBIT_SATBDS] > 0 ) {
1635 char obuffer[CLOCKORBIT_BUFFERSIZE];
1636 int len = MakePhaseBias(&phasebias, PBTYPE_AUTO, 0, obuffer, sizeof(obuffer));
1637 if (len > 0) {
1638 hlpBufferPhaseBias = QByteArray(obuffer, len);
1639 }
1640 }
1641
1642 // VTEC
1643 // ----
1644 QByteArray hlpBufferVtec;
1645
1646 _outBuffer += hlpBufferCo + hlpBufferBias + hlpBufferPhaseBias;
1647}
1648
1649//
1650////////////////////////////////////////////////////////////////////////////
1651void bncRtnetUploadCaster::processSatellite(const t_eph* eph, int GPSweek,
1652 double GPSweeks, const QString& prn,
1653 const ColumnVector& rtnAPC,
1654 double rtnClk,
1655 const ColumnVector& rtnVel,
1656 const ColumnVector& rtnCoM,
1657 struct ClockOrbit::SatData* sd,
1658 QString& outLine) {
1659
1660 // Broadcast Position and Velocity
1661 // -------------------------------
1662 ColumnVector xB(4);
1663 ColumnVector vB(3);
1664 eph->getCrd(bncTime(GPSweek, GPSweeks), xB, vB, false);
1665
1666 // Precise Position
1667 // ----------------
1668 ColumnVector xP = _CoM ? rtnCoM : rtnAPC;
1669
1670 double dc = 0.0;
1671 if (_crdTrafo != "IGS08") {
1672 crdTrafo(GPSweek, xP, dc);
1673 }
1674
1675 // Difference in xyz
1676 // -----------------
1677 ColumnVector dx = xB.Rows(1,3) - xP;
1678 ColumnVector dv = vB - rtnVel;
1679
1680 // Difference in RSW
1681 // -----------------
1682 ColumnVector rsw(3);
1683 XYZ_to_RSW(xB.Rows(1,3), vB, dx, rsw);
1684
1685 ColumnVector dotRsw(3);
1686 XYZ_to_RSW(xB.Rows(1,3), vB, dv, dotRsw);
1687
1688 // Clock Correction
1689 // ----------------
1690 double dClk = rtnClk - (xB(4) - dc) * t_CST::c;
1691
1692 if (sd) {
1693 sd->ID = prn.mid(1).toInt();
1694 sd->IOD = eph->IOD();
1695 sd->Clock.DeltaA0 = dClk;
1696 sd->Clock.DeltaA1 = 0.0; // TODO
1697 sd->Clock.DeltaA2 = 0.0; // TODO
1698 sd->Orbit.DeltaRadial = rsw(1);
1699 sd->Orbit.DeltaAlongTrack = rsw(2);
1700 sd->Orbit.DeltaCrossTrack = rsw(3);
1701 sd->Orbit.DotDeltaRadial = dotRsw(1);
1702 sd->Orbit.DotDeltaAlongTrack = dotRsw(2);
1703 sd->Orbit.DotDeltaCrossTrack = dotRsw(3);
1704 }
1705
1706 outLine.sprintf("%d %.1f %s %3d %10.3f %8.3f %8.3f %8.3f\n",
1707 GPSweek, GPSweeks, eph->prn().toString().c_str(),
1708 eph->IOD(), dClk, rsw(1), rsw(2), rsw(3));
1709
1710 double relativity = -2.0 * DotProduct(xP, rtnVel) / t_CST::c;
1711 double sp3Clk = (rtnClk - relativity) / t_CST::c; // in seconds
1712
1713 if (_rnx) {
1714 _rnx->write(GPSweek, GPSweeks, prn, sp3Clk);
1715 }
1716 if (_sp3) {
1717 _sp3->write(GPSweek, GPSweeks, prn, rtnCoM, sp3Clk);
1718 }
1719}
1720
1721// Transform Coordinates
1722////////////////////////////////////////////////////////////////////////////
1723void bncRtnetUploadCaster::crdTrafo(int GPSWeek, ColumnVector& xyz,
1724 double& dc) {
1725
1726 // Current epoch minus 2000.0 in years
1727 // ------------------------------------
1728 double dt = (GPSWeek - (1042.0+6.0/7.0)) / 365.2422 * 7.0 + 2000.0 - _t0;
1729
1730 ColumnVector dx(3);
1731
1732 dx(1) = _dx + dt * _dxr;
1733 dx(2) = _dy + dt * _dyr;
1734 dx(3) = _dz + dt * _dzr;
1735
1736 static const double arcSec = 180.0 * 3600.0 / M_PI;
1737
1738 double ox = (_ox + dt * _oxr) / arcSec;
1739 double oy = (_oy + dt * _oyr) / arcSec;
1740 double oz = (_oz + dt * _ozr) / arcSec;
1741
1742 double sc = 1.0 + _sc * 1e-9 + dt * _scr * 1e-9;
1743
1744 // Specify approximate center of area
1745 // ----------------------------------
1746 ColumnVector meanSta(3);
1747
1748 if (_crdTrafo == "ETRF2000") {
1749 meanSta(1) = 3661090.0;
1750 meanSta(2) = 845230.0;
1751 meanSta(3) = 5136850.0;
1752 }
1753 else if (_crdTrafo == "NAD83") {
1754 meanSta(1) = -1092950.0;
1755 meanSta(2) = -4383600.0;
1756 meanSta(3) = 4487420.0;
1757 }
1758 else if (_crdTrafo == "GDA94") {
1759 meanSta(1) = -4052050.0;
1760 meanSta(2) = 4212840.0;
1761 meanSta(3) = -2545110.0;
1762 }
1763 else if (_crdTrafo == "SIRGAS2000") {
1764 meanSta(1) = 3740860.0;
1765 meanSta(2) = -4964290.0;
1766 meanSta(3) = -1425420.0;
1767 }
1768 else if (_crdTrafo == "SIRGAS95") {
1769 meanSta(1) = 3135390.0;
1770 meanSta(2) = -5017670.0;
1771 meanSta(3) = -2374440.0;
1772 }
1773 else if (_crdTrafo == "DREF91") {
1774 meanSta(1) = 3959579.0;
1775 meanSta(2) = 721719.0;
1776 meanSta(3) = 4931539.0;
1777 }
1778 else if (_crdTrafo == "Custom") {
1779 meanSta(1) = 0.0; // TODO
1780 meanSta(2) = 0.0; // TODO
1781 meanSta(3) = 0.0; // TODO
1782 }
1783
1784 // Clock correction proportional to topocentric distance to satellites
1785 // -------------------------------------------------------------------
1786 double rho = (xyz - meanSta).norm_Frobenius();
1787 dc = rho * (sc - 1.0) / sc / t_CST::c;
1788
1789 Matrix rMat(3,3);
1790 rMat(1,1) = 1.0;
1791 rMat(1,2) = -oz;
1792 rMat(1,3) = oy;
1793 rMat(2,1) = oz;
1794 rMat(2,2) = 1.0;
1795 rMat(2,3) = -ox;
1796 rMat(3,1) = -oy;
1797 rMat(3,2) = ox;
1798 rMat(3,3) = 1.0;
1799
1800 xyz = sc * rMat * xyz + dx;
1801}
1802
1803int bncRtnetUploadCaster::determineUpdateInd(double samplingRate) {
1804
1805 if (samplingRate == 10.0) {
1806 return 3;
1807 }
1808 else if (samplingRate == 15.0) {
1809 return 4;
1810 }
1811 else if (samplingRate == 30.0) {
1812 return 5;
1813 }
1814 else if (samplingRate == 60.0) {
1815 return 6;
1816 }
1817 else if (samplingRate == 120.0) {
1818 return 7;
1819 }
1820 else if (samplingRate == 240.0) {
1821 return 8;
1822 }
1823 else if (samplingRate == 300.0) {
1824 return 9;
1825 }
1826 else if (samplingRate == 600.0) {
1827 return 10;
1828 }
1829 else if (samplingRate == 900.0) {
1830 return 11;
1831 }
1832 else if (samplingRate == 1800.0) {
1833 return 12;
1834 }
1835 else if (samplingRate == 3600.0) {
1836 return 13;
1837 }
1838 else if (samplingRate == 7200.0) {
1839 return 14;
1840 }
1841 else if (samplingRate == 10800.0) {
1842 return 15;
1843 }
1844 return 2;// default
1845}
Note: See TracBrowser for help on using the repository browser.