1. 课程导入与水下INS误差修正全景

水下惯性导航系统(Inertial Navigation System,INS)是潜航器、水下机器人(ROV/AUV)、水下拖曳体等平台的核心自主导航手段。它依靠陀螺仪测量角速度、加速度计测量比力,经姿态解算与积分运算递推出速度、位置和姿态,全程不依赖外部无线电信号,因而具备隐蔽、连续、抗干扰的天然优势。但惯性导航的本质是"积分放大误差":陀螺零偏带来姿态漂移,姿态误差又通过重力投影污染加速度,加速度计零偏再经两次积分放大为位置误差。一个中等精度的惯导,在水下航行数小时后位置误差可达数百米甚至公里级,这对需要精确抵近、定点悬停或长航时返航的任务是不可接受的。因此,误差修正不是可选优化,而是水下INS能否真正可用的前提。

本课程以"水下INS误差修正"为核心对象,围绕误差从哪里来、如何被观测、怎样被估计与补偿三条主线展开。学习者需要建立三个基本认识:第一,误差源具有明确的物理分类——器件级(零偏、标度因数、安装误差)、初始级(初始对准误差)、环境级(温度、振动、洋流引起的运动扰动);第二,修正手段分为"抑制"与"估计补偿"两类,前者如旋转调制、温度建模,后者如卡尔曼滤波融合DVL、深度计、USBL等外部量测;第三,修正效果必须通过可观测性、收敛性和残差统计来验证,而不是凭感觉判断。

水下INS误差传播与修正闭环全景 误差源 陀螺零偏 / 标度因数 加速度计零偏 / 安装误差 初始对准误差 温度 / 振动 / 洋流扰动 误差传播链(积分放大) 陀螺零偏 → 姿态角漂移 姿态误差 → 重力投影污染比力 比力误差 → 速度误差(一次积分) 速度误差 → 位置误差(二次积分) 修正手段 旋转调制 / 温度补偿 DVL 速度辅助 深度计 / USBL 位置辅助 卡尔曼滤波估计与反馈 误差状态反馈补偿 导航解算与修正效果验证 姿态解算 四元数 / 方向余弦 速度积分 比力 + 重力补偿 位置递推 经纬度 / 深度 残差与可观测性 新息序列 / 协方差 判断依据:位置残差收敛、速度误差有界、姿态漂移率下降、滤波新息白化

上图把整门课的逻辑压缩成一条闭环:左侧是误差源,中间是误差沿积分链放大的路径,右侧是修正手段,底部是解算与验证环节。理解这张图的关键在于"传播链"——它解释了为什么修正必须尽早、必须针对可观测的误差状态。举例来说,若某MEMS陀螺零偏为0.5°/h,在无修正条件下航行2小时,仅由该零偏引起的姿态漂移约1°,而1°的姿态误差在重力投影下可产生约0.17 m/s²的等效加速度误差,积分10分钟后速度误差即达百米每秒量级,位置误差迅速发散。这个数量级推演说明:修正的收益不是线性的,而是"截断积分链"式的。

课程整体知识框架分为四个层次。第一层是误差建模:建立陀螺与加速度计的零偏、标度因数、安装误差模型,明确随机常值、一阶马尔可夫、随机游走等不同成分的统计描述,这是后续滤波的状态方程基础。第二层是初始对准:静基座下利用重力与地球自转角速度完成解析对准,动基座下借助外部参考完成传递对准,对准精度直接决定初始误差协方差。第三层是组合修正:以INS误差方程为状态方程,以DVL速度、深度计深度、USBL位置为量测,构建卡尔曼滤波器,讨论量测更新频率、时间同步、杆臂补偿与可观测性。第四层是工程验证:通过湖试或海试数据回放,检查残差统计、协方差一致性与航迹闭合误差。

为了让学习目标可检验,本课程建议以一套典型AUV组合导航配置作为贯穿案例:中低精度光纤陀螺(零偏约0.1°/h)、石英加速度计(零偏约1 mg)、DVL(对底速度精度约0.5%±2 mm/s)、深度计(精度0.1% FS)、USBL(定位精度约1%斜距)。学习者应能在课程结束时独立完成:写出15维误差状态方程、配置一套DVL/深度计组合的卡尔曼滤波、判断一次湖试数据中滤波器是否发散,并给出杆臂或时间延迟的排查结论。这些能力对应的正是误差建模、对准、组合修正与验证四个层次。

学习建议:每章动手前先明确"当前处理的是哪一类误差、它位于传播链的哪一环、用什么量测能观测它"。带着这三个问题读公式和代码,比单纯记忆滤波方程更有效。