Changeset 5750 in ntrip for trunk/BNC/src/PPP/satobs.cpp

Timestamp:

Aug 3, 2014, 11:30:39 AM (10 years ago)

Author:

mervart

Message:

 

File:

• trunk/BNC/src/PPP/satobs.cpp (modified) (20 diffs)

trunk/BNC/src/PPP/satobs.cpp

@@ -44 +44 @@
 #include <newmatio.h>
 #include "satobs.h"
-#include "genconst.h"
+#include "bncconst.h"
 #include "ephpool.h"
 #include "station.h"
-#include "utils.h"
-#include "tropo.h"
-#include "antex.h"
+#include "bncutils.h"
+#include "bncantex.h"
 #include "obspool.h"
+#include "pppClient.h"
+#include "bncmodel.h"
 
 using namespace BNC;
@@ -57 +58 @@
 // Constructor
 ////////////////////////////////////////////////////////////////////////////
-t_satObs::t_obs::t_obs(const t_obs& obs) {
-  _type            = obs._rnxType2ch;
-  _code            = obs._code;           
-  _codeValid       = obs._codeValid;      
-  _phase           = obs._phase;          
-  _phaseValid      = obs._phaseValid;     
-  _doppler         = obs._doppler;        
-  _dopplerValid    = obs._dopplerValid;   
-  _snr             = obs._snr;            
-  _snrValid        = obs._snrValid;       
-  _slip            = obs._slip;           
-  _slipCounter     = obs._slipCounter;    
-  _biasJumpCounter = -1;
-}
-
-// Constructor
-////////////////////////////////////////////////////////////////////////////
-t_satObs::t_satObs(const t_satObs& satObs) {
-  _prn  = satObs._prn;
-  _time = satObs._time;
+t_satObs::t_satObs(const t_pppSatObs& pppSatObs) {
+  _prn  = pppSatObs._prn;
+  _time = pppSatObs._time;
   _outlier    = false;
-  for (int ii = 0; ii < satObs._numObs; ii++) {
-    const t_obs& obs = satObs._obs[ii];
+  for (unsigned ii = 0; ii < pppSatObs._obs.size(); ii++) {
+    const t_obs& obs = pppSatObs._obs[ii];
     t_obsType obsType = string(obs._rnxType2ch).substr(0,2);
     _allObs[obsType] = new t_obs(obs);
@@ -145 +129 @@
   // Copy raw observations
   // ---------------------
-  _f1    = t_genConst::f1(_prn.system(), _channel);
+  _f1    = t_CST::f1(_prn.system(), _channel);
   _rawC1 = _validObs1->_code;
-  _rawL1 = _validObs1->_phase * t_genConst::c / _f1;
+  _rawL1 = _validObs1->_phase * t_CST::c / _f1;
   if (dualFreq) {
-    _f2    = t_genConst::f2(_prn.system(), _channel);
+    _f2    = t_CST::f2(_prn.system(), _channel);
     _rawC2 = _validObs2->_code;
-    _rawL2 = _validObs2->_phase * t_genConst::c / _f2;
+    _rawL2 = _validObs2->_phase * t_CST::c / _f2;
   }
   else {
@@ -168 +152 @@
   double prange = obsValue(tLC);
   for (int ii = 1; ii <= 10; ii++) {
-    bncTime ToT = _time - prange / t_genConst::c - _xcSat[3];
-    if (PPP_CLIENT->ephPool()->getCrd(_prn, ToT, _xcSat, _vvSat) != t_irc::success) {
+    bncTime ToT = _time - prange / t_CST::c - _xcSat[3];
+    if (PPP_CLIENT->ephPool()->getCrd(_prn, ToT, _xcSat, _vvSat) != success) {
       _valid = false;
       return;
     }
     ColumnVector dx = _xcSat - satPosOld;
-    dx[3] *= t_genConst::c;
+    dx[3] *= t_CST::c;
     if (dx.norm_Frobenius() < 1.e-4) {
       totOK = true;
@@ -182 +166 @@
   }
   if (totOK) {
-    _model._satClkM = _xcSat[3] * t_genConst::c; 
+    _model._satClkM = _xcSat[3] * t_CST::c; 
   }
   else {
@@ -214 +198 @@
   // Satellite Clocks
   // ----------------
-  _model._satClkM = _xcSat[3] * t_genConst::c;
+  _model._satClkM = _xcSat[3] * t_CST::c;
 
   // Receiver Clocks
   // ---------------
-  _model._recClkM = station->dClk() * t_genConst::c;
+  _model._recClkM = station->dClk() * t_CST::c;
 
   // Sagnac Effect (correction due to Earth rotation)
@@ -225 +209 @@
   Omega[0] = 0.0;
   Omega[1] = 0.0;
-  Omega[2] = t_genConst::omega / t_genConst::c;
+  Omega[2] = t_CST::omega / t_CST::c;
   _model._sagnac = DotProduct(Omega, crossproduct(rSat, station->xyzApr()));
 
@@ -250 +234 @@
   // Tropospheric Delay
   // ------------------
-  t_tropo::dtrop(_time, station->ellApr()[0], station->ellApr()[1],
-                 station->ellApr()[2], _model._eleSat, OPT->tropoModel(),
-                 OPT->tropoMF(), false, _model._tropo);
+  _model._tropo = bncModel::delay_saast(station->xyzApr(), station->ellApr()[2]);
 
   // Phase Wind-Up
@@ -264 +246 @@
   bool biasL1flg = false;
   bool biasL2flg = false;
-  int  nsdfix    =  0;
   const t_satBias* satBias = PPP_CLIENT->obsPool()->satBias(_prn);
   if (satBias) { 
-    nsdfix    = satBias->nx();
     map<t_biasType, double>::const_iterator it;
     for (it = satBias->biases().begin(); it != satBias->biases().end(); it++) {
@@ -273 +253 @@
       if (_validObs1) {
         _validObs1->_biasJumpCounter = satBias->jumpCount();
-        if      ("C" + _validObs1->_type == biasType) {
+        if      ("C" + _validObs1->_rnxType2ch == biasType) {
           _model._biasC1 = it->second;
           biasC1flg = true;
         }
-        else if ("L" + _validObs1->_type == biasType) {
+        else if ("L" + _validObs1->_rnxType2ch == biasType) {
           _model._biasL1 = it->second;
           biasL1flg = true;
@@ -284 +264 @@
       if (_validObs2) {
         _validObs2->_biasJumpCounter = satBias->jumpCount();
-        if      ("C" + _validObs2->_type == biasType) {
+        if      ("C" + _validObs2->_rnxType2ch == biasType) {
           _model._biasC2 = it->second;
           biasC2flg = true;
         }
-        else if ("L" + _validObs2->_type == biasType) {
+        else if ("L" + _validObs2->_rnxType2ch == biasType) {
           _model._biasL2 = it->second;
           biasL2flg = true;
@@ -299 +279 @@
       _valid = false;
     }
-    if (nsdfix < OPT->minSDFix()) {
-      _valid = false;
-    }
   }
 
@@ -320 +297 @@
   _model._set = true;
 
-  return t_irc::success;
+  return success;
 }
 
@@ -329 +306 @@
   LOG << "MODEL for Satellite " << _prn.toString() << endl
       << "RHO:    " << setw(12) << setprecision(3) << _model._rho     << endl
-      << "ELE:    " << setw(12) << setprecision(3) << _model._eleSat * t_genConst::rho_deg << endl
-      << "AZI:    " << setw(12) << setprecision(3) << _model._azSat  * t_genConst::rho_deg << endl
+      << "ELE:    " << setw(12) << setprecision(3) << _model._eleSat * 180.0 / M_PI << endl
+      << "AZI:    " << setw(12) << setprecision(3) << _model._azSat  * 180.0 / M_PI << endl
       << "SATCLK: " << setw(12) << setprecision(3) << _model._satClkM << endl
       << "RECCLK: " << setw(12) << setprecision(3) << _model._recClkM << endl
@@ -350 +327 @@
 
   LOG << "WIND L3:" <<  setw(12) << setprecision(3) 
-      << lc(t_lc::lIF, _model._windUp * t_genConst::c / _f1, 
-                       _model._windUp * t_genConst::c / _f2, 0.0, 0.0) << endl;
+      << lc(t_lc::lIF, _model._windUp * t_CST::c / _f1, 
+                       _model._windUp * t_CST::c / _f2, 0.0, 0.0) << endl;
 
   LOG << "OBS-CMP P3: " << _prn.toString() << " " 
@@ -403 +380 @@
   // Add Dispersive Part
   // -------------------
-  double L1 = nonDisp + _model._antPco1 - _model._biasL1 + _model._windUp * t_genConst::c / _f1;
-  double L2 = nonDisp + _model._antPco2 - _model._biasL2 + _model._windUp * t_genConst::c / _f2;
+  double L1 = nonDisp + _model._antPco1 - _model._biasL1 + _model._windUp * t_CST::c / _f1;
+  double L2 = nonDisp + _model._antPco2 - _model._biasL2 + _model._windUp * t_CST::c / _f2;
   double C1 = nonDisp + _model._antPco1 - _model._biasC1;
   double C2 = nonDisp + _model._antPco2 - _model._biasC2;
@@ -503 +480 @@
   _model._biasL2  -= obsBase->_model._biasL2;
 
-  return t_irc::success;
+  return success;
 }
 
@@ -511 +488 @@
 
   if      (tLC == t_lc::l1) {
-    return t_genConst::c / _f1;
+    return t_CST::c / _f1;
   }
   else if (tLC == t_lc::l2) {
-    return t_genConst::c / _f2;
+    return t_CST::c / _f2;
   }
   else if (tLC == t_lc::lIF) {
-    return t_genConst::c / (_f1 + _f2);
+    return t_CST::c / (_f1 + _f2);
   }
   else if (tLC == t_lc::MW) {
-    return t_genConst::c / (_f1 - _f2);
+    return t_CST::c / (_f1 - _f2);
   }
   else if (tLC == t_lc::CL) {
-    return t_genConst::c / _f1 / 2.0;
+    return t_CST::c / _f1 / 2.0;
   }
 
@@ -534 +511 @@
 
   ColumnVector sig(4);
-  sig(1) = OPT->sigmaPhase();
-  sig(2) = OPT->sigmaPhase();
-  sig(3) = OPT->sigmaCode();
-  sig(4) = OPT->sigmaCode();
+  sig(1) = OPT->_sigmaL1;
+  sig(2) = OPT->_sigmaL1;
+  sig(3) = OPT->_sigmaC1;
+  sig(4) = OPT->_sigmaC1;
 
   ColumnVector coeff(4);
@@ -547 +524 @@
   // -----------------------------
   double cEle = 1.0;
-  if ( (OPT->eleWgtCode()  && t_lc::includesCode(tLC)) ||
-       (OPT->eleWgtPhase() && t_lc::includesPhase(tLC)) ) {
-    double eleD = eleSat()*180.0/t_genConst::pi;
+  if ( (OPT->_eleWgtCode  && t_lc::includesCode(tLC)) ||
+       (OPT->_eleWgtPhase && t_lc::includesPhase(tLC)) ) {
+    double eleD = eleSat()*180.0/M_PI;
     double hlp  = fabs(90.0 - eleD);
     cEle = (1.0 + hlp*hlp*hlp*0.000004);