Changeset 9474 in ntrip for branches/BNC_2.12/src/PPP_SSR_I/pppFilter.cpp

Timestamp:

Jul 13, 2021, 10:59:04 PM (3 years ago)

Author:

stuerze

Message:

satellite antenna phase center correction is added

File:

• branches/BNC_2.12/src/PPP_SSR_I/pppFilter.cpp (modified) (2 diffs)

branches/BNC_2.12/src/PPP_SSR_I/pppFilter.cpp

@@ -376 +376 @@
 
   if (_antex) {
+
+    // Satellite correction
+    // ---------------------
+    double elTx,azTx;
+
+    // LOS unit vector satellite --> receiver
+    ColumnVector rho = xRec - satData->xx;
+    rho /= rho.norm_Frobenius();
+
+    // Sun unit vector
+    ColumnVector xSun = t_astro::Sun(satData->tt.mjd());
+    xSun /= xSun.norm_Frobenius();
+
+    // Satellite unit vectors sz, sy, sx
+    ColumnVector sz = -satData->xx / satData->xx.norm_Frobenius();
+    ColumnVector sy = crossproduct(sz, xSun);
+    ColumnVector sx = crossproduct(sy, sz);
+
+    sx /= sx.norm_Frobenius();
+    sy /= sy.norm_Frobenius();
+
+    // LOS vector in satellite frame
+    ColumnVector u(3);
+    u(1) = dotproduct(sx, rho);
+    u(2) = dotproduct(sy, rho);
+    u(3) = dotproduct(sz, rho);
+
+    // Azimuth and elevation in satellite antenna frame
+    elTx = atan2(u(3),sqrt(pow(u(2),2)+pow(u(1),2)));
+    azTx = atan2(u(2),u(1));
+
     bool found;
-    phaseCenter = satData->lkA * _antex->rcvCorr(OPT->_antNameRover, frqA,
-                                                 satData->eleSat, satData->azSat,
-                                                 found)
-                + satData->lkB * _antex->rcvCorr(OPT->_antNameRover, frqB,
-                                                 satData->eleSat, satData->azSat,
-                                                 found);
+    if (OPT->_isAPC) {
+      phaseCenter += satData->lkB * _antex->satCorr(satData->prn, frqA, elTx, azTx, found);
+    }
+    else {
+      phaseCenter += satData->lkA * _antex->satCorr(satData->prn, frqA, elTx, azTx, found);
+    }
     if (!found) {
-      LOG << "ANTEX: antenna >" << OPT->_antNameRover << "< not found\n";
+      LOG << "ANTEX: antenna >" << satData->prn.mid(0,3).toStdString() << " " << frqA << "< not found\n";
+    }
+
+    phaseCenter += satData->lkB * _antex->satCorr(satData->prn, frqB, elTx, azTx, found);
+    if (!found) {
+      LOG << "ANTEX: antenna >" << satData->prn.mid(0,3).toStdString() << " " << frqB << "< not found\n";
+    }
+
+                /*
+    LOG << "ANTEX: " << satData->prn.mid(0,3).toStdString() << " "
+        << fixed
+        << setprecision(3)
+        << " xyz "
+        << setw(7) << u(1)
+        << setw(7) << u(2)
+        << setw(7) << u(3)
+        << setprecision(1)
+        << " elTx " << setw(5) << elTx * 180.0/M_PI
+        << " azTx " << setw(7) << azTx * 180.0/M_PI
+        << " elRx " << setw(5) << satData->eleSat * 180.0/M_PI
+        << setprecision(3)
+        << " pcc " << setw(6) << phaseCenter
+        << endl;
+                */
+
+    // Receiver correction
+    // -------------------
+
+    phaseCenter += satData->lkA * _antex->rcvCorr(OPT->_antNameRover, frqA,
+                                                  satData->eleSat, satData->azSat, found);
+    if (!found) {
+      phaseCenter += satData->lkA * _antex->rcvCorr(OPT->_antNameRover, t_frequency::G1,
+                                                    satData->eleSat, satData->azSat, found);
+    }
+    if (!found) {
+      LOG << "ANTEX: antenna >" << OPT->_antNameRover << " " << frqA << "< not found\n";
+    }
+
+    phaseCenter += satData->lkB * _antex->rcvCorr(OPT->_antNameRover, frqB,
+                                                  satData->eleSat, satData->azSat, found);
+    if (!found) {
+      phaseCenter += satData->lkB * _antex->rcvCorr(OPT->_antNameRover, t_frequency::G2,
+                                                    satData->eleSat, satData->azSat, found);
+    }
+    if (!found) {
+      LOG << "ANTEX: antenna >" << OPT->_antNameRover << " " << frqB << "< not found\n";
     }
   }
@@ -1022 +1098 @@
           << " RES " << satData->prn.mid(0,3).toAscii().data()
           << (iPhase ? "   L3 " : "   P3 ")
-          << setw(9) << setprecision(4) << vv(satData->obsIndex) << endl;
+          << setw(9) << setprecision(4) << vv(satData->obsIndex) << " "
+          /*
+          << setprecision(3)
+          << setw(7) << (iPhase? satData->L3sig : satData->P3sig) << " "
+          << setprecision(1)
+          << setw(5) <<satData->eleSat * 180 / M_PI
+          */
+          << endl;
     }
   }