Changeset 8619 in ntrip for trunk/BNC/src/pppModel.cpp

Timestamp:

Feb 28, 2019, 2:49:35 PM (5 years ago)

Author:

stuerze

Message:

special ssr wind up computation is added

File:

• trunk/BNC/src/pppModel.cpp (modified) (5 diffs)

trunk/BNC/src/pppModel.cpp

@@ -369 +369 @@
 ///////////////////////////////////////////////////////////////////////////
 double t_windUp::value(const bncTime& etime, const ColumnVector& rRec,
-                       t_prn prn, const ColumnVector& rSat) {
+                       t_prn prn, const ColumnVector& rSat, bool ssr,
+                       double yaw, const ColumnVector& vSat) {
 
   if (etime.mjddec() != lastEtime[prn.toInt()]) {
@@ -380 +381 @@
     // GPS Satellite unit Vectors sz, sy, sx
     // -------------------------------------
+    ColumnVector sHlp;
+    if (!ssr) {
+      sHlp = t_astro::Sun(etime.mjddec());
+    }
+    else {
+      ColumnVector Omega(3);
+      Omega[0] = 0.0;
+      Omega[1] = 0.0;
+      Omega[2] = t_CST::omega;
+      sHlp = vSat + crossproduct(Omega, rSat);
+    }
+    sHlp /= sHlp.norm_Frobenius();
+
     ColumnVector sz = -rSat / rSat.norm_Frobenius();
-
-    ColumnVector xSun = t_astro::Sun(etime.mjddec());
-    xSun /= xSun.norm_Frobenius();
-
-    ColumnVector sy = crossproduct(sz, xSun);
+    ColumnVector sy = crossproduct(sz, sHlp);
     ColumnVector sx = crossproduct(sy, sz);
+
+    // Yaw consideration
+    sx = t_astro::rotZ(yaw) * sx;
 
     // Effective Dipole of the GPS Satellite Antenna
     // ---------------------------------------------
-    ColumnVector dipSat = sx - rho * DotProduct(rho,sx)
-                                                - crossproduct(rho, sy);
+    ColumnVector dipSat = sx - rho * DotProduct(rho,sx) - crossproduct(rho, sy);
 
     // Receiver unit Vectors rx, ry
@@ -397 +409 @@
     ColumnVector rx(3);
     ColumnVector ry(3);
-
     double recEll[3]; xyz2ell(rRec.data(), recEll) ;
     double neu[3];
@@ -413 +424 @@
     // Effective Dipole of the Receiver Antenna
     // ----------------------------------------
-    ColumnVector dipRec = rx - rho * DotProduct(rho,rx)
-                                                   + crossproduct(rho, ry);
+    ColumnVector dipRec = rx - rho * DotProduct(rho,rx) + crossproduct(rho, ry);
 
     // Resulting Effect
@@ -420 +430 @@
     double alpha = DotProduct(dipSat,dipRec) /
                       (dipSat.norm_Frobenius() * dipRec.norm_Frobenius());
-
+/*
     if (alpha >  1.0) alpha =  1.0;
     if (alpha < -1.0) alpha = -1.0;
-
+*/
     double dphi = acos(alpha) / 2.0 / M_PI;  // in cycles