AUV 和载人潜水器的导航原理总体相似,核心区别在于:AUV 要自己闭环完成“定位—规划—控制”,载人潜水器则把融合后的导航信息提供给驾驶员,同时通常由母船持续进行声学跟踪和安全监控。
1. 为什么水下导航特别困难
海水会快速衰减 GPS/GNSS 使用的无线电信号,因此潜水器下潜以后通常无法直接接收卫星定位。
水下导航一般采用:
水面 GPS 初始位置 ↓ INS/IMU 高频惯性推算 ↓ DVL 修正水平速度 压力深度计修正深度 ↓ USBL/LBL 提供周期性绝对位置 ↓ 声呐、相机、地形匹配进一步修正 ↓ EKF / UKF / 因子图融合 ↓ 输出位置、速度、姿态和不确定度任何一种传感器都不够,真正可靠的系统依赖多传感器组合。
2. AUV 是怎么导航的
AUV 在水面时先用 GPS 完成初始定位、校准时间和部分惯导初始化。下潜后主要依靠以下设备。
| 设备 | 作用 | 主要限制 |
|---|---|---|
| INS/IMU | 高频输出姿态、速度和相对位置 | 积分误差随时间增长 |
| DVL | 测量相对于海底或水体的速度 | 距海底过远、地形陡峭时可能失锁 |
| 压力深度计 | 准确测量深度 | 不能测量水平位置 |
| 磁力计 | 提供航向参考 | 容易受电机、金属结构影响 |
| USBL | 由母船测量 AUV 的距离和方向 | 更新慢、受声速和母船姿态影响 |
| LBL | 利用布置在海底的多个声学基站定位 | 精度较高,但部署成本高 |
| 前视声呐 | 避障、目标检测、声呐 SLAM | 分辨率通常低于相机 |
| 多波束/侧扫声呐 | 海底地形测绘和地形匹配 | 设备昂贵、处理复杂 |
| 相机/视觉 SLAM | 近距离精细定位和重建 | 浑浊、弱光、低纹理时容易失效 |
导航计算机通常利用扩展卡尔曼滤波器(EKF)或因子图,把这些观测融合成统一状态:
[
\mathbf{x}=
[\mathbf{p},\mathbf{v},\mathbf{q},
\mathbf{b}_a,\mathbf{b}_g,\ldots]
]
其中包括位置、速度、姿态、加速度计零偏和陀螺仪零偏。
AUV 得到位姿后,还需要自主执行:
任务航线 → 路径规划 → 制导 → 姿态/速度控制 → 推进器 ↑ 融合导航结果因此,“导航”在 AUV 系统中通常包含三个不同层面:
- Navigation:我在哪里、姿态和速度是多少。
- Guidance:下一步应该朝哪里走。
- Control:各推进器应该输出多大的力。
NOAA 对 REMUS 600 的介绍是一个很直观的工程案例:水面用 GPS,水下由融合多传感器的 INS 导航,并通过声学链路与母船通信。NOAA:REMUS 600 海底测绘
3. 载人潜水器如何导航
载人潜水器也会使用 INS、DVL、深度计和 USBL,但体系更强调冗余、驾驶员显示以及母船监督。
以美国载人潜水器 Alvin 为例:
艇内: DVL + 光纤陀螺仪 + 深度计 ↓ 计算局部连续位置 ↓ 显示给驾驶员并用于定点、定深、定航向 母船: GPS + 船载 USBL ↓ 测量潜水器的绝对位置 ↓ 通过水声通信传给潜水器并校正艇内导航Alvin 使用 DVL 测量相对于海底的运动,用光纤陀螺仪提供主要航向和姿态,再用母船 USBL 的位置修正漂移。这是非常典型的现代载人潜水器架构。WHOI:Alvin 系统与传感器
载人潜水器和 AUV 的主要差别如下:
| 对比 | AUV | 载人潜水器 HOV |
|---|---|---|
| 决策者 | 自主计算机 | 驾驶员为主 |
| 航线执行 | 自动闭环控制 | 驾驶员或自动保持系统 |
| 母船定位 | 视任务决定 | 通常持续 USBL 跟踪 |
| 故障处理 | 自动降级、返航或上浮 | 驾驶员判断并执行应急操作 |
| 导航目的 | 自主完成任务 | 安全航行、到达目标并返回 |
| 传感器原理 | INS/DVL/声学/深度 | 基本相同,但更强调冗余 |
| 后处理 | 测绘任务中很常见 | 航次数据也会重新融合处理 |
值得阅读 WHOI 关于 Alvin 导航改造的科普文章。它直接展示了 USBL 解算、艇上航位推算和辅助 INS 三种轨迹为什么会不一致:WHOI:Segal’s Law of Navigation
4. 匀速航行时怎么处理
正如前面讨论的,IMU 无法仅凭当前测量区分“静止”和“匀速直线运动”。但完整水下导航系统不会因此失效:
- IMU 提供高频姿态和加速度。
- DVL 直接测量匀速运动的速度。
- 深度计稳定垂向位置。
- USBL/LBL 定期修正绝对位置。
- 视觉或声呐 SLAM 测量相对环境的位移。
- 动力学模型可以利用推进器输出、阻力和水流估计运动。
因此匀速是“纯 IMU 不可观”的情况,却不是“组合导航不可观”的情况。DVL 正是解决这个问题的重要设备。
5. 推荐阅读顺序
| 难度 | 文章 | 时间 | 推荐理由 |
|---|---|---|---|
| 入门 | WHOI:Alvin Systems, Sensors and Sampling | 持续更新 | 最直观的载人潜水器真实导航配置 |
| 入门 | WHOI:Segal’s Law of Navigation | 2022 | 用实际轨迹解释 USBL、航位推算和辅助 INS |
| 入门 | NOAA:REMUS 600 Seafloor Mapping | 2019 | 简洁介绍 AUV 从 GPS 初始化到水下惯导 |
| 综合综述 | Autonomous Underwater Vehicle Navigation: A Review | 2023 | 分类最系统:航位推算、信号导航、地图匹配、组合与协同导航 |
| 经典综述 | AUV Navigation and Localization: A Review | 2014 | 水下导航领域经典入门论文 |
| 开放获取综述 | Positioning Systems for Unmanned Underwater Vehicles | 2024 | 可直接阅读全文,传感器对比比较全面 |
| 声学定位 | Underwater Acoustic Positioning Systems | 2015 | 理解 LBL、SBL、USBL 和深海误差来源 |
| 算法进阶 | INS/USBL/DVL Integrated Navigation | 2023 | 比较卡尔曼滤波和因子图组合导航 |
| DVL进阶 | Doppler Water-Track Aided Inertial Navigation | 2009 | 解释 DVL 底锁丢失时如何使用水体速度辅助 INS |
如果只读三篇,我建议依次看:
- WHOI 的 Alvin 系统介绍——建立工程直觉。
- 2023 年 AUV Navigation Review——建立完整知识框架。
- INS/USBL/DVL 因子图论文——了解现代融合算法。
结合你现在的 ZED2i、ORB-SLAM3 和正射拼图方向,最相关的路线是:
IMU/INS + DVL + 压力深度计 + 水下相机视觉里程计/SLAM + 必要时使用USBL绝对校正 ↓ 统一时间同步与坐标系 ↓ EKF或因子图融合位姿 ↓ 正射拼图和三维重建也就是说,ORB-SLAM3 可以成为近海底精细相对定位的一部分,但不应单独承担整段 AUV 或载人潜水器的绝对导航。