Changeset 8905 in ntrip for trunk/BNC/src/PPP/pppClient.cpp

Timestamp:

Mar 18, 2020, 11:13:50 AM (4 years ago)

Author:

stuerze

Message:

some developments regarding PPP, not completed!

File:

• trunk/BNC/src/PPP/pppClient.cpp (modified) (13 diffs)

trunk/BNC/src/PPP/pppClient.cpp

@@ -55 +55 @@
   _obsPool  = new t_pppObsPool();
   _staRover = new t_pppStation();
-  _filter   = new t_pppFilter();
+  _filter   = new t_pppFilter(_obsPool);
   _tides    = new t_tides();
-
+  _antex    = 0;
   if (!_opt->_antexFileName.empty()) {
     _antex = new bncAntex(_opt->_antexFileName.c_str());
   }
-  else {
-    _antex = 0;
-  }
-
   if (!_opt->_blqFileName.empty()) {
-    _loading = new t_loading(_opt->_blqFileName.c_str());
-  }
-  else {
-    _loading = 0;
-  }
-
+    if (_tides->readBlqFile(_opt->_blqFileName.c_str()) == success) {
+      //_tides->printAllBlqSets();
+    }
+  }
+
+  if (OPT->_refSatRequired) {
+    for (unsigned iSys = 0; iSys < OPT->systems().size(); iSys++) {
+      char system = OPT->systems()[iSys];
+      _obsPool->initRefSatMapElement(system);
+    }
+  }
+  _offGG = 0.0;
   CLIENTS.setLocalData(this);  // CLIENTS takes ownership over "this"
 }
@@ -80 +82 @@
   delete _log;
   delete _opt;
+  delete _filter;
   delete _ephPool;
   delete _obsPool;
@@ -86 +89 @@
     delete _antex;
   }
-  delete _filter;
   delete _tides;
-  if (_loading) {
-    delete _loading;
-  }
   clearObs();
 }
@@ -157 +156 @@
 t_irc t_pppClient::prepareObs(const vector<t_satObs*>& satObs,
                               vector<t_pppSatObs*>& obsVector, bncTime& epoTime) {
+
   // Default
   // -------
@@ -176 +176 @@
   }
 
+  // (re)set reference satellites per system if required
+  // ---------------------------------------------------
+  if (_opt->_refSatRequired) {
+    // reference satellite definition per system
+    for (unsigned iSys = 0; iSys < OPT->systems().size(); iSys++) {
+      char system = OPT->systems()[iSys];
+      bool refSatDefined = false;
+      t_pppRefSat* refSat = _obsPool->getRefSatMapElement(system);
+      for (unsigned ii = 0; ii < obsVector.size(); ii++) {
+        const t_pppSatObs* satObs = obsVector.at(ii);
+        // reference satellite is unchanged
+        if      (!_obsPool->epoReProcessing() && refSat->prn() == satObs->prn()) {
+          refSatDefined = true;
+          obsVector[ii]->setAsReference();
+          refSat->setStatus(t_pppRefSat::unchanged);
+        }
+        // reference satellite has changed
+        else if (_obsPool->epoReProcessing() && refSat->prn() != satObs->prn()) {
+          if (satObs->prn().system() == system) {
+            refSatDefined = true;
+            obsVector[ii]->setAsReference();
+            refSat->setStatus(t_pppRefSat::changed);
+            refSat->setPrn(satObs->prn());
+          }
+        }
+        if (refSatDefined) {
+          break;
+        }
+      }
+      // reference satellite has to be initialized
+      if (!refSatDefined) {
+        for (unsigned ii = 0; ii < obsVector.size(); ii++) {
+          const t_pppSatObs* satObs = obsVector.at(ii);
+          if (satObs->prn().system() == system) {
+            obsVector[ii]->setAsReference();
+            refSat->setStatus(t_pppRefSat::initialized);
+            refSat->setPrn(satObs->prn());
+          }
+        }
+      }
+    }
+    _obsPool->setEpoReProcessing(false); //TODO: später erst nach Trafo false setzen
+  }
+
   // Check whether data are synchronized, compute epoTime
   // ----------------------------------------------------
@@ -202 +246 @@
 }
 
+//
+//////////////////////////////////////////////////////////////////////////////
+bool t_pppClient::preparePseudoObs(std::vector<t_pppSatObs*>& obsVector) {
+
+  bool pseudoObsIono = false;
+
+  if (OPT->_pseudoObsIono) {
+    vector<t_pppSatObs*>::iterator it = obsVector.begin();
+    while (it != obsVector.end()) {
+      t_pppSatObs* satObs = *it;
+      char system = satObs->prn().system();
+      t_pppRefSat* refSat = _obsPool->getRefSatMapElement(system);
+      double stecRef = refSat->stecValue();
+      if (stecRef && !satObs->isReference()) {
+        pseudoObsIono = true;
+        satObs->setPseudoObsIono(t_frequency::G1, stecRef);
+      }
+      satObs->printObsMinusComputed();
+      it++;
+    }
+  }
+
+  return pseudoObsIono;
+}
+
 // Compute the Bancroft position, check for blunders
 //////////////////////////////////////////////////////////////////////////////
@@ -250 +319 @@
     for (unsigned ii = 0; ii < obsVector.size(); ii++) {
       const t_pppSatObs* satObs = obsVector.at(ii);
-      if ( satObs->isValid() && satObs->prn().system() == 'G' &&
-           (!satObs->modelSet() || satObs->eleSat() >= OPT->_minEle) ) {
+      if (satObs->isValid() &&
+          satObs->prn().system() == 'G' &&
+          (!satObs->modelSet() || satObs->eleSat() >= OPT->_minEle) ) {
         ColumnVector rr = satObs->xc().Rows(1,3) - xyzc.Rows(1,3);
-        double res = rr.norm_Frobenius() - satObs->obsValue(tLC)
+        double res = rr.NormFrobenius() - satObs->obsValue(tLC)
                    - (satObs->xc()[3] - xyzc[3]) * t_CST::c;
         if (std::isnan(res) || fabs(res) > maxRes) {
@@ -393 +463 @@
 t_irc t_pppClient::cmpModel(t_pppStation* station, const ColumnVector& xyzc,
                                vector<t_pppSatObs*>& obsVector) {
-
   bncTime time;
   time = _epoTimeRover;
   station->setName(OPT->_roverName);
   station->setAntName(OPT->_antNameRover);
+  station->setEpochTime(time);
   if (OPT->xyzAprRoverSet()) {
     station->setXyzApr(OPT->_xyzAprRover);
@@ -412 +482 @@
   // Tides
   // -----
-  station->setTideDspl( _tides->displacement(time, station->xyzApr()) );
-
-  // Ionosphere
-  // ----------
-  station->setIonoEpochTime(time);
+  station->setTideDsplEarth(_tides->earth(time, station->xyzApr()));
+  station->setTideDsplOcean(_tides->ocean(time, station->xyzApr(), station->name()));
 
   // Observation model
@@ -430 +497 @@
         satObs->eleSat() >= OPT->_minEle &&
         modelSetup == success) {
+      if (satObs->isReference() && OPT->_pseudoObsIono) {
+        char system = satObs->prn().system();
+        t_pppRefSat* refSat = _obsPool->getRefSatMapElement(system);
+        refSat->setStecValue(satObs->getIonoCodeDelay(t_frequency::G1));
+      }
       ++it;
     }
@@ -447 +519 @@
   try {
     initOutput(output);
-
-    // Prepare Observations of the Rover
-    // ---------------------------------
-    if (prepareObs(satObs, _obsRover, _epoTimeRover) != success) {
-      return finish(failure);
-    }
-
-    LOG << "\nPPP of Epoch ";
-    if (!_epoTimeRover.undef()) LOG << string(_epoTimeRover);
-    LOG << "\n---------------------------------------------------------------\n";
-
-    for (int iter = 1; iter <= 2; iter++) {
-      ColumnVector xyzc(4); xyzc = 0.0;
-      bool print = (iter == 2);
-      if (cmpBancroft(_epoTimeRover, _obsRover, xyzc, print) != success) {
+    _num = 0;
+    _obsPool->setEpoReProcessing(false); // initialize for epoch
+
+    do {
+      _num++;
+
+      // Prepare Observations of the Rover
+      // ---------------------------------
+      if (prepareObs(satObs, _obsRover, _epoTimeRover) != success) {
         return finish(failure);
       }
-      if (cmpModel(_staRover, xyzc, _obsRover) != success) {
+
+      LOG << "\nPPP of Epoch ";
+      if (!_epoTimeRover.undef()) LOG << string(_epoTimeRover);
+      LOG << "\n---------------------------------------------------------------\n";
+
+      for (int iter = 1; iter <= 2; iter++) {
+        ColumnVector xyzc(4); xyzc = 0.0;
+        bool print = (iter == 2);
+        if (cmpBancroft(_epoTimeRover, _obsRover, xyzc, print) != success) {
+          return finish(failure);
+        }
+        if (cmpModel(_staRover, xyzc, _obsRover) != success) {
+          return finish(failure);
+        }
+      }
+
+      _offGG = cmpOffGG(_obsRover);
+
+      // Prepare Pseudo Observations of the Rover
+      // ----------------------------------------
+      _pseudoObsIono = preparePseudoObs(_obsRover);//qDebug() << "_pseudoObsIonoAvailable: " << _pseudoObsIono;
+
+      if (int(_obsRover.size()) < OPT->_minObs) {
+        LOG << "t_pppClient::processEpoch not enough observations" << endl;
         return finish(failure);
       }
-    }
-
-    _offGG = cmpOffGG(_obsRover);
-
-    if (int(_obsRover.size()) < OPT->_minObs) {
-      LOG << "t_pppClient::processEpoch not enough observations" << endl;
-      return finish(failure);
-    }
-
-    // Store last epoch of data
-    // ------------------------
-    _obsPool->putEpoch(_epoTimeRover, _obsRover);
-
-    // Process Epoch in Filter
-    // -----------------------
-    if (_filter->processEpoch(_obsPool) != success) {
-      return finish(failure);
-    }
+
+      if (OPT->_refSatRequired) {
+        LOG.setf(ios::fixed);
+        QMapIterator<char, t_pppRefSat*> it(_obsPool->getRefSatMap());
+        while (it.hasNext()) {
+          it.next();
+          char   sys = it.key();
+          string prn = it.value()->prn().toString();
+          LOG << string(_epoTimeRover) << " REFSAT  " << sys << ": " << prn << endl;
+        }
+      }
+
+      // Store last epoch of data
+      // ------------------------
+      //_obsRover.resize(2);
+      _obsPool->putEpoch(_epoTimeRover, _obsRover, _pseudoObsIono);
+
+      // Process Epoch in Filter
+      // -----------------------
+      if (_filter->processEpoch(_num) != success) {
+        return finish(failure);
+      }
+      // if num > 1 und !obsPool->epoReProcessing() => filter ->datumTransformation
+    } while (_obsPool->epoReProcessing());
   }
   catch (Exception& exc) {
@@ -588 +683 @@
 void t_pppClient::reset() {
 
-  // to delete all parameters
-  delete _filter;
-  _filter   = new t_pppFilter();
-
   // to delete old orbit and clock corrections
   delete _ephPool;
@@ -599 +690 @@
   delete _obsPool;
   _obsPool  = new t_pppObsPool();
-}
+
+  // to delete all parameters
+  delete _filter;
+  _filter   = new t_pppFilter(_obsPool);
+
+}