gnss-js 1.18.0 → 1.20.0

package/dist/{chunk-HXF7XVW7.js → chunk-NOQAAUGY.js}

@@ -1,3 +1,9 @@
+import {
+  CNAV_A_REF,
+  CNAV_OMEGA_DOT_REF,
+  GPS_PI
+} from "./chunk-WZDFZ76K.js";
+
 // src/rinex/format.ts
 function padL(s, w) {
   return s.length >= w ? s.slice(0, w) : s + " ".repeat(w - s.length);
@@ -212,19 +218,19 @@ var R4_MSG_LINES = {
   SBAS: 4,
   FDMA: 5,
   // RINEX 4 adds orbit-4 (status flags) vs 3 in RINEX 3
-  // EPH types we skip (different field layout)
+  // EPH type parsed into RinexCnavEphemeris for G/J (skipped otherwise)
   CNAV: 9,
+  // EPH types we skip (different field layout)
   CNV1: 10,
   CNV2: 10,
   CNV3: 9,
   L1NV: 8,
   L1OC: 9,
-  L3OC: 9,
-  // Non-EPH records
-  STO: 2,
-  EOP: 3,
-  ION: 3
+  L3OC: 9
 };
+var GPS_EPOCH_MS = Date.UTC(1980, 0, 6);
+var SEC_PER_WEEK = 7 * 86400;
+var QZSS_CNAV_A_REF = 42164200;
 var SUPPORTED_EPH_MSGS = /* @__PURE__ */ new Set([
   "LNAV",
   "INAV",
@@ -288,6 +294,20 @@ function parseDataLine(line, colOffset = 4) {
   }
   return values;
 }
+function parseDataLineSlots(line) {
+  const values = [];
+  for (let i = 0; i < 4; i++) {
+    const start = 4 + i * 19;
+    const s = start < line.length ? line.substring(start, start + 19).trim() : "";
+    if (s.length === 0) {
+      values.push(null);
+      continue;
+    }
+    const v = parseFloat19(s);
+    values.push(Number.isFinite(v) ? v : null);
+  }
+  return values;
+}
 function buildKeplerEphemeris(sys, prn, date, epochVals, data) {
   const d = [];
   for (const line of data) {
@@ -350,6 +370,68 @@ function buildStateVectorEphemeris(sys, prn, date, epochVals, data) {
     zAcc: d[10] ?? 0
   };
 }
+function buildCnavEphemeris(sys, prn, date, epochVals, d) {
+  const num = (r, c) => d[r]?.[c] ?? 0;
+  const opt = (r, c) => d[r]?.[c] ?? null;
+  const t = (date.getTime() - GPS_EPOCH_MS) / 1e3;
+  const week = Math.floor(t / SEC_PER_WEEK);
+  const toc = t - week * SEC_PER_WEEK;
+  const sqrtA = num(1, 3);
+  const a = sqrtA * sqrtA;
+  const aRef = sys === "J" ? QZSS_CNAV_A_REF : CNAV_A_REF;
+  const omegaDot = num(3, 3);
+  const wnOp = d[7]?.[1];
+  return {
+    system: sys,
+    prn,
+    week,
+    health: num(5, 1),
+    uraEd: num(5, 0),
+    uraNed0: num(4, 2),
+    uraNed1: num(4, 3),
+    uraNed2: num(5, 3),
+    top: num(2, 0),
+    toe: toc,
+    toeDate: date,
+    a,
+    deltaA: a - aRef,
+    aDot: num(0, 0),
+    deltaN0: num(0, 2),
+    deltaN0Dot: num(4, 1),
+    m0: num(0, 3),
+    e: num(1, 1),
+    omega: num(3, 2),
+    omega0: num(2, 2),
+    i0: num(3, 0),
+    omegaDot,
+    deltaOmegaDot: omegaDot - CNAV_OMEGA_DOT_REF * GPS_PI,
+    i0Dot: num(4, 0),
+    cis: num(2, 3),
+    cic: num(2, 1),
+    crs: num(0, 1),
+    crc: num(3, 1),
+    cus: num(1, 2),
+    cuc: num(1, 0),
+    toc,
+    tocDate: date,
+    af0: epochVals[0] ?? 0,
+    af1: epochVals[1] ?? 0,
+    af2: epochVals[2] ?? 0,
+    clockMsgType: 0,
+    // not recorded in RINEX
+    tgd: opt(5, 2),
+    iscL1ca: opt(6, 0),
+    iscL2c: opt(6, 1),
+    iscL5i5: opt(6, 2),
+    iscL5q5: opt(6, 3),
+    ...wnOp != null && { wnOp },
+    integrityFlag: false,
+    // not recorded in RINEX
+    l2cPhasing: false,
+    // not recorded in RINEX
+    tow: num(7, 0)
+  };
+}
 function parseNavFile(text) {
   const lines = text.split("\n");
   const header = {
@@ -359,6 +441,7 @@ function parseNavFile(text) {
     ionoCorrections: {}
   };
   const ephemerides = [];
+  const cnav = [];
   let inHeader = true;
   let i = 0;
   while (i < lines.length) {
@@ -419,8 +502,15 @@ function parseNavFile(text) {
     if (isV4 && line.charAt(0) === ">") {
       const parts = line.substring(2).trim().split(/\s+/);
       const recType = parts[0] ?? "";
+      const svSys = (parts[1] ?? "").charAt(0);
       const msgType = parts[2] ?? recType;
-      if (recType !== "EPH" || !SUPPORTED_EPH_MSGS.has(msgType)) {
+      if (recType !== "EPH") {
+        const totalLines = recType === "STO" ? 2 : recType === "EOP" ? 3 : recType === "ION" ? svSys === "E" ? 2 : 3 : 2;
+        i += totalLines + 1;
+        continue;
+      }
+      const isCnav = msgType === "CNAV" && (svSys === "G" || svSys === "J");
+      if (!SUPPORTED_EPH_MSGS.has(msgType) && !isCnav) {
         const totalLines = R4_MSG_LINES[msgType] ?? 2;
         i += totalLines + 1;
         continue;
@@ -432,6 +522,21 @@ function parseNavFile(text) {
       const sys2 = epochLine.charAt(0);
       const parsed = parseNavEpochV3(epochLine);
       const prn2 = `${sys2}${parsed.prn.substring(1)}`;
+      if (isCnav) {
+        const slotLines = [];
+        for (let j = 0; j < numDataLines2; j++) {
+          i++;
+          if (i >= lines.length) break;
+          slotLines.push(parseDataLineSlots(lines[i]));
+        }
+        if (slotLines.length === numDataLines2 && (sys2 === "G" || sys2 === "J")) {
+          cnav.push(
+            buildCnavEphemeris(sys2, prn2, parsed.date, parsed.values, slotLines)
+          );
+        }
+        i++;
+        continue;
+      }
       const dataLines2 = [];
       for (let j = 0; j < numDataLines2; j++) {
         i++;
@@ -505,7 +610,7 @@ function parseNavFile(text) {
     }
     i++;
   }
-  return { header, ephemerides };
+  return cnav.length > 0 ? { header, ephemerides, cnav } : { header, ephemerides };
 }
 
 // src/rinex/nav-writer.ts
@@ -513,9 +618,13 @@ function fmtD(val) {
   if (val === 0) return " 0.000000000000E+00";
   const sign = val < 0 ? "-" : " ";
   const abs = Math.abs(val);
-  const exp = Math.floor(Math.log10(abs));
+  let exp = Math.floor(Math.log10(abs));
   const mantissa = abs / 10 ** exp;
-  const mStr = mantissa.toFixed(12);
+  let mStr = mantissa.toFixed(12);
+  if (mStr.length > 14) {
+    exp += 1;
+    mStr = (mantissa / 10).toFixed(12);
+  }
   const expSign = exp >= 0 ? "+" : "-";
   const expStr = String(Math.abs(exp)).padStart(2, "0");
   return `${sign}${mStr}E${expSign}${expStr}`;
@@ -590,7 +699,7 @@ function writeKeplerRecord(eph) {
 function writeGlonassRecord(eph) {
   const lines = [];
   lines.push(
-    `${padL(eph.prn, 3)} ${fmtEpoch(eph.tocDate)}${fmtD(-eph.tauN)}${fmtD(eph.gammaN)}${fmtD(eph.messageFrameTime)}`
+    `${padL(eph.prn, 3)} ${fmtEpoch(eph.tocDate)}${fmtD(eph.tauN)}${fmtD(eph.gammaN)}${fmtD(eph.messageFrameTime)}`
   );
   lines.push(orbitLine([eph.x, eph.xDot, eph.xAcc, eph.health]));
   lines.push(orbitLine([eph.y, eph.yDot, eph.yAcc, eph.freqNum]));
@@ -610,6 +719,181 @@ function writeRinexNav(nav) {
   return header + records.join("\n") + "\n";
 }
 
+// src/rinex/nav-writer-v4.ts
+var BLANK19 = " ".repeat(19);
+function fmtEpoch4(d) {
+  const p2 = (v) => String(v).padStart(2, "0");
+  return `${d.getUTCFullYear()} ${p2(d.getUTCMonth() + 1)} ${p2(d.getUTCDate())} ${p2(d.getUTCHours())} ${p2(d.getUTCMinutes())} ${p2(d.getUTCSeconds())}`;
+}
+function orbitLine4(values) {
+  const line = "    " + values.map((v) => v == null ? BLANK19 : fmtD(v)).join("");
+  return line.replace(/ +$/, "");
+}
+function epochLine4(prn, date, vals) {
+  return `${padL(prn, 3)} ${fmtEpoch4(date)}${vals.map(fmtD).join("")}`;
+}
+var BDS_GEO = /* @__PURE__ */ new Set([
+  "C01",
+  "C02",
+  "C03",
+  "C04",
+  "C05",
+  "C59",
+  "C60",
+  "C61",
+  "C62",
+  "C63"
+]);
+function msgLabel(eph) {
+  switch (eph.system) {
+    case "E":
+      return "INAV";
+    case "C":
+      return BDS_GEO.has(eph.prn) ? "D2" : "D1";
+    case "R":
+      return "FDMA";
+    case "S":
+      return "SBAS";
+    default:
+      return "LNAV";
+  }
+}
+function isKepler2(eph) {
+  return "af0" in eph;
+}
+function keplerRecord(eph) {
+  return [
+    epochLine4(eph.prn, eph.tocDate, [eph.af0, eph.af1, eph.af2]),
+    orbitLine4([eph.iode, eph.crs, eph.deltaN, eph.m0]),
+    orbitLine4([eph.cuc, eph.e, eph.cus, eph.sqrtA]),
+    orbitLine4([eph.toe, eph.cic, eph.omega0, eph.cis]),
+    orbitLine4([eph.i0, eph.crc, eph.omega, eph.omegaDot]),
+    orbitLine4([eph.idot, 0, eph.week, 0]),
+    orbitLine4([0, eph.svHealth, eph.tgd, 0]),
+    orbitLine4([eph.toe, 0, 0, 0])
+  ].join("\n");
+}
+function stateVectorRecord(eph) {
+  const lines = [
+    epochLine4(eph.prn, eph.tocDate, [
+      eph.tauN,
+      eph.gammaN,
+      eph.messageFrameTime
+    ]),
+    orbitLine4([eph.x, eph.xDot, eph.xAcc, eph.health]),
+    orbitLine4([eph.y, eph.yDot, eph.yAcc, eph.freqNum]),
+    orbitLine4([eph.z, eph.zDot, eph.zAcc, 0])
+  ];
+  if (eph.system === "R") {
+    lines.push(orbitLine4([null, 999999999999e-3, 15, null]));
+  }
+  return lines.join("\n");
+}
+function resolveWnOp(week, wnOp) {
+  if (wnOp == null) return week;
+  return week - ((week - wnOp) % 256 + 256) % 256;
+}
+function cnavRecord(eph) {
+  return [
+    epochLine4(eph.prn, eph.tocDate, [eph.af0, eph.af1, eph.af2]),
+    orbitLine4([eph.aDot, eph.crs, eph.deltaN0, eph.m0]),
+    orbitLine4([eph.cuc, eph.e, eph.cus, Math.sqrt(eph.a)]),
+    orbitLine4([eph.top, eph.cic, eph.omega0, eph.cis]),
+    orbitLine4([eph.i0, eph.crc, eph.omega, eph.omegaDot]),
+    orbitLine4([eph.i0Dot, eph.deltaN0Dot, eph.uraNed0, eph.uraNed1]),
+    orbitLine4([eph.uraEd, eph.health, eph.tgd, eph.uraNed2]),
+    orbitLine4([eph.iscL1ca, eph.iscL2c, eph.iscL5i5, eph.iscL5q5]),
+    orbitLine4([eph.tow, resolveWnOp(eph.week, eph.wnOp)])
+  ].join("\n");
+}
+var KLOBUCHAR_SOURCES = [
+  ["GPSA", "GPSB", "G", "LNAV"],
+  ["QZSA", "QZSB", "J", "LNAV"],
+  ["BDSA", "BDSB", "C", "D1D2"],
+  ["IRNA", "IRNB", "I", "LNAV"]
+];
+function ionRecords(header, epoch) {
+  const records = [];
+  const iono = header.ionoCorrections;
+  for (const [alphaKey, betaKey, sys, msg] of KLOBUCHAR_SOURCES) {
+    const alpha = iono[alphaKey];
+    if (!alpha) continue;
+    const beta = iono[betaKey] ?? [0, 0, 0, 0];
+    records.push(
+      [
+        `> ION ${sys}   ${msg}`,
+        `    ${fmtEpoch4(epoch)}${[alpha[0] ?? 0, alpha[1] ?? 0, alpha[2] ?? 0].map(fmtD).join("")}`,
+        orbitLine4([alpha[3] ?? 0, beta[0] ?? 0, beta[1] ?? 0, beta[2] ?? 0]),
+        orbitLine4([beta[3] ?? 0, null])
+      ].join("\n")
+    );
+  }
+  const gal = iono["GAL"];
+  if (gal) {
+    records.push(
+      [
+        "> ION E   IFNV",
+        `    ${fmtEpoch4(epoch)}${[gal[0] ?? 0, gal[1] ?? 0, gal[2] ?? 0].map(fmtD).join("")}`,
+        orbitLine4([gal[3] ?? 0])
+      ].join("\n")
+    );
+  }
+  return records;
+}
+function writeHeader4(header) {
+  const lines = [];
+  lines.push(
+    hdrLine(
+      padL("     4.01", 9) + "           " + padL("NAVIGATION DATA", 20) + padL("M", 20),
+      "RINEX VERSION / TYPE"
+    )
+  );
+  const now = /* @__PURE__ */ new Date();
+  const dateStr = now.getUTCFullYear().toString() + String(now.getUTCMonth() + 1).padStart(2, "0") + String(now.getUTCDate()).padStart(2, "0") + " " + String(now.getUTCHours()).padStart(2, "0") + String(now.getUTCMinutes()).padStart(2, "0") + String(now.getUTCSeconds()).padStart(2, "0") + " UTC";
+  lines.push(
+    hdrLine(
+      padL("GNSSCalc", 20) + padL("", 20) + padL(dateStr, 20),
+      "PGM / RUN BY / DATE"
+    )
+  );
+  if (header.leapSeconds != null) {
+    lines.push(hdrLine(padR(String(header.leapSeconds), 6), "LEAP SECONDS"));
+  }
+  lines.push(hdrLine("", "END OF HEADER"));
+  return lines.join("\n") + "\n";
+}
+function writeRinexNav4(nav) {
+  const records = [];
+  for (const eph of nav.ephemerides) {
+    const label = msgLabel(eph);
+    records.push({
+      prn: eph.prn,
+      time: eph.tocDate.getTime(),
+      label,
+      body: `> EPH ${padL(eph.prn, 3)} ${label}
+` + (isKepler2(eph) ? keplerRecord(eph) : stateVectorRecord(eph))
+    });
+  }
+  for (const eph of nav.cnav ?? []) {
+    records.push({
+      prn: eph.prn,
+      time: eph.tocDate.getTime(),
+      label: "CNAV",
+      body: `> EPH ${padL(eph.prn, 3)} CNAV
+` + cnavRecord(eph)
+    });
+  }
+  records.sort(
+    (a, b) => a.prn.localeCompare(b.prn) || a.time - b.time || a.label.localeCompare(b.label)
+  );
+  const bodies = records.map((r) => r.body);
+  if (records.length > 0) {
+    const earliest = new Date(Math.min(...records.map((r) => r.time)));
+    bodies.push(...ionRecords(nav.header, earliest));
+  }
+  return writeHeader4(nav.header) + (bodies.length > 0 ? bodies.join("\n") + "\n" : "");
+}
+
 // src/rinex/ionex.ts
 function gridRange(l1, l2, dl) {
   const out = [];
@@ -1193,7 +1477,9 @@ export {
   EMPTY_WARNINGS,
   WarningAccumulator,
   parseNavFile,
+  fmtD,
   writeRinexNav,
+  writeRinexNav4,
   parseIonex,
   parseSp3,
   sp3Position,