Changeset 9635 in ntrip for trunk/BNC/src/combination

Timestamp:

Feb 24, 2022, 5:08:42 PM (3 years ago)

Author:

stuerze

Message:

consideration of incoming Code Biases during clock combination

Location:

trunk/BNC/src/combination

Files:

• bnccomb.cpp (modified) (19 diffs)
• bnccomb.h (modified) (5 diffs)

trunk/BNC/src/combination/bnccomb.cpp

@@ -18 +18 @@
 #include <iomanip>
 #include <sstream>
+#include <map>
 
 #include "bnccomb.h"
@@ -472 +473 @@
     }
 
-    // Check satellite code biases
-    // ----------------------------
-    if (!_satCodeBiases.contains(acName)) {
-      delete newCorr;
-      continue;
-    }
-    else {
-      QMap<t_prn, t_satCodeBias>& storage = _satCodeBiases[acName];
-      if (!storage.contains(clkCorr._prn)) {
-        delete newCorr;
-        continue;
-      }
-      else {
-        newCorr->_satCodeBias = storage[clkCorr._prn];
-      }
-    }
-
     // Check the Ephemeris
     //--------------------
@@ -520 +504 @@
         continue;
       }
+    }
+
+    // Check satellite code biases
+    // ----------------------------
+    if (!_satCodeBiases.contains(acName)) {
+      delete newCorr;
+      continue;
+    }
+    else {
+      QMap<t_prn, t_satCodeBias>& storage = _satCodeBiases[acName];
+      if (!storage.contains(clkCorr._prn)) {
+        delete newCorr;
+        continue;
+      }
+      else {
+        t_satCodeBias& satCodeBias = storage[clkCorr._prn];
+        QMap<t_frequency::type, double> codeBias;
+        for (unsigned ii = 1; ii < t_lcRefSig::cIF; ii++) {
+          t_frequency::type frqType = t_lcRefSig::toFreq(sys,  static_cast<t_lcRefSig::type>(ii));
+          char frqNum = t_frequency::toString(frqType)[1];
+          char attrib = t_lcRefSig::toAttrib(sys,  static_cast<t_lcRefSig::type>(ii));
+          QString obsType = QString("%1%2").arg(frqNum).arg(attrib);
+          for (unsigned ii = 0; ii < satCodeBias._bias.size(); ii++) {
+            const t_frqCodeBias& bias = satCodeBias._bias[ii];
+            if (obsType.toStdString() == bias._rnxType2ch) {
+              codeBias[frqType] = bias._value;
+            }
+          }
+        }
+        map<t_frequency::type, double> codeCoeff;
+        double channel = double(newCorr->_eph->slotNum());
+        t_lcRefSig::coeff(sys, t_lcRefSig::cIF, channel, codeCoeff);
+        map<t_frequency::type, double>::const_iterator it;
+        for (it = codeCoeff.begin(); it != codeCoeff.end(); it++) {
+          t_frequency::type frqType = it->first;
+          newCorr->_codeBiasIF += it->second * codeBias[frqType];
+        }
+      }
+      cout <<  acName.toStdString() << " " << clkCorr._prn.toString().c_str() << " _codeBiasIF: " << newCorr->_codeBiasIF << endl;
     }
 
@@ -597 +620 @@
   QTextStream out(&_log, QIODevice::WriteOnly);
 
-  out << endl <<           "Combination: " << sys << endl
-      << "--------------------------------" << endl;
+  out << "\n" <<           "Combination: " << sys << "\n"
+      << "--------------------------------" << "\n";
 
   // Observation Statistics
@@ -617 +640 @@
       }
     }
-    out << AC->name.toLatin1().data() << ": " << AC->numObs[sys] << endl;
+    out << AC->name.toLatin1().data() << ": " << AC->numObs[sys] << "\n";
   }
 
@@ -629 +652 @@
     ++_masterMissingEpochs[sys];
     if (_masterMissingEpochs[sys] < switchMasterAfterGap) {
-      out << "Missing Master, Epoch skipped" << endl;
+      out << "Missing Master, Epoch skipped" << "\n";
       _buffer[sys].remove(_resTime);
       emit newMessage(_log, false);
@@ -644 +667 @@
               << AC->name.toLatin1().data()   << " "
               << _resTime.datestr().c_str()    << " "
-              << _resTime.timestr().c_str()    << endl;
+              << _resTime.timestr().c_str()    << "\n";
           _masterOrbitAC[sys] = AC->name;
           break;
@@ -682 +705 @@
       out.setRealNumberPrecision(4);
       out << pp->toString(sys) << " "
-          << pp->xx << " +- " << sqrt(_QQ[sys](pp->index,pp->index)) << endl;
+          << pp->xx << " +- " << sqrt(_QQ[sys](pp->index,pp->index)) << "\n";
       out.setFieldWidth(0);
     }
@@ -762 +785 @@
       }
 
-      out << "  Outlier" << endl;
+      out << "  Outlier" << "\n";
       _QQ[sys] = QQ_sav;
       corrs(sys).remove(maxResIndex-1);
     }
     else {
-      out << "  OK" << endl;
+      out << "  OK" << "\n";
       out.setRealNumberNotation(QTextStream::FixedNotation);
       out.setRealNumberPrecision(4);
@@ -776 +799 @@
             << corr->_acName << ' ' << corr->_prn.mid(0,3);
         out.setFieldWidth(10);
-        out <<  " res = " << vv[ii] << endl;
+        out <<  " res = " << vv[ii] << "\n";
         out.setFieldWidth(0);
       }
@@ -807 +830 @@
       out << "Full Clock " << corr->_prn.mid(0,3) << " " << corr->_iod << " ";
       out.setFieldWidth(14);
-      out << (xc(4) + corr->_dClkResult) * t_CST::c << endl;
+      out << (xc(4) + corr->_dClkResult) * t_CST::c << "\n";
       out.setFieldWidth(0);
     }
     else {
-      out << "bncComb::printResuls bug" << endl;
+      out << "bncComb::printResuls bug" << "\n";
     }
   }
@@ -958 +981 @@
     }
 
-    ll(iObs) = corr->_clkCorr._dClk * t_CST::c - DotProduct(AA.Row(iObs), x0);
+    ll(iObs) = (corr->_clkCorr._dClk * t_CST::c - corr->_codeBiasIF) - DotProduct(AA.Row(iObs), x0);
   }
 
@@ -1117 +1140 @@
     }
     catch (Exception& exc) {
-      out << exc.what() << endl;
+      out << exc.what() << "\n";
       return failure;
     }
@@ -1130 +1153 @@
 
     if (maxRes > _MAXRES) {
-      out << "  Outlier" << endl;
+      out << "  Outlier" << "\n";
       delete corrs(sys)[maxResIndex-1];
       corrs(sys).remove(maxResIndex-1);
     }
     else {
-      out << "  OK" << endl;
+      out << "  OK" << "\n";
       out.setRealNumberNotation(QTextStream::FixedNotation);
       out.setRealNumberPrecision(3);
@@ -1144 +1167 @@
             << corr->_acName << ' ' << corr->_prn.mid(0,3);
         out.setFieldWidth(6);
-        out << " res = " << vv[ii] << endl;
+        out << " res = " << vv[ii] << "\n";
         out.setFieldWidth(0);
       }
@@ -1172 +1195 @@
 
     if      (ephLast == 0) {
-      out << "checkOrbit: missing eph (not found) " << corr->_prn.mid(0,3) << endl;
+      out << "checkOrbit: missing eph (not found) " << corr->_prn.mid(0,3) << "\n";
       delete corr;
       im.remove();
     }
     else if (corr->_eph == 0) {
-      out << "checkOrbit: missing eph (zero) " << corr->_prn.mid(0,3) << endl;
+      out << "checkOrbit: missing eph (zero) " << corr->_prn.mid(0,3) << "\n";
       delete corr;
       im.remove();
@@ -1186 +1209 @@
       }
       else {
-        out << "checkOrbit: missing eph (deleted) " << corr->_prn.mid(0,3) << endl;
+        out << "checkOrbit: missing eph (deleted) " << corr->_prn.mid(0,3) << "\n";
         delete corr;
         im.remove();
@@ -1268 +1291 @@
               << prn.mid(0,3).toLatin1().data()           << " "
               << corr->_iod                     << " "
-              << norm                           << endl;
+              << norm                           << "\n";
           delete corr;
           im.remove();
@@ -1301 +1324 @@
       out << "Provider ID changed: AC " << AC->name.toLatin1().data()   << " "
           << _resTime.datestr().c_str()    << " "
-          << _resTime.timestr().c_str()    << endl;
+          << _resTime.timestr().c_str()    << "\n";
       break;
     }

trunk/BNC/src/combination/bnccomb.h

@@ -4 +4 @@
 
 #include <fstream>
+#include <map>
 #include <newmat.h>
 #include "bncephuser.h"
 #include "satObs.h"
+#include "bncconst.h"
 #include "../RTCM3/clock_and_orbit/clock_orbit_rtcm.h"
 #include "../RTCM3/clock_and_orbit/clock_orbit_igs.h"
@@ -80 +82 @@
       _iod        = 0;
       _dClkResult = 0.0;
+      _codeBiasIF   = 0.0;
     }
     ~cmbCorr() {}
@@ -90 +93 @@
     t_satCodeBias _satCodeBias;
     QString       _acName;
+    double        _codeBiasIF;
     double        _dClkResult;
     ColumnVector  _diffRao;
@@ -106 +110 @@
     QVector<cmbCorr*> corrs;
   };
+
+  class t_lcRefSig {
+   public:
+    enum type {dummy = 0, c1, c2, cIF};
+
+    static t_frequency::type toFreq(char sys, type tt) {
+      switch (tt) {
+      case c1:
+        if      (sys == 'G') return t_frequency::G1;
+        else if (sys == 'R') return t_frequency::R1;
+        else if (sys == 'E') return t_frequency::E1;
+        else if (sys == 'C') return t_frequency::C2;
+        else if (sys == 'J') return t_frequency::J1;
+        else if (sys == 'S') return t_frequency::S1;
+        else                 return t_frequency::dummy;
+      case c2:
+        if      (sys == 'G') return t_frequency::G2;
+        else if (sys == 'R') return t_frequency::R2;
+        else if (sys == 'E') return t_frequency::E5;
+        else if (sys == 'C') return t_frequency::C6;
+        else if (sys == 'J') return t_frequency::J2;
+        else if (sys == 'S') return t_frequency::S5;
+        else                 return t_frequency::dummy;
+      case dummy:
+      case cIF:
+        return t_frequency::dummy;
+      }
+      return t_frequency::dummy;
+    }
+
+    static char toAttrib(char sys, type LC) {
+      switch (LC) {
+        case c1:
+          if      (sys == 'G') return 'W';
+          else if (sys == 'R') return 'P';
+          else if (sys == 'E') return 'C';
+          else if (sys == 'C') return 'I';
+          else if (sys == 'J') return 'C';
+          else if (sys == 'S') return 'C';
+          break;
+        case c2:
+          if      (sys == 'G') return 'W';
+          else if (sys == 'R') return 'P';
+          else if (sys == 'E') return 'Q';
+          else if (sys == 'C') return 'I';
+          else if (sys == 'J') return 'L';
+          else if (sys == 'S') return 'Q';
+          break;
+      case dummy:
+      case cIF:
+        return '_';
+        break;
+      }
+      return '_';
+    }
+
+      static void coeff(char sys, type tLC, double channel, std::map<t_frequency::type, double>& codeCoeff)  {
+      codeCoeff.clear();
+      t_frequency::type fType1 = toFreq(sys, c1);
+      t_frequency::type fType2 = toFreq(sys, c2);
+      double f1 = t_CST::freq(fType1, channel);
+      double f2 = t_CST::freq(fType2, channel);
+      switch (tLC) {
+        case c1:
+          codeCoeff[fType1] = 1.0;
+          return;
+        case c2:
+          codeCoeff[fType2] = 1.0;
+          return;
+        case cIF:
+          codeCoeff[fType1] =  f1 * f1 / (f1 * f1 - f2 * f2);
+          codeCoeff[fType2] = -f2 * f2 / (f1 * f1 - f2 * f2);
+          return;
+        case t_lcRefSig::dummy:
+          return;
+      }
+      return;
+    }
+  };
+
 
   void  processEpoch(char sys);
@@ -134 +218 @@
   e_method                                   _method;
   int                                        _cmbSampl;
+  QString                                    _cmbRefAttributes;
   QMap<QString, QMap<t_prn, t_orbCorr> >     _orbCorrections;
   QMap<QString, QMap<t_prn, t_satCodeBias> > _satCodeBiases;