3. 坐标系与时间基准误差

水下导航的定位解算，本质上是在一个约定的空间参照系和一个约定的时间尺度上，把传感器观测转换为载体位置。只要坐标系定义不一致、转换参数不准确，或各传感器的时间戳存在偏差，解算结果就会出现系统性偏移或随时间漂移的误差。本节围绕三件事展开：常用坐标系如何定义、它们之间如何转换、时间同步偏差如何进入定位解算并放大误差。

一、水下导航常用坐标系的定义与约定

工程上通常同时使用四类坐标系，各自承担不同职责：

• 地心地固坐标系（ECEF）：原点在地球质心，Z 轴指向协议地球北极，X 轴指向本初子午线与赤道交点。它是全球统一的笛卡尔框架，适合做多源数据融合的公共参考。
• 地理坐标系（经纬高，LLH）：以纬度、经度、椭球高描述位置，便于人机交互与海图对照，但直接用于滤波时需转换为局部直角坐标。
• 当地水平坐标系（ENU/NED）：原点取载体所在点，东-北-天（ENU）或北-东-地（NED）三轴构成局部直角框架。水下组合导航的误差状态方程几乎都在 ENU 或 NED 下建立，因为重力方向与水平面在此系下有明确物理意义。
• 载体坐标系（b 系）：与载体固连，X 轴指向艏向、Y 轴指向右舷、Z 轴指向下（前-右-下约定）。IMU、DVL、磁罗经的原始观测都在 b 系下表达。

需要特别强调约定一致性：姿态角的正负号、旋转顺序（如 Z-Y-X 的航向-纵摇-横摇）、DVL 波束指向、磁偏角修正方向，都必须在全系统内统一。若 IMU 采用“右-前-上”而 DVL 采用“前-右-下”，仅轴序不一致就会在解算中引入与航向相关的耦合误差，表现为转弯时定位突然跳变。

二、坐标系转换链与误差传播

从传感器观测到最终位置，典型转换链为：b 系观测 → 经姿态旋转矩阵 C_bⁿ 转到 n 系（ENU）→ 经位置相关的转换矩阵转到 ECEF → 再转为 LLH 输出。其中 C_bⁿ 由航向 ψ、纵摇 θ、横摇 φ 按约定顺序连乘得到。

转换链上的误差传播有两个关键点。第一，姿态误差会被杠杆臂放大：若 DVL 安装点距 IMU 中心存在杆臂 r，姿态角误差 δθ 会产生速度观测偏差 δv ≈ δθ × ω × r，在转向或摇摆时尤为明显。第二，基准点误差是系统性偏移：若大地基准（椭球参数、中央子午线、投影带）设置错误，LLH 与 ENU 之间的往返转换不再自洽，定位结果会出现固定偏置，且该偏置不随滤波收敛而消失。

三、时间基准与同步偏差的影响

组合导航的观测更新依赖“同一时刻”的假设。实际系统中，IMU 以高频（如 200 Hz）输出，DVL 以低频（如 1 Hz）输出，深度计、磁罗经、USBL 各有自己的采样节拍与传输延迟。若时间戳未统一到同一时间基准（如 GPS 授时的 UTC 或系统单调时钟），就会产生两类误差：

• 固定时延：某传感器数据整体滞后 Δt。载体以速度 v 运动时，等效位置误差约为 v·Δt。以 1.5 m/s 航速、200 ms 延迟计，约 0.3 m；对高精度任务已不可忽略。
• 时变抖动：延迟不恒定，导致观测与预测时刻错配，滤波残差出现非白噪声特性，表现为新息序列相关性升高、协方差估计失真。

处理方法是：为每个传感器建立“采样时刻—到达时刻”记录，估计并补偿固定时延；对 IMU 与 DVL 采用插值或状态回推，把观测对齐到统一时刻；在滤波器中把残余时延作为状态量在线估计。判断同步是否达标，可观察 DVL 速度新息的均值是否接近零、自相关是否快速衰减。

四、一个可复现的检查示例

假设某 AUV 以 1.2 m/s 匀速直航，DVL 数据相对 IMU 存在 150 ms 固定时延，杆臂 r = (0.8, 0.1, 0.3) m，转向角速度 5°/s。可做如下估算：时延引起的等效位置误差约 1.2 × 0.15 = 0.18 m；杆臂项在转向时产生的速度偏差量级约 0.087 rad/s × 0.8 m ≈ 0.07 m/s，若持续 10 s 则累积约 0.7 m。两者叠加后，一次转向机动的定位偏差可达米级。这说明坐标系与时间基准误差往往不是“小量”，而是与机动强度强相关的误差源。

把上述检查固化为联调流程的一部分，可以在下水前发现大部分坐标系与时间基准类问题，避免把系统性偏差误判为滤波器参数不佳。