3. 水下导航定位的基本概念与坐标系

水下导航定位要回答的核心问题其实很朴素：“我在哪、我朝哪、我动得多快、我的姿态如何”。这四个问题分别对应位置、航向、速度与姿态。它们不是四个孤立数字，而是一组在同一参考框架下彼此关联的状态量。理解这一点，是后续学习惯性导航、声学定位、组合导航的前提。

四个基本状态量的定义

位置是载体在某一坐标系中的坐标表达。在局部作业中常用“北—东—地”三个分量描述，例如某水下机器人相对投放点的位置可记为（北 120 m，东 −45 m，深 80 m），表示它在投放点以北 120 m、以西 45 m、水面以下 80 m。注意“地”轴向下为正，深度 80 m 对应地轴分量 +80 m，这个符号约定必须在全系统中统一。

航向是载体纵轴在水平面内的投影相对正北方向的夹角，通常以正北为 0°、顺时针为正，取值范围 0°～360°。航向 90° 表示朝东，270° 表示朝西。它与姿态中的“艏向角”在水平航行时数值一致，但严格说航向是地理参考下的方向，艏向是载体坐标系相对参考系的转角，二者在存在纵倾、横滚时需要区分。

速度是位置对时间的导数，既有大小又有方向。工程上常分解为沿载体三轴的前向速度、右向速度、垂向速度（载体坐标系），也可转换为北向、东向、垂向速度（当地水平坐标系）。同一运动在两种坐标系下分量完全不同，换算依赖姿态矩阵。

姿态描述载体坐标系相对参考坐标系的转动关系，用横滚角、纵倾角、艏向角三个欧拉角表示。横滚是绕纵轴的转动，纵倾是绕横轴的转动，艏向是绕垂向轴的转动。姿态不仅决定速度分量如何换算，还直接影响安装在载体上的传感器（如 DVL、罗经）测得的数据如何解释。

三类常用坐标系及其转换

大地坐标系以地球椭球为基准，用经度、纬度、高度描述绝对位置，是全球统一、不随载体移动的参考框架。它的优点是绝对、无累积漂移，缺点是局部作业时经纬度数值不直观，且直接做米级距离计算需要投影换算。

当地水平坐标系（常称 NED 或 ENU）原点取在载体或作业区某一点，三轴分别指向北、东、地（或东、北、天）。它把“米”作为单位，适合局部导航解算与轨迹描述，是水下作业中最常用的工作坐标系。原点选在投放点、母船或作业区中心均可，但一旦选定，全系统必须一致。

载体坐标系固连在载体上，原点通常取载体重心或 IMU 安装中心，三轴为前、右、下。传感器测量值天然在载体坐标系下，而导航结果需要在地理框架下表达，因此每次解算都要做坐标转换。

三者之间的转换关系可以概括为：大地坐标与当地水平坐标之间通过原点经纬度和椭球参数做投影/反投影；当地水平坐标与载体坐标之间通过姿态矩阵（由三个欧拉角构成）做旋转。实际解算中，IMU 输出的角速度和比力先在载体坐标系积分得到姿态与速度，再经姿态矩阵转到当地水平坐标系积分得到位置，最后按需投影为经纬度。

精度指标：CEP、RMS 与圆概率误差

导航定位结果必须带精度描述，否则“位置”只是一个没有可信度的数字。水下定位中最常用的三个指标是 RMS、CEP 和圆概率误差，它们回答的问题略有不同。

RMS（均方根误差）衡量误差的统计离散程度，对一维或多维误差都可用。若某次定位的北向误差序列为 e_N、东向误差为 e_E，则水平 RMS 常取 √((e_N²+e_E²) 的均值)。它反映整体误差水平，但对离群点敏感。

CEP（圆概率误差，Circular Error Probable）指以真实位置为圆心、包含 50% 定位结果的圆半径。例如 CEP=5 m，意味着约一半的定位点落在真实位置 5 m 以内。它直观、易解释，是水下声学定位常用的验收指标。

圆概率误差在中文语境中常与 CEP 混用，严格说 CEP 是 50% 概率圆，而工程上还会用 R95（95% 概率圆）描述更严格的置信范围。R95 约为 CEP 的 2.1～2.4 倍（取决于误差分布假设），因此看到“CEP 5 m”不能直接理解为“最大误差 5 m”。

一个可操作的换算示例

假设某次静态测试中，USBL 对同一应答器连续输出 100 个定位点，以真实坐标为原点，得到北向、东向误差（单位：米）如下（示例数据，用于说明计算方法）：

eN = [ 1.2, -0.8, 2.1, 0.4, -1.5, 0.9, 1.8, -0.3, 0.6, -2.0, ... ]
eE = [-0.6,  1.1, 0.3, -1.4, 0.8, -0.9, 1.2, 0.5, -1.1, 0.7, ... ]

水平误差 r_i = sqrt(eN_i^2 + eE_i^2)
RMS = sqrt( mean(r_i^2) )
CEP ≈ 将 r_i 升序排列后取第 50 百分位

若算得 RMS≈1.6 m、CEP≈1.4 m，说明半数点落在 1.4 m 圆内，整体离散约 1.6 m。此时若任务要求“定位误差优于 2 m（CEP）”，则判定合格；若要求 R95 优于 2 m，则需进一步计算 95 百分位，很可能不达标。这就是为什么验收前必须明确指标口径。

坐标系使用中的常见约定

• 符号统一：NED 中“地”轴向下为正，深度 80 m 记为 D=+80 m；若系统改用 ENU，则“天”轴向上为正，深度记为 −80 m。混用会导致深度符号翻转。
• 航向基准：以真北为 0°、顺时针为正。磁罗经输出的是磁航向，需加磁偏角修正后才能与真北框架下的航向比较。
• 原点固定：当地水平坐标系原点一旦确定，整段作业不应随意更换；若必须更换，需记录新旧原点偏移量并统一换算。
• 安装偏差：IMU、DVL、USBL 基阵的安装角与安装位置偏差会直接进入姿态矩阵和杆臂补偿，标定后应在配置中固化。