Changeset 9474 in ntrip for branches/BNC_2.12/src/bncantex.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/bncantex.cpp (modified) (2 diffs)

branches/BNC_2.12/src/bncantex.cpp

@@ -196 +196 @@
       }
 
-     // End of Frequency
+      // End of Frequency
       // ----------------
       else if (line.indexOf("END OF FREQUENCY") == 60) {
@@ -351 +351 @@
 
   return failure;
+}
+
+//
+////////////////////////////////////////////////////////////////////////////
+double bncAntex::satCorr(const QString& prn, t_frequency::type frqType,
+                         double elTx, double azTx, bool& found) const {
+
+  if (_maps.find(prn.mid(0,3)) == _maps.end()) {
+    found = false;
+    return 0.0;
+  };
+
+  t_antMap* map = _maps[prn.mid(0,3)];
+
+  if (map->frqMap.find(frqType) == map->frqMap.end()) {
+    found = false;
+    return 0.0;
+  };
+
+  t_frqMap* frqMap = map->frqMap[frqType];
+
+  double var = 0.0;
+  if (frqMap->pattern.ncols() > 0) {
+    double zenDiff = 999.999;
+    double zenTx  = 90.0 - elTx * 180.0 / M_PI;
+    unsigned iZen = 0;
+    for (double zen = map->zen1; zen <= map->zen2; zen += map->dZen) {
+      iZen += 1;
+      double newZenDiff = fabs(zen - zenTx);
+      if (newZenDiff < zenDiff) {
+        zenDiff = newZenDiff;
+        var = frqMap->pattern(iZen);
+      }
+    }
+  }
+
+  found = true;
+  return var - frqMap->neu[0] * cos(azTx)*cos(elTx)
+             - frqMap->neu[1] * sin(azTx)*cos(elTx)
+             - frqMap->neu[2] * sin(elTx);
+
 }