Changeset 9481 in ntrip for trunk/BNC/src/bncantex.cpp

Timestamp:

Jul 19, 2021, 10:46:16 PM (3 years ago)

Author:

stuerze

Message:

minor changes

File:

• trunk/BNC/src/bncantex.cpp (modified) (2 diffs)

trunk/BNC/src/bncantex.cpp

@@ -321 +321 @@
     frqType = t_frequency::R1;
   }
+  else if (prn[0] == 'E') {
+    frqType = t_frequency::E1;
+  }
+  else if (prn[0] == 'C') {
+    frqType = t_frequency::C2;
+  }
+  else if (prn[0] == 'S') {
+    frqType = t_frequency::S1;
+  }
+  else if (prn[0] == 'J') {
+    frqType = t_frequency::J1;
+  }
+  else if (prn[0] == 'I') {
+    frqType = t_frequency::I5;
+  }
 
   QMap<QString, t_antMap*>::const_iterator it = _maps.find(prn.mid(0,3));
@@ -351 +366 @@
 
   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);
+
 }