4. 传感器误差源分析

在水下机器人导航系统中,IMU、DVL、深度计、磁罗盘等传感器的输出误差往往不是单一来源,而是多种误差叠加的结果。若不能把误差拆开来看,标定就会变成“调参数碰运气”。本节把常见误差源按数学作用方式分类,并说明每类误差在标定与验收中如何被观测、被补偿、被判定。

一、误差的分类框架:确定性误差与随机误差

从标定角度,传感器误差首先分为两大类。确定性误差(系统误差)在相同输入下可重复出现,可以用参数模型描述并补偿,包括零偏、尺度因子误差、非正交/轴间耦合误差、安装误差。随机误差不可逐次复现,只能用统计特性描述,包括白噪声、随机游走、温漂中的随机成分。水下环境干扰则介于两者之间:它由外部物理场引起,具有一定的可建模性,但随任务环境变化。

以三轴加速度计为例,一个常用的确定性误差模型可写为:

a_meas = M · S · (a_true + b) + n
其中:
  b   —— 三轴零偏向量 (m/s²)
  S   —— 尺度因子对角阵,S = diag(sx, sy, sz)
  M   —— 非正交/轴间耦合矩阵(对角为1,非对角为小量)
  n   —— 随机噪声项

这个模型的价值在于:标定的任务就是估计 b、S、M 中的未知量,而验收的任务是检查补偿后残差是否落在指标内。下面逐项展开。

二、零偏:静止时的“假输出”

零偏是输入为零时传感器的非零输出。陀螺零偏表现为静止时仍有角速度读数,积分后直接变成姿态漂移;加速度计零偏在水平静止时表现为倾角解算偏差。零偏又分为常值零偏(turn-on bias)和零偏稳定性(bias instability),前者每次上电不同但一次任务内近似恒定,后者随时间缓慢变化。

工程上常用“六位置静置法”估计加速度计零偏:将IMU分别以±X、±Y、±Z六个方向朝上静置,每个位置采集30~60秒取均值,则每个轴的零偏可由正反两位置读数之和的一半得到,例如 b_x ≈ (a_x(+X) + a_x(−X))/2。陀螺零偏则在完全静止条件下取长时间均值,并同时记录 Allan 方差曲线以评估零偏稳定性。需要注意:静置时必须确认载体真正静止(例如放在减振垫上、远离电机与推进器),否则“零偏”里会混入振动与水流扰动。

三、尺度因子与非正交误差:增益不准与轴不正交

尺度因子误差指传感器输出与真实输入之间的比例偏差,典型来源是MEMS敏感元件的制造公差与温度相关增益变化。非正交误差指三个敏感轴不完全正交,导致某一轴的输入“泄漏”到另一轴。两者在数学上都表现为测量向量与真实向量之间的线性变换偏差,因此常被合称为“轴间误差矩阵”。

标定方法上,加速度计可用多位置翻转法,通过最小二乘拟合 3×3 矩阵与零偏;陀螺则常用转台提供已知角速率,或在无转台条件下利用重力矢量在不同姿态下的约束进行联合估计。一个可操作的判断是:标定后检查矩阵 M·S 的非对角项,若某非对角项绝对值超过 0.02(约1.1°轴间失准),应检查安装面是否平整、传感器是否松动,而不是继续用软件硬压。

四、噪声:白噪声与随机游走

噪声决定短时精度上限。白噪声用噪声密度描述(陀螺 °/s/√Hz,加速度计 m/s²/√Hz),随机游走用 Allan 方差曲线在斜率 +1/2 区段读取。实际标定中,噪声参数不通过“调”获得,而是通过静态数据统计:采集≥1小时静止数据,计算 Allan 偏差,取 τ=1s 处为噪声密度,取曲线谷底为随机游走。验收时应把噪声参数与滤波器设计匹配——若陀螺噪声密度为 0.01°/s/√Hz,而姿态滤波器带宽设为 50Hz,则理论姿态噪声约 0.07°,据此判断滤波器参数是否合理。

五、温漂与安装误差

温漂是零偏与尺度因子随温度的变化,MEMS陀螺尤为明显,典型量级可达 0.01~0.1°/s/℃。补偿方式是建立“温度—零偏”查找表或一阶线性模型,并在标定中做温箱阶梯升温试验(如 5℃→40℃,每5℃保温20分钟)。安装误差则是传感器敏感轴与载体坐标系之间的失准角,它会把载体的真实运动“看错方向”,在组合导航中表现为航向与速度的交叉耦合误差。安装误差通常与传感器轴间误差一起,通过整机多姿态标定联合估计。

六、水下环境干扰:被忽视的误差源

水下环境对传感器的影响具有场景特异性。DVL 在近底、浑水、气泡、鱼群附近会出现底跟踪丢失或跳变;磁罗盘受推进器大电流、船体铁磁材料与水下金属结构影响产生磁偏差;深度计受水温与盐度变化影响,压力—深度换算系数需按实际水域修正;IMU 则受载体振动与螺旋桨周期性激励影响,表现为高频噪声抬升。这类干扰无法靠单传感器标定消除,需要在验收中设计“环境复现”测试,例如在推进器满功率运行状态下采集磁罗盘数据,检查磁偏差是否超出阈值。

传感器误差源 → 标定手段 → 验收判据 误差源 零偏 b 静止非零输出 / 积分漂移 尺度因子 S 增益偏差 / 比例不准 非正交 M 轴间耦合 / 交叉泄漏 噪声 n 白噪声 / 随机游走 温漂 零偏/增益随温度变化 安装误差 敏感轴与载体轴失准 水下环境干扰 标定 / 补偿手段 六位置静置取均值 正反位置求和/2 多姿态最小二乘拟合 估计 3×3 矩阵与 b 联合估计 M·S 检查非对角项 < 0.02 Allan 方差统计 噪声密度 / 随机游走 温箱阶梯升温试验 建立温度—零偏查找表 整机多姿态联合标定 分离安装失准角 环境复现测试(满功率/浑水) 验收判据(示例阈值) 陀螺零偏稳定性 ≤ 0.05 °/s(1σ) 尺度因子残差 ≤ 0.5 % 轴间失准角 ≤ 1.0° 噪声密度 与滤波器带宽匹配 温漂补偿后残差 ≤ 0.02 °/s(5~40℃) 安装失准角 ≤ 0.5°(整机) 磁偏差 / 底跟踪有效率 注:右侧阈值为教学示例,实际验收指标应依据任务精度与传感器规格书确定

七、把误差源落到标定与验收动作上

理解误差源之后,标定流程应按“先确定性、后随机性、再环境”的顺序组织。第一步做静态零偏与噪声采集,确认传感器本身工作正常;第二步做多姿态翻转,估计零偏、尺度因子与非正交矩阵;第三步做温度试验,建立温漂补偿模型;第四步做整机安装标定,分离安装失准角;最后在真实水域或等效环境中做环境干扰复现测试。每一步都应保留原始数据与补偿前后残差,作为验收证据。

判断误差是否“标定干净”的一个实用方法:把补偿后的残差按时间画出来。若残差呈随机分布、均值接近零,说明确定性误差已被扣除;若残差仍有缓慢趋势,通常是温漂未补偿或零偏稳定性不足;若残差在特定动作(如推进器启动)时突跳,则应回到环境干扰与安装误差上排查。
常见误区:把安装误差当成零偏来“调”。安装失准角在载体转向时会表现为随姿态变化的等效零偏,若只用静止零偏补偿,运动中的航向误差会明显放大。正确做法是通过多姿态联合标定把安装矩阵单独估计出来,而不是用一组零偏去掩盖它。

综上,零偏、尺度因子、非正交误差、噪声、温漂、安装误差与水下环境干扰分别对应不同的数学作用位置和不同的标定手段。把它们分开建模、分开标定、分开验收,才能让后续的组合导航与验收指标有据可依,而不是把所有偏差笼统地归为“传感器不准”。