1. 水下导航任务与坐标变换需求分析

自主水下航行器（AUV）在执行海底地形测绘、管线巡检、沉船探测或水文采样等任务时，导航系统需要持续回答三个问题：我在哪里、我朝向哪里、我相对目标偏了多少。这三个问题看似简单，却横跨了惯性导航、声学定位、地球模型与任务规划多个环节，而把这些环节串联起来的关键纽带，正是坐标变换。本节从一次典型的AUV巡航作业出发，梳理导航数据流中涉及的坐标系、变换环节与精度要求，为后续各章的公式推导与工程实现建立整体框架。

一次典型巡航任务中的导航数据流

设想一台AUV以约2 kn的速度在80 m深的海域执行测线任务，任务规划给定的是地理坐标下的测线端点（经度、纬度、深度），而航行控制需要的是载体相对水流的姿态与速度，侧扫声呐成像需要的是声呐换能器相对海底的位置与指向。整个数据流大致经过以下环节：

• 惯性测量单元（IMU）输出比力与角速度，经捷联解算得到载体在导航系下的姿态、速度与位置增量；
• 多普勒计程仪（DVL）提供对底速度，需从仪器坐标系转换到载体坐标系，再投影到导航系；
• 深度计给出压力深度，用于约束垂向位置；
• 超短基线（USBL）或长基线（LBL）提供声学定位观测，其观测值定义在声学基阵坐标系中；
• 组合导航滤波器融合上述信息，输出统一导航系下的位置、速度、姿态；
• 任务载荷（侧扫声呐、多波束、相机）依据自身安装关系，将成像结果反算到地理坐标。

可以看到，几乎每一个传感器都工作在各自的坐标系中，而融合与决策必须在统一参考下进行。坐标变换不是附属步骤，而是贯穿数据链的“翻译层”。

四类核心坐标系及其分工

水下导航中最常打交道的坐标系有四类。第一类是仪器坐标系，每个传感器都有自己的轴向定义，例如DVL的波束平面、USBL基阵的阵面法向。第二类是载体坐标系，通常取AUV质心为原点，x轴指向艏部，y轴指向右舷，z轴指向底部，符合右手定则。第三类是导航坐标系，工程上常取当地水平坐标系（北-东-地，NED），原点随载体移动，用于捷联解算与滤波。第四类是地理坐标系，用经度、纬度、椭球高描述，是任务规划与成果交付的最终表达。

需要特别强调参照约定的统一：本课程全程采用NED导航系，姿态角按“先航向、再俯仰、后横滚”的Z-Y-X顺序定义，旋转矩阵均为从载体系到导航系的正交阵。任何一次坐标系切换，都必须在文档与代码中显式注明，否则正负号与旋转方向极易出错。

变换环节与误差传播

从仪器系到地理系，变换链通常包含三步：安装矩阵补偿、姿态矩阵投影、地球模型与投影换算。安装矩阵由传感器在载体上的机械安装角度决定，出厂标定或坞内标定给出；姿态矩阵由IMU解算实时提供；地球模型则涉及椭球参数、子午圈与卯酉圈曲率半径，以及从局部NED到经纬度的积分换算。

误差沿这条链逐级传播。举一个可核算的示例：设某DVL安装点相对AUV质心的杆臂为艏向1.2 m、垂向0.3 m，当载体存在0.5°的横滚角误差时，杆臂引起的速度观测偏差约为 ω×r，量级在毫米每秒到厘米每秒之间；若姿态误差增大到2°，该偏差将放大四倍。这说明坐标变换中的杆臂补偿与姿态精度必须匹配设计，不能只关注传感器本身的标称精度。

精度需求的分解方法

任务对导航精度的要求应当自上而下分解。以侧扫声呐测绘为例，若要求成图平面位置误差优于5 m，则需将总误差预算分配给：惯性导航漂移、DVL测速误差、声学定位误差、杆臂与时间同步误差、坐标投影误差。一个合理的做法是列出误差预算表，对每项给出量级估计与平方和开方合成，再判断哪一项是瓶颈。下表给出一个示例性预算（数值为教学假设，非实测）：

本课程的学习目标与框架

基于上述分析，本课程围绕“定义—变换—融合—验证”四条主线展开。第一阶段厘清各坐标系的定义、轴向与旋转顺序，建立统一的符号体系；第二阶段推导仪器系、载体系、导航系、地理系之间的变换矩阵，并处理杆臂、时间同步与地球模型；第三阶段把变换嵌入组合导航滤波，理解状态量、观测方程与坐标系选择的关系；第四阶段通过仿真与实测数据验证变换链的正确性，学会用闭合航迹、往返测线一致性等指标判断结果是否可信。