1. 课程导入与导航任务认知
欢迎进入《水下DVL与惯导组合导航入门》。在正式接触公式和算法之前,我们需要先建立一张"知识地图":这门课要解决什么问题,涉及哪几个核心器件,它们各自扮演什么角色,又为什么必须"组合"在一起使用。本章不追求计算细节,而是帮助你在脑中搭建整体框架,为后续章节的深入打下认知基础。
一、水下导航到底难在哪里
陆地上的车辆可以依赖卫星导航,而水下环境对电磁波极不友好——高频信号在水中衰减极快,GPS/GNSS 信号几乎无法穿透水面到达水下数十米甚至数百米。这意味着水下航行器(AUV、ROV、潜艇等)必须依靠"自主"手段确定自身位置、姿态和速度。
水下导航的难点可以归纳为三点:一是无卫星参考,位置必须靠推算或声学辅助;二是误差会累积,任何基于积分的推算方法,误差都随时间增长;三是环境约束强,水流、温度、盐度变化会影响传感器性能。理解这三点,就理解了为什么单一传感器难以胜任,也理解了"组合导航"的必要性。
二、三个核心概念
DVL(Doppler Velocity Log,多普勒速度计程仪):它向水底发射声波,利用回波的多普勒频移测量航行器相对于海底(或水层)的三维速度。DVL 的关键价值在于提供对地速度,且误差不随时间累积——但它测的是速度而非位置,需要积分才能得到位移,且对底高度、底质有一定要求。
INS(Inertial Navigation System,惯性导航系统):由陀螺仪和加速度计组成,通过测量角速度和比力,积分推算姿态、速度和位置。INS 的优点是完全自主、输出频率高、短时精度好;缺点是误差随时间发散,长时间单独工作会"漂移"。
组合导航:把 DVL 与 INS 的数据通过滤波算法(如卡尔曼滤波)融合。INS 提供高频的姿态和推算结果,DVL 提供不随时间漂移的速度观测,二者互补,从而抑制 INS 的漂移、提升整体精度与稳定性。这就是"1+1>2"的工程体现。
三、为什么必须"组合":一个直观的示例
假设某 AUV 以约 1.5 m/s 的速度巡航,INS 单独工作时位置误差可能以每小时数百米到上千米的量级增长(具体取决于陀螺零偏等级,此处为教学假设)。若任务要求定位误差控制在十米级,单靠 INS 显然不够。而 DVL 提供的速度观测若精度在 0.5% 量级,配合滤波融合后,位置误差的增长会被显著压制。这个对比说明:INS 解决"连续、自主、高频",DVL 解决"长期不漂移",组合解决"两者兼得"。
四、本课程的知识框架与学习目标
围绕上述三个概念,本课程将按"认知—原理—实现—验证"的路径展开,主要包括:
- 基础认知:坐标系约定(如载体坐标系、导航坐标系)、姿态表示(欧拉角、四元数)、DVL 与 INS 的工作原理与误差特性。
- 组合原理:松组合、紧组合的差异,卡尔曼滤波的状态量选取(位置、速度、姿态、零偏等),观测方程如何引入 DVL 速度。
- 工程实现:时间同步、杆臂补偿、DVL 安装角标定、数据预处理与异常剔除。
- 验证与排障:轨迹对比、误差统计、常见故障(如 DVL 失锁、底跟踪丢失)的识别与处理。
学完本课程,你应当能够:说清 DVL 与 INS 各自的能力边界;理解组合导航为何能提升精度;读懂基本的滤波配置与参数含义;并具备对一次组合导航结果做初步判读的能力。
五、坐标系约定(先立规矩)
后续所有方向、正负号都依赖坐标系定义,这里先统一:载体坐标系(b 系)取"右-前-上"或"前-右-下"需在课程中固定,本课程采用前-右-下(FRD);导航坐标系(n 系)采用北-东-地(NED)。DVL 测得的速度通常在 b 系下表达,融合前需经姿态矩阵转换到 n 系。切换参照系时,正文与图示都会明确标注,避免混淆。
至此,你已经拥有了本课程的"总览图":任务场景提出需求,INS 与 DVL 各司其职,组合导航通过融合实现优势互补,而坐标系与误差特性是贯穿始终的基础约定。接下来的章节将逐一拆开这些模块,从原理走向可操作的工程实践。