gnss-js 1.24.0 → 1.26.0

package/dist/chunk-IQ5OIMQD.js

@@ -0,0 +1,148 @@
+// src/navbits/index.ts
+var GPS_PI = 3.1415926535898;
+var GPS_EPOCH_MS = Date.UTC(1980, 0, 6);
+var SEC_PER_WEEK = 7 * 86400;
+function getBitU(buff, pos, len) {
+  let bits = 0;
+  for (let i = pos; i < pos + len; i++) {
+    bits = bits * 2 + (buff[i >> 3] >> 7 - (i & 7) & 1);
+  }
+  return bits;
+}
+function getBitS(buff, pos, len) {
+  const bits = getBitU(buff, pos, len);
+  if (len <= 0 || bits < 2 ** (len - 1)) return bits;
+  return bits - 2 ** len;
+}
+function setBitU(buff, pos, len, data) {
+  let mask = 2 ** (len - 1);
+  for (let i = pos; i < pos + len; i++, mask /= 2) {
+    if (data >= mask) {
+      buff[i >> 3] |= 1 << 7 - (i & 7);
+      data -= mask;
+    } else {
+      buff[i >> 3] &= ~(1 << 7 - (i & 7));
+    }
+  }
+}
+function decodeGpsLnavFrame(subframes, opts = {}) {
+  if (subframes.length < 90) return null;
+  const b = subframes;
+  let i = 24;
+  const tow1 = getBitU(b, i, 17) * 6;
+  i += 17 + 2;
+  const id1 = getBitU(b, i, 3);
+  i += 3 + 2;
+  const week10 = getBitU(b, i, 10);
+  i += 10;
+  i += 2;
+  i += 4;
+  const svHealth = getBitU(b, i, 6);
+  i += 6;
+  const iodc0 = getBitU(b, i, 2);
+  i += 2;
+  i += 1 + 87;
+  const tgdRaw = getBitS(b, i, 8);
+  i += 8;
+  const iodc1 = getBitU(b, i, 8);
+  i += 8;
+  const tocSec = getBitU(b, i, 16) * 16;
+  i += 16;
+  const af2 = getBitS(b, i, 8) * 2 ** -55;
+  i += 8;
+  const af1 = getBitS(b, i, 16) * 2 ** -43;
+  i += 16;
+  const af0 = getBitS(b, i, 22) * 2 ** -31;
+  i = 240 + 24;
+  i += 17 + 2;
+  const id2 = getBitU(b, i, 3);
+  i += 3 + 2;
+  const iode = getBitU(b, i, 8);
+  i += 8;
+  const crs = getBitS(b, i, 16) * 2 ** -5;
+  i += 16;
+  const deltaN = getBitS(b, i, 16) * 2 ** -43 * GPS_PI;
+  i += 16;
+  const m0 = getBitS(b, i, 32) * 2 ** -31 * GPS_PI;
+  i += 32;
+  const cuc = getBitS(b, i, 16) * 2 ** -29;
+  i += 16;
+  const e = getBitU(b, i, 32) * 2 ** -33;
+  i += 32;
+  const cus = getBitS(b, i, 16) * 2 ** -29;
+  i += 16;
+  const sqrtA = getBitU(b, i, 32) * 2 ** -19;
+  i += 32;
+  const toes = getBitU(b, i, 16) * 16;
+  i = 480 + 24;
+  i += 17 + 2;
+  const id3 = getBitU(b, i, 3);
+  i += 3 + 2;
+  const cic = getBitS(b, i, 16) * 2 ** -29;
+  i += 16;
+  const omega0 = getBitS(b, i, 32) * 2 ** -31 * GPS_PI;
+  i += 32;
+  const cis = getBitS(b, i, 16) * 2 ** -29;
+  i += 16;
+  const i0 = getBitS(b, i, 32) * 2 ** -31 * GPS_PI;
+  i += 32;
+  const crc = getBitS(b, i, 16) * 2 ** -5;
+  i += 16;
+  const omega = getBitS(b, i, 32) * 2 ** -31 * GPS_PI;
+  i += 32;
+  const omegaDot = getBitS(b, i, 24) * 2 ** -43 * GPS_PI;
+  i += 24;
+  const iode3 = getBitU(b, i, 8);
+  i += 8;
+  const idot = getBitS(b, i, 14) * 2 ** -43 * GPS_PI;
+  const iodc = iodc0 * 256 + iodc1;
+  if (id1 !== 1 || id2 !== 2 || id3 !== 3) return null;
+  if (iode3 !== iode || iode !== (iodc & 255)) return null;
+  const ref = opts.refWeek ?? Math.floor((Date.now() - GPS_EPOCH_MS) / 1e3 / SEC_PER_WEEK);
+  let week = week10 + 1024 * Math.round((ref - week10) / 1024);
+  if (toes < tow1 - 302400) week++;
+  else if (toes > tow1 + 302400) week--;
+  const prn = opts.prn ?? "G00";
+  const tocDate = new Date(
+    GPS_EPOCH_MS + (week * SEC_PER_WEEK + tocSec) * 1e3
+  );
+  return {
+    system: prn[0] === "J" ? "J" : "G",
+    prn,
+    tocDate,
+    // Same seconds-of-week convention as parseNavFile (rinex/nav.ts).
+    toc: tocDate.getTime() / 1e3 % SEC_PER_WEEK,
+    af0,
+    af1,
+    af2,
+    iode,
+    crs,
+    deltaN,
+    m0,
+    cuc,
+    e,
+    cus,
+    sqrtA,
+    toe: toes,
+    cic,
+    omega0,
+    cis,
+    i0,
+    crc,
+    omega,
+    omegaDot,
+    idot,
+    week,
+    svHealth,
+    tgd: tgdRaw === -128 ? 0 : tgdRaw * 2 ** -31
+    // IS-GPS-200: -128 reserved
+  };
+}
+
+export {
+  GPS_PI,
+  getBitU,
+  getBitS,
+  setBitU,
+  decodeGpsLnavFrame
+};