2. 水下导航常用坐标系定义与物理意义

水下导航的所有位置、姿态、速度和声学测量值，最终都要落到某个坐标系里才有意义。同一组数字，换一个坐标系解释，可能从“向北 10 m”变成“沿载体纵轴 10 m”。因此本节不孤立背定义，而是围绕一个核心问题展开：每个坐标系解决什么问题、轴向怎么约定、在什么场景下选它，并给出可操作的工程判断依据。

一、五个坐标系的分工

地球惯性系（ECI）是牛顿力学定律成立的基准惯性空间，原点在地球质心，Z 轴指向北极，X 轴指向某一历元时刻的春分点。它不随地球自转，因此惯性器件（陀螺、加速度计）的比力方程和姿态动力学都在此系下描述。工程上它很少直接输出导航结果，但它是惯导解算的“物理底座”。

地心地固系（ECEF）与地球固连，随地球一起自转，原点同样在地心，Z 轴指向北极，X 轴指向本初子午线与赤道交点。它把“地球上的点”变成不随时间漂移的三维直角坐标，GPS/北斗的卫星星历、水下潜器的全球位置、大范围航迹推算都适合用它。ECEF 与经纬高之间的转换是导航数据处理的高频操作。

当地水平系（NED 或 ENU）以载体所在点为原点，一个轴沿当地垂线（天向或地向），另两轴在水平面内指北、指东。它最贴近人的直觉——“向北多少米、向东多少米、下潜多少米”，因此航位推算、航路规划、误差评估普遍采用。需注意 NED（北-东-地）与 ENU（东-北-天）轴向不同，混用会导致符号错误。

载体坐标系（b 系）固连于潜器本体，通常 X 轴沿纵轴向前、Y 轴沿横轴向右、Z 轴沿竖轴向下，构成右手系。它描述的是“相对自身”的量：前向速度、侧向漂移、俯仰/横滚/航向角，以及 IMU、DVL、深度计等传感器的安装基准。

声学基阵坐标系（a 系）固连于换能器基阵，原点在基阵几何中心，轴向由基阵布放决定。超短基线（USBL）测得的是目标相对基阵的斜距与方位角，长基线（LBL）测得的是到各应答器的距离，这些原始量必须先归算到 a 系，再经安装矩阵变换到 b 系，才能与惯导数据融合。

二、轴向约定与易错点

五个坐标系里最容易出错的是轴向约定。ECI 与 ECEF 的 Z 轴都指向北极，区别只在 X 轴是否随地球转动；NED 的 D 轴指向地心方向，而 ENU 的 U 轴指向天顶，两者相差 180°。载体坐标系若采用“前-右-下”，则俯仰角抬头为正还是为负、横滚角右倾为正还是为负，必须与姿态解算和显示端统一。声学基阵坐标系更特殊：它的轴向完全取决于换能器安装姿态，同一套 USBL 设备正装与倒装，其 a 系到 b 系的安装矩阵就不同。

一个常见的实操错误是：把 USBL 输出的“方位角、俯仰角、斜距”直接当作 NED 下的北向、东向、地向分量使用。正确做法是先按基阵轴向把球坐标转为 a 系直角坐标，再乘安装矩阵 R_ab 转到 b 系，最后用姿态矩阵 R_nb 转到 NED。少任何一步，位置就会随载体姿态变化而系统性偏移。

三、坐标系选择的工程判断依据

选择坐标系不是学术偏好，而是由“数据来源”和“使用目的”共同决定的。可按下述判断链操作：

• 看数据来源：IMU 原始比力与角速度在 b 系；卫星星历在 ECEF；USBL/LBL 原始量在 a 系；深度计给出的是当地垂线方向的距离。先确认输入属于哪个系，再决定是否需要变换。
• 看解算目的：若做惯性导航机械编排，以 ECI 或 ECEF 为基准；若做局部航迹显示与避碰，用 NED 更直观；若做多源融合，通常统一到 NED 或 ECEF 之一作为公共参考系。
• 看作用范围：作业范围在几公里内，NED 的平面近似误差可忽略；跨海域或长航时，应使用 ECEF 避免当地水平系随位置变化带来的累积误差。
• 看精度预算：安装矩阵标定残差、姿态角误差、坐标系转换的舍入误差都应计入总误差。若 USBL 安装角标定误差为 0.5°，在 100 m 斜距上就会引入约 0.87 m 的横向位置误差。

四、统一参考系的落地做法

实际工程中，建议在数据处理链路中固定一个“公共参考系”，例如统一采用 NED 作为融合与显示基准，所有传感器数据在进入滤波器前完成到 NED 的变换，并保留原始系数据用于回溯。变换链应写成显式函数，输入输出都标注坐标系名称，例如 R_ab、R_nb、R_en，避免用含义模糊的 R。每次变换前检查旋转顺序（如 Z-Y-X 或 Z-X-Y）与正负号约定，并在代码注释中写明所采用的 NED 还是 ENU。

此外，坐标系定义应形成一份简短的“坐标约定卡”，记录各系原点、轴向、旋转顺序、安装矩阵标定值和标定日期。这份卡片在多传感器联调、故障复盘和人员交接时，往往比任何算法文档都更能避免低级错误。坐标系选对了、约定统一了，后续的滤波、融合与误差分析才有可靠的基础。