水下导航扫盲_水下imu+里程计定位-优快云博客

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 或载人潜水器的绝对导航。