Changeset 10031 in ntrip for trunk/BNC/src/PPP/pppFilter.cpp
- Timestamp:
- Apr 14, 2023, 11:56:49 AM (19 months ago)
- File:
-
- 1 edited
Legend:
- Unmodified
- Added
- Removed
-
trunk/BNC/src/PPP/pppFilter.cpp
r10028 r10031 95 95 // Status Vector, Variance-Covariance Matrix 96 96 // ----------------------------------------- 97 ColumnVector xFltOld = _xFlt;97 ColumnVector xFltOld = _xFlt; 98 98 SymmetricMatrix QFltOld = _QFlt; 99 99 setStateVectorAndVarCovMatrix(xFltOld, QFltOld, setNeuNoiseToZero); … … 467 467 // ----------------------- 468 468 else { 469 ColumnVector AA(nPar); 470 for (unsigned iPar = 0; iPar < nPar; iPar++) { 471 const t_pppParam *par = params[iPar]; 472 AA[iPar] = par->partial(_epoTime, obs, tLC, refPrn); 473 } 474 double ll = obs->obsValue(tLC) - obs->cmpValue(tLC) 475 - DotProduct(_x0, AA); 476 double vv = DotProduct(AA, _xFlt) - ll; 477 if (fabs(vv) > SLIP) { 478 LOG << epoTimeStr << " cycle slip detected " << t_lc::toString(tLC) 479 << ' ' << obs->prn().toString() << ' ' << setw(8) 480 << setprecision(4) << vv << endl; 481 if (preProcessing) { 482 _obsPool->setRefSatChangeRequired(sys, true); 483 } else { 469 if (!preProcessing) { 470 ColumnVector AA(nPar); 471 for (unsigned iPar = 0; iPar < nPar; iPar++) { 472 const t_pppParam *par = params[iPar]; 473 AA[iPar] = par->partial(_epoTime, obs, tLC, refPrn); 474 } 475 double ll = obs->obsValue(tLC) - obs->cmpValue(tLC) 476 - DotProduct(_x0, AA); 477 double vv = DotProduct(AA, _xFlt) - ll; 478 if (fabs(vv) > SLIP) { 479 LOG << epoTimeStr << " cycle slip detected " << t_lc::toString(tLC) 480 << ' ' << obs->prn().toString() << ' ' << setw(8) 481 << setprecision(4) << vv << endl; 484 482 resetAmb(obs->prn(), obsVector, tLC); 485 483 } … … 682 680 #ifdef BNC_DEBUG_PPP 683 681 LOG << "GET LAST EPOCH" << endl; 684 #endif 682 #endif 685 683 if (!epoch) { 686 684 LOG << "t_pppFilter::datumTransformation: !lastEpoch" << endl; … … 688 686 } 689 687 _epoTime = epoch->epoTime(); 690 688 691 689 LOG.setf(ios::fixed); 692 690 LOG << "DATUM TRANSFORMATION in Epoch "<< string(_epoTime) << endl; … … 785 783 } 786 784 787 ColumnVector xFltOld = _xFlt;785 ColumnVector xFltOld = _xFlt; 788 786 SymmetricMatrix QFltOld = _QFlt; 789 787 … … 821 819 // ================= 822 820 _datumTrafo->switchAA(); 823 821 824 822 _obsPool->putEpoch(_epoTime, allObs, pseudoObsIono, refSatMap); 825 #ifdef BNC_DEBUG_PPP 823 #ifdef BNC_DEBUG_PPP 826 824 LOG << "PUT EPOCH t_pppFilter::datumTransformation " << _epoTime.timestr().c_str() << endl; 827 825 #endif
Note:
See TracChangeset
for help on using the changeset viewer.