单一导航源难以满足全面覆盖的需求:GNSS在水下或城市峡谷中会失效;DVL受限于海底跟踪范围;里程计易受车轮打滑和比例因子误差的影响;视觉系统在纹理稀疏的环境或光照条件变化时性能下降。多源融合的核心思想在于利用各种传感器的互补特性,通过最优估计理论实现冗余和容错。本文基于耦合深度和信息互补性两个维度,系统地分析了四种典型的融合导航模式。
耦合深度分类
根据信息融合的深度,多源融合可以分为三个层次:
* **松耦合**代表最低级别的耦合,其中子系统执行独立计算,主滤波器融合位置和速度等导航参数。其优点包括计算量低和故障隔离简单;然而,精度损失主要源于子系统计算的独立性。
* **紧耦合** 将观测提升到原始测量的水平;来自 IMU 和 DVL(或视觉传感器)的原始数据直接参与联合估计过程,利用传感器误差特性的时间相关性来实现更优的估计。
* **深度耦合** 更进一步,将某些传感器的原始信号纳入 IMU 的闭环控制中,在测量域中建立直接反馈;这代表了最高级别的耦合,实现了极致的精度和最大的鲁棒性。
**四种集成导航模式的原理**
(1) **INS/DVL集成**
多普勒速度计 (DVL) 利用多普勒效应测量车辆相对于海底(或水层)的三维速度。惯性导航系统 (INS) 与 DVL 的集成本质上是一个基于速度观测的卡尔曼滤波过程:DVL 速度测量值作为外部观测值,用于校正 INS 的速度误差,从而抑制位置漂移。状态方程和观测方程可以表示如下:
![]()
协方差矩阵Σ是确定融合权重的关键:协方差越小(表示不确定性越低),分配给传感器的权重就越高。当底部跟踪有效时,DVL的权重最高;在平坦地形上,里程计的权重次之;而在视觉纹理丰富的区域,视觉则提供横向约束。
故障检测与隔离(FDI)机制利用卡方检验或残差检验实时监测观测源的异常情况。如果DVL海底跟踪失效,系统自动降级至INS/里程计/视觉融合模式;如果视觉性能下降,则切换至INS/DVL/里程计模式;如果仅剩INS和里程计,则恢复至受非完整约束(NHC)限制的纯INS模式。异构冗余设计确保即使出现单点故障也能保证导航连续性,从而实现从浅水区、深水区到近底水下环境等各种作业场景的无缝覆盖。
结论
多传感器融合导航并非仅仅增加传感器数量,而是依赖于耦合深度的合理选择和协方差矩阵的精确定义,以实现传感器性能的互补。虽然更深的耦合深度能够带来更高的潜在精度,但也增加了计算复杂度和工程实现难度;因此,应根据具体任务需求选择最佳融合架构。
留言