1. 课程导入与水下定位坐标转换概览

水下定位与导航,解决的是一个看似简单却极其关键的问题:“我现在在哪里?我要去的地方在哪里?” 在陆地上,卫星导航几乎可以随时回答这个问题;但电磁波在水中衰减极快,GPS信号在几米深的海水中就基本不可用。因此,水下定位必须依赖声学、惯性、光学或压力等多种传感器组合,而这些传感器各自输出的是不同坐标系下的数据——声学给出的是相对基阵的距离与方位,惯导给出的是载体坐标系下的加速度积分,深度计给出的是相对某一基准面的压力换算值。要让这些数据“说同一种语言”,坐标转换就是贯穿始终的桥梁。

本课程围绕“坐标转换”这一核心能力展开,但坐标转换并不是孤立的数学运算,它嵌入在完整的水下定位与导航链路中。理解这一点,是学好后续内容的前提。

一、水下定位与导航的基本概念

定位回答的是“当前时刻的位置”,通常输出一个坐标值;导航回答的是“从当前位置如何到达目标”,需要位置、姿态、速度随时间的变化。两者共享同一套坐标框架,但关注点不同:定位强调单点解算的精度与可靠性,导航强调连续推演的一致性与误差控制。

水下定位系统按参考基准可分为三类:绝对定位(如USBL超短基线、LBL长基线,参考点是水面船或海底基阵的已知坐标)、相对定位(如DVL多普勒计程仪推算、惯性导航,参考点是载体自身的初始位置)、地理定位(通过水面GPS浮标或声学同步将绝对坐标引入水下)。实际系统往往是多源融合,而融合的第一步,就是把各源数据统一到同一坐标系。

二、坐标转换为什么是核心

以一个典型的USBL作业为例:水面船上的换能器基阵测得水下ROV的斜距 r、方位角 θ、俯仰角 φ,这是基阵坐标系下的球坐标;船载惯导给出船体姿态(横摇、纵摇、艏向),需要把基阵坐标旋转到船体坐标系,再旋转到当地水平坐标系(北-东-地),最后叠加船位GPS的大地坐标,才能得到ROV的地理位置。这条链路上任何一步旋转矩阵写错、角度正负号约定不一致,都会导致定位结果偏差数米甚至数十米。

更隐蔽的问题来自约定不一致:同样是“艏向角”,有的系统以正北为0°顺时针为正,有的以正东为0°逆时针为正;同样是“深度”,有的以水面为基准向下为正,有的以海平面为基准向上为正。这些约定本身没有对错,但混用就会出错。因此,本课程会在每一类转换中先明确源坐标系与目标坐标系的定义,再给出转换关系,并在全文和图示中保持一致。

USBL 定位链路中的坐标转换关系 从基阵测量到大地坐标,每一级转换都对应一个明确的坐标系 基阵坐标系 斜距 r、方位 θ、俯仰 φ 原点:换能器基阵中心 轴向:随基阵安装方向 船体坐标系 原点:船舶参考点 X 艏向、Y 右舷、Z 向下 含横摇/纵摇/艏向姿态 当地水平坐标系 北-东-地(NED) 原点:船位参考点 水平面与重力方向对齐 大地坐标系 经纬度 + 深度 WGS-84 或局部基准 最终交付坐标 安装角 旋转 姿态 旋转 船位 叠加 三类典型水下任务的坐标转换需求 ROV 精细作业 • 目标:阀门/接口厘米级对位 • 关键转换:基阵→船体→目标 • 关注:姿态补偿、安装角标定 • 误差敏感:角度约定、杆臂 示例:斜距 120 m,方位偏差 0.5° 即横向约 1.05 m 偏差 (示例假设,非实测) AUV 长航程巡航 • 目标:航迹保持与任务点到达 • 关键转换:惯导→NED→大地 • 关注:初始对准、航向漂移 • 误差敏感:初始位置、陀螺零偏 示例:航向误差 0.2°,航行 1 km 后横向偏差约 3.5 m (示例假设,非实测) 潜水员导航 • 目标:返回起点/到达作业点 • 关键转换:罗经→NED→相对位移 • 关注:磁偏角、水流影响 • 误差敏感:罗经偏差、步距估计 示例:罗经偏差 5°,游动 200 m 后偏离约 17.4 m (示例假设,非实测)

三、课程整体结构与学习目标

本课程共 30 章,按“概念—数学基础—传感器与系统—转换实现—任务应用—误差与排障”的逻辑递进组织。前段建立坐标系定义与旋转矩阵、欧拉角、四元数等数学工具;中段进入USBL、LBL、DVL、惯导、深度计等具体传感器,讲清每类数据所在坐标系及其转换路径;后段结合ROV作业、AUV巡航、潜水员导航等任务,完成从原始观测到可用坐标的完整链路,并讨论误差传播与常见故障判断。

学习目标可归纳为三条:第一,能准确说出一个水下定位系统中每个数据分别属于哪个坐标系、原点与轴向如何定义;第二,能独立完成基阵坐标到船体坐标、船体坐标到当地水平坐标、当地水平坐标到大地坐标的转换计算,并保持角度与深度约定一致;第三,能判断转换链路中哪一环出现偏差,以及该偏差对最终定位结果的影响量级。

四、一个贯穿全课的例子

假设某次ROV作业中,USBL测得目标斜距 120 m、方位角 30°、俯仰角 −10°(基阵坐标系,方位以基阵X轴为0°、绕Z轴逆时针为正,俯仰向下为负)。若基阵相对船体的安装角已知为艏向偏转 2°,船体姿态为艏向 45°、纵摇 1°、横摇 −2°,船位GPS为已知大地坐标。完整解算需要依次完成:球坐标转直角坐标、安装角旋转、姿态旋转、坐标叠加。这个例子会在后续章节中逐步展开,每一步的矩阵形式和数值结果都会给出,并明确标注为教学示例。读者届时可以对照本节图示,检查自己是否清楚每一步的输入、输出与约定。

学习建议:每遇到一个新坐标系,先画三件事——原点在哪、三个轴指向哪、角度正方向怎么定。这三件事写清楚,转换公式就不容易用错。

坐标转换不是一门孤立的计算技巧,而是水下定位系统能否输出可信坐标的“最后一公里”。接下来的章节将从最基础的坐标系定义开始,逐步搭建这条链路。