gnss-js 1.27.0 → 1.29.0

package/dist/chunk-4KMWWCUR.js

@@ -0,0 +1,120 @@
+// src/rinex/sp3.ts
+var BAD_CLOCK = 999999.999999;
+function parseSp3(text) {
+  const lines = text.split("\n");
+  const epochs = [];
+  const satellites = {};
+  let version = "";
+  let intervalSec = 0;
+  let timeSystem = "GPS";
+  let timeSystemSet = false;
+  let epochIdx = -1;
+  for (const line of lines) {
+    if (!version && line.startsWith("#") && line.charAt(1) !== "#") {
+      version = line.charAt(1);
+    }
+    if (line.startsWith("##")) {
+      const f = line.slice(2).trim().split(/\s+/);
+      intervalSec = Number(f[2]) || 0;
+    } else if (line.startsWith("%c") && !timeSystemSet) {
+      const sys = line.slice(9, 12).trim();
+      if (sys && !/^c+$/.test(sys)) {
+        timeSystem = sys;
+        timeSystemSet = true;
+      }
+    } else if (line.startsWith("*")) {
+      const f = line.slice(1).trim().split(/\s+/).map(Number);
+      if (f.length >= 6 && f.every(Number.isFinite)) {
+        const sec = f[5];
+        epochs.push(
+          Date.UTC(
+            f[0],
+            f[1] - 1,
+            f[2],
+            f[3],
+            f[4],
+            Math.floor(sec),
+            Math.round(sec % 1 * 1e3)
+          )
+        );
+        epochIdx++;
+      }
+    } else if (line.startsWith("P") && epochIdx >= 0) {
+      const prn = line.slice(1, 4).replace(/\s/g, "0");
+      const f = line.slice(4).trim().split(/\s+/).map(Number);
+      if (f.length < 3) continue;
+      const [xKm, yKm, zKm] = f;
+      let arr = satellites[prn];
+      if (!arr) satellites[prn] = arr = [];
+      while (arr.length < epochIdx) arr.push(null);
+      if (xKm === 0 && yKm === 0 && zKm === 0) {
+        arr.push(null);
+        continue;
+      }
+      const clkUs = f[3];
+      arr.push({
+        x: xKm * 1e3,
+        y: yKm * 1e3,
+        z: zKm * 1e3,
+        clk: clkUs !== void 0 && Math.abs(clkUs) < BAD_CLOCK ? clkUs * 1e-6 : null
+      });
+    }
+  }
+  for (const arr of Object.values(satellites)) {
+    while (arr.length < epochs.length) arr.push(null);
+  }
+  return { version, epochs, intervalSec, timeSystem, satellites };
+}
+function sp3Position(sp3, prn, tMs, order = 9) {
+  const samples = sp3.satellites[prn];
+  const { epochs } = sp3;
+  const n = epochs.length;
+  if (!samples || n < order) return null;
+  if (tMs < epochs[0] || tMs > epochs[n - 1]) return null;
+  let lo = 0;
+  let hi = n - 1;
+  while (lo < hi) {
+    const mid = lo + hi + 1 >> 1;
+    if (epochs[mid] <= tMs) lo = mid;
+    else hi = mid - 1;
+  }
+  let start = lo - (order >> 1) + (order % 2 === 0 ? 1 : 0);
+  start = Math.max(0, Math.min(n - order, start));
+  for (let i = start; i < start + order; i++) {
+    if (!samples[i]) return null;
+  }
+  const t0 = epochs[start];
+  const t = (tMs - t0) / 1e3;
+  let x = 0;
+  let y = 0;
+  let z = 0;
+  for (let i = 0; i < order; i++) {
+    const ti = (epochs[start + i] - t0) / 1e3;
+    let w = 1;
+    for (let j = 0; j < order; j++) {
+      if (j === i) continue;
+      const tj = (epochs[start + j] - t0) / 1e3;
+      w *= (t - tj) / (ti - tj);
+    }
+    const s = samples[start + i];
+    x += w * s.x;
+    y += w * s.y;
+    z += w * s.z;
+  }
+  let clk = null;
+  const a = samples[lo];
+  const b = samples[Math.min(lo + 1, n - 1)];
+  if (a?.clk != null && b?.clk != null) {
+    const span = epochs[Math.min(lo + 1, n - 1)] - epochs[lo];
+    const f = span > 0 ? (tMs - epochs[lo]) / span : 0;
+    clk = a.clk * (1 - f) + b.clk * f;
+  } else if (a?.clk != null) {
+    clk = a.clk;
+  }
+  return { x, y, z, clk };
+}
+
+export {
+  parseSp3,
+  sp3Position
+};