Changeset 8912 in ntrip for trunk/BNC/src/PPP/pppFilter.cpp

Timestamp:

Apr 6, 2020, 10:43:22 AM (4 years ago)

Author:

stuerze

Message:

minor changes regarding PPP (not completed)

File:

• trunk/BNC/src/PPP/pppFilter.cpp (modified) (11 diffs)

trunk/BNC/src/PPP/pppFilter.cpp

@@ -51 +51 @@
 t_irc t_pppFilter::processEpoch(int num) {
   _numSat     = 0;
+  _numOfEpochProcessing = num;
   const double maxSolGap = 60.0;
 
@@ -87 +88 @@
   ColumnVector    xFltOld = _xFlt;
   SymmetricMatrix QFltOld = _QFlt;
-
   _QFlt.ReSize(_parlist->nPar()); _QFlt = 0.0;
   _xFlt.ReSize(_parlist->nPar()); _xFlt = 0.0;
   _x0.ReSize(_parlist->nPar());   _x0   = 0.0;
-
   for (unsigned ii = 0; ii < params.size(); ii++) {
     const t_pppParam* par1 = params[ii];
@@ -111 +110 @@
     }
   }
-
   predictCovCrdPart(QFltOld);
 
@@ -141 +139 @@
   // Process Satellite Systems separately
   // ------------------------------------
+  int numOfAllUsedLCs = 0;
+  preProcessing = false;
   for (unsigned iSys = 0; iSys < OPT->systems().size(); iSys++) {
     char system = OPT->systems()[iSys];
+    numOfAllUsedLCs += OPT->LCs(system).size();
     if (OPT->_refSatRequired) {
       _refPrn = (_obsPool->getRefSatMapElement(system))->prn();
@@ -160 +161 @@
     }
   }
-  if (_obsPool->epoReProcessing()) {
-    // set A1 und A2 abhängig von num
-    // if num == 1 => A1
-    // if num >  1 => A2
-  }
+
+  // refSat change required?
+  // -----------------------
+  if (_obsPool->refSatChangeRequired()) {
+    _xFlt = xFltOld;
+    _QFlt = QFltOld;
+    initDatumTransformation(numOfAllUsedLCs);
+  }
+  // close epoch processing
+  // ----------------------
   else {
     cmpDOP(allObs);
@@ -223 +229 @@
     ColumnVector          ll(maxObs);
     DiagonalMatrix        PP(maxObs); PP = 0.0;
-    //TETSPLOT
+
+    // TETSPLOT
     for (unsigned iPar = 0; iPar < params.size(); iPar++) {
       const t_pppParam* par = params[iPar];
@@ -229 +236 @@
     }
     cout << endl;
+    //END TETSPLOT
 
     int iObs = -1;
@@ -307 +315 @@
       if      (par && preProcessing) {
         if (par->prn() == refPrn) {
-          _obsPool->setEpoReProcessing(true);
+          _obsPool->setRefSatChangeRequired(true);
         }
       }
@@ -392 +400 @@
           if (preProcessing) {
             if (obs->prn() == refPrn) {
-              _obsPool->setEpoReProcessing(true);
+              _obsPool->setRefSatChangeRequired(true);
             }
           }
@@ -412 +420 @@
             if (preProcessing) {
               if (obs->prn() == refPrn) {
-                _obsPool->setEpoReProcessing(true);
+                _obsPool->setRefSatChangeRequired(true);
               }
             }
@@ -542 +550 @@
   }
 }
+
+//
+////////////////////////////////////////////////////////////////////////////
+void t_pppFilter::initDatumTransformation(int numOfUsedLCs) {
+
+  if (_numOfEpochProcessing == 1) {
+           _AA1.ReSize(numOfUsedLCs, _parlist->nPar());
+           _AA1 = 0.0;
+     _AA2.ReSize(numOfUsedLCs, _parlist->nPar());
+     _AA2 = 0.0;
+  }
+}
+
+//
+////////////////////////////////////////////////////////////////////////////
+void t_pppFilter::datumTransformation() {
+
+  Matrix D21 = (_AA2.t() * _AA2).i() * _AA2.t() * _AA1;
+
+  _QFlt = D21 * _QFlt * D21.t();
+}
+
+
+
+