gnss-js 2.11.0 → 2.12.0

package/dist/chunk-TWGZTRBL.js

@@ -0,0 +1,323 @@
+import {
+  crc24q
+} from "./chunk-HUXQABJI.js";
+import {
+  GPS_PI,
+  getBitS,
+  getBitU
+} from "./chunk-V2D5KUKH.js";
+
+// src/navbits/gal.ts
+var GPS_EPOCH_MS = Date.UTC(1980, 0, 6);
+var SEC_PER_WEEK = 7 * 86400;
+var HALF_WEEK = 302400;
+var GST_GPS_WEEK_OFFSET = 1024;
+function galInavPageCrcOk(page) {
+  if (page.length < 28) return false;
+  return crc24q(page, 196) === getBitU(page, 196, 24);
+}
+function galFnavPageCrcOk(page) {
+  if (page.length < 30) return false;
+  return crc24q(page, 214) === getBitU(page, 214, 24);
+}
+function gpsDate(week, sec) {
+  return new Date(GPS_EPOCH_MS + (week * SEC_PER_WEEK + sec) * 1e3);
+}
+function weekOfToe(week, tow, toe) {
+  if (toe - tow > HALF_WEEK) return week - 1;
+  if (toe - tow < -HALF_WEEK) return week + 1;
+  return week;
+}
+var two = (n) => String(n).padStart(2, "0");
+function decodeGalInavWords(words) {
+  if (words.length < 96) return null;
+  const b = words;
+  let i = 128;
+  const type1 = getBitU(b, i, 6);
+  i += 6;
+  const iodNav1 = getBitU(b, i, 10);
+  i += 10;
+  const toes = getBitU(b, i, 14) * 60;
+  i += 14;
+  const m0 = getBitS(b, i, 32) * 2 ** -31 * GPS_PI;
+  i += 32;
+  const e = getBitU(b, i, 32) * 2 ** -33;
+  i += 32;
+  const sqrtA = getBitU(b, i, 32) * 2 ** -19;
+  i = 128 * 2;
+  const type2 = getBitU(b, i, 6);
+  i += 6;
+  const iodNav2 = getBitU(b, i, 10);
+  i += 10;
+  const omega0 = getBitS(b, i, 32) * 2 ** -31 * GPS_PI;
+  i += 32;
+  const i0 = getBitS(b, i, 32) * 2 ** -31 * GPS_PI;
+  i += 32;
+  const omega = getBitS(b, i, 32) * 2 ** -31 * GPS_PI;
+  i += 32;
+  const idot = getBitS(b, i, 14) * 2 ** -43 * GPS_PI;
+  i = 128 * 3;
+  const type3 = getBitU(b, i, 6);
+  i += 6;
+  const iodNav3 = getBitU(b, i, 10);
+  i += 10;
+  const omegaDot = getBitS(b, i, 24) * 2 ** -43 * GPS_PI;
+  i += 24;
+  const deltaN = getBitS(b, i, 16) * 2 ** -43 * GPS_PI;
+  i += 16;
+  const cuc = getBitS(b, i, 16) * 2 ** -29;
+  i += 16;
+  const cus = getBitS(b, i, 16) * 2 ** -29;
+  i += 16;
+  const crc = getBitS(b, i, 16) * 2 ** -5;
+  i += 16;
+  const crs = getBitS(b, i, 16) * 2 ** -5;
+  i = 128 * 4;
+  const type4 = getBitU(b, i, 6);
+  i += 6;
+  const iodNav4 = getBitU(b, i, 10);
+  i += 10;
+  const svid = getBitU(b, i, 6);
+  i += 6;
+  const cic = getBitS(b, i, 16) * 2 ** -29;
+  i += 16;
+  const cis = getBitS(b, i, 16) * 2 ** -29;
+  i += 16;
+  const tocs = getBitU(b, i, 14) * 60;
+  i += 14;
+  const af0 = getBitS(b, i, 31) * 2 ** -34;
+  i += 31;
+  const af1 = getBitS(b, i, 21) * 2 ** -46;
+  i += 21;
+  const af2 = getBitS(b, i, 6) * 2 ** -59;
+  i = 128 * 5;
+  const type5 = getBitU(b, i, 6);
+  i += 6 + 11 + 11 + 14 + 5;
+  const bgdE5a = getBitS(b, i, 10) * 2 ** -32;
+  i += 10;
+  i += 10;
+  const e5bHs = getBitU(b, i, 2);
+  i += 2;
+  const e1bHs = getBitU(b, i, 2);
+  i += 2;
+  const e5bDvs = getBitU(b, i, 1);
+  i += 1;
+  const e1bDvs = getBitU(b, i, 1);
+  i += 1;
+  const gstWeek = getBitU(b, i, 12);
+  i += 12;
+  const tow = getBitU(b, i, 20);
+  if (type1 !== 1 || type2 !== 2 || type3 !== 3 || type4 !== 4 || type5 !== 5)
+    return null;
+  if (iodNav1 !== iodNav2 || iodNav1 !== iodNav3 || iodNav1 !== iodNav4)
+    return null;
+  if (svid < 1 || svid > 36) return null;
+  const week = weekOfToe(gstWeek, tow, toes) + GST_GPS_WEEK_OFFSET;
+  const tocDate = gpsDate(week, tocs);
+  return {
+    system: "E",
+    prn: `E${two(svid)}`,
+    toc: tocDate.getTime() / 1e3 % SEC_PER_WEEK,
+    tocDate,
+    af0,
+    af1,
+    af2,
+    iode: iodNav1,
+    crs,
+    deltaN,
+    m0,
+    cuc,
+    e,
+    cus,
+    sqrtA,
+    toe: toes,
+    cic,
+    omega0,
+    cis,
+    i0,
+    crc,
+    omega,
+    omegaDot,
+    idot,
+    week,
+    svHealth: e5bHs << 7 | e5bDvs << 6 | e1bHs << 1 | e1bDvs,
+    tgd: bgdE5a
+  };
+}
+function decodeGalFnavPages(pages) {
+  if (pages.length < 124) return null;
+  const b = pages;
+  let i = 0;
+  const type1 = getBitU(b, i, 6);
+  i += 6;
+  const svid = getBitU(b, i, 6);
+  i += 6;
+  const iodNav1 = getBitU(b, i, 10);
+  i += 10;
+  const tocs = getBitU(b, i, 14) * 60;
+  i += 14;
+  const af0 = getBitS(b, i, 31) * 2 ** -34;
+  i += 31;
+  const af1 = getBitS(b, i, 21) * 2 ** -46;
+  i += 21;
+  const af2 = getBitS(b, i, 6) * 2 ** -59;
+  i += 6;
+  i += 8 + 11 + 11 + 14 + 5;
+  const bgdE5a = getBitS(b, i, 10) * 2 ** -32;
+  i += 10;
+  const e5aHs = getBitU(b, i, 2);
+  i += 2;
+  const gstWeek = getBitU(b, i, 12);
+  i += 12;
+  const tow = getBitU(b, i, 20);
+  i += 20;
+  const e5aDvs = getBitU(b, i, 1);
+  i = 31 * 8;
+  const type2 = getBitU(b, i, 6);
+  i += 6;
+  const iodNav2 = getBitU(b, i, 10);
+  i += 10;
+  const m0 = getBitS(b, i, 32) * 2 ** -31 * GPS_PI;
+  i += 32;
+  const omegaDot = getBitS(b, i, 24) * 2 ** -43 * GPS_PI;
+  i += 24;
+  const e = getBitU(b, i, 32) * 2 ** -33;
+  i += 32;
+  const sqrtA = getBitU(b, i, 32) * 2 ** -19;
+  i += 32;
+  const omega0 = getBitS(b, i, 32) * 2 ** -31 * GPS_PI;
+  i += 32;
+  const idot = getBitS(b, i, 14) * 2 ** -43 * GPS_PI;
+  i = 62 * 8;
+  const type3 = getBitU(b, i, 6);
+  i += 6;
+  const iodNav3 = getBitU(b, i, 10);
+  i += 10;
+  const i0 = getBitS(b, i, 32) * 2 ** -31 * GPS_PI;
+  i += 32;
+  const omega = getBitS(b, i, 32) * 2 ** -31 * GPS_PI;
+  i += 32;
+  const deltaN = getBitS(b, i, 16) * 2 ** -43 * GPS_PI;
+  i += 16;
+  const cuc = getBitS(b, i, 16) * 2 ** -29;
+  i += 16;
+  const cus = getBitS(b, i, 16) * 2 ** -29;
+  i += 16;
+  const crc = getBitS(b, i, 16) * 2 ** -5;
+  i += 16;
+  const crs = getBitS(b, i, 16) * 2 ** -5;
+  i += 16;
+  const toes = getBitU(b, i, 14) * 60;
+  i = 93 * 8;
+  const type4 = getBitU(b, i, 6);
+  i += 6;
+  const iodNav4 = getBitU(b, i, 10);
+  i += 10;
+  const cic = getBitS(b, i, 16) * 2 ** -29;
+  i += 16;
+  const cis = getBitS(b, i, 16) * 2 ** -29;
+  if (type1 !== 1 || type2 !== 2 || type3 !== 3 || type4 !== 4) return null;
+  if (iodNav1 !== iodNav2 || iodNav1 !== iodNav3 || iodNav1 !== iodNav4)
+    return null;
+  if (svid < 1 || svid > 36) return null;
+  const week = weekOfToe(gstWeek, tow, toes) + GST_GPS_WEEK_OFFSET;
+  const tocDate = gpsDate(week, tocs);
+  return {
+    system: "E",
+    prn: `E${two(svid)}`,
+    toc: tocDate.getTime() / 1e3 % SEC_PER_WEEK,
+    tocDate,
+    af0,
+    af1,
+    af2,
+    iode: iodNav1,
+    crs,
+    deltaN,
+    m0,
+    cuc,
+    e,
+    cus,
+    sqrtA,
+    toe: toes,
+    cic,
+    omega0,
+    cis,
+    i0,
+    crc,
+    omega,
+    omegaDot,
+    idot,
+    week,
+    svHealth: e5aHs << 4 | e5aDvs << 3,
+    tgd: bgdE5a
+  };
+}
+var dedupKey = (eph) => `${eph.iode}:${eph.toe}:${eph.tocDate.getTime()}`;
+var GalInavAssembler = class {
+  sats = /* @__PURE__ */ new Map();
+  /**
+   * Push one I/NAV page pair for satellite `prn` (1-36): the 234-bit
+   * even+odd concatenation, even part first with its 6 tail bits
+   * removed, bit 0 = the even part's Even/Odd bit (≥ 17 bytes).
+   * Returns the newly completed ephemeris, or null. Pages that are
+   * not an even/odd nominal pair, alert pages and word types outside
+   * 1-5 are ignored.
+   */
+  push(prn, page) {
+    if (prn < 1 || prn > 36 || page.length < 17) return null;
+    if (getBitU(page, 0, 1) !== 0 || getBitU(page, 114, 1) !== 1) return null;
+    if (getBitU(page, 1, 1) === 1 || getBitU(page, 115, 1) === 1) return null;
+    const type = getBitU(page, 2, 6);
+    if (type < 1 || type > 5) return null;
+    let sat = this.sats.get(prn);
+    if (!sat) {
+      sat = { words: new Uint8Array(96) };
+      this.sats.set(prn, sat);
+    }
+    for (let k = 0; k < 14; k++)
+      sat.words[type * 16 + k] = getBitU(page, 2 + 8 * k, 8);
+    sat.words[type * 16 + 14] = getBitU(page, 116, 8);
+    sat.words[type * 16 + 15] = getBitU(page, 124, 8);
+    if (type !== 5) return null;
+    const eph = decodeGalInavWords(sat.words);
+    if (!eph || eph.prn !== `E${two(prn)}`) return null;
+    const key = dedupKey(eph);
+    if (key === sat.lastKey) return null;
+    sat.lastKey = key;
+    return eph;
+  }
+};
+var GalFnavAssembler = class {
+  sats = /* @__PURE__ */ new Map();
+  /**
+   * Push one F/NAV page for satellite `prn` (1-36): 244 bits with the
+   * sync field stripped, bit 0 = first page-type bit (≥ 31 bytes).
+   * Returns the newly completed ephemeris, or null. Dummy pages
+   * (type 63) and page types outside 1-4 are ignored.
+   */
+  push(prn, page) {
+    if (prn < 1 || prn > 36 || page.length < 31) return null;
+    const type = getBitU(page, 0, 6);
+    if (type < 1 || type > 4) return null;
+    let sat = this.sats.get(prn);
+    if (!sat) {
+      sat = { words: new Uint8Array(124) };
+      this.sats.set(prn, sat);
+    }
+    sat.words.set(page.subarray(0, 31), (type - 1) * 31);
+    if (type !== 4) return null;
+    const eph = decodeGalFnavPages(sat.words);
+    if (!eph || eph.prn !== `E${two(prn)}`) return null;
+    const key = dedupKey(eph);
+    if (key === sat.lastKey) return null;
+    sat.lastKey = key;
+    return eph;
+  }
+};
+
+export {
+  galInavPageCrcOk,
+  galFnavPageCrcOk,
+  GalInavAssembler,
+  GalFnavAssembler
+};