3. 传感器故障模式
在融合定位系统中,GNSS、IMU、轮速计、激光雷达、视觉相机等传感器共同提供位置、速度、姿态与观测约束。任何一路传感器出现异常,都会通过融合滤波器或优化器传播到最终定位结果。因此,故障检测与隔离(FDI)的第一步,不是急着设计算法,而是把“故障长什么样、从哪里来、会怎样影响定位”讲清楚。本章围绕故障分类、常见故障原因以及故障对定位的影响三条主线展开,为后续残差构造、阈值设计和隔离策略奠定基础。
一、故障分类:硬故障、软故障与间歇故障
工程上最常用的分类方式是按故障的时间形态与幅值特征划分,分为硬故障、软故障和间歇故障。三类故障在检测难度、隔离策略和对定位的影响上差异明显。
- 硬故障(Hard Fault):传感器输出突然跳变、完全失效或卡死在某一固定值,例如GNSS接收机失锁后输出无效定位、IMU某轴输出饱和、轮速计断线。其特征是幅值大、变化快,通常容易被残差突变检测捕获。
- 软故障(Soft Fault):输出仍“看起来正常”,但逐渐偏离真实值,典型如零偏缓慢漂移、标度因数误差、安装角缓慢变化。软故障幅值小、演化慢,容易被滤波器当作真实运动吸收,是FDI中最危险的一类。
- 间歇故障(Intermittent Fault):故障时有时无,表现为随机丢包、偶发跳变、短时卡死后恢复。它既不像硬故障那样持续,也不像软故障那样平滑,容易造成检测统计量反复越限又恢复,导致误隔离或漏隔离。
二、常见故障原因:从漂移、偏差到丢包
故障分类描述的是“表现”,故障原因描述的是“来源”。同一类表现可能由多种原因引起,定位工程师需要建立“现象—原因—可观测特征”的对应关系。
| 故障现象 | 典型原因 | 可观测特征 | 常见传感器 |
|---|---|---|---|
| 漂移 | 零偏不稳定、温漂、老化 | 残差缓慢单调增大 | IMU、轮速计 |
| 偏差 | 标定不准、安装角误差 | 残差存在稳定偏置 | IMU、相机、LiDAR |
| 卡死 | 接口冻结、驱动死锁 | 输出方差趋零、残差恒定 | GNSS、轮速计 |
| 噪声异常 | 电磁干扰、振动、多路径 | 方差突增、残差抖动 | GNSS、IMU、LiDAR |
| 丢包 | 通信中断、时间同步失败 | 时间戳间隔异常、数据缺失 | GNSS、相机、轮速计 |
除表中五类外,还有两类常被忽视的原因:其一是时间同步故障,例如GNSS秒脉冲丢失导致IMU与GNSS时间基准错位,表现为定位结果在转弯或加速时出现规律性偏差;其二是坐标系与标定故障,例如外参标定错误使LiDAR点云与地图整体偏移,残差呈现与运动方向相关的系统性误差。这两类故障往往不体现在单传感器自身输出上,而体现在融合残差的结构性变化中。
# 典型故障日志片段(示意)
[GNSS] status=FIX sats=12 hdop=0.8 # 正常
[GNSS] status=NOFIX sats=3 hdop=9.5 # 硬故障:失锁
[IMU ] gyro_z=0.002 rad/s temp=65C # 软故障:温漂
[WHEEL] speed=0.00 m/s tick=0 # 卡死:轮速计冻结
[CAM ] frame_id=1024 dt=0.31s # 间歇故障:丢包
三、故障对定位的影响分析
不同故障对定位的影响路径不同,理解影响机理才能判断“该不该隔离、隔离谁、隔离后如何降级”。
- 硬故障:若未被及时隔离,GNSS跳变会直接把位置解拉偏数十米;IMU饱和会使姿态在数秒内发散,进而污染速度与位置。影响特点是“快、大、可恢复”,隔离后通常能较快回到正常精度。
- 软故障:漂移和偏差会被滤波器逐步吸收,短时间内定位看似正常,但误差持续累积。例如IMU零偏漂移0.01°/s,在60秒内可造成约0.6°姿态误差,进而引起米级位置偏差。影响特点是“慢、隐蔽、难恢复”,需要依靠长期残差统计或外部观测约束才能发现。
- 间歇故障:丢包和偶发跳变会造成融合结果时好时坏,检测统计量反复越限,容易触发误隔离。若隔离逻辑过于激进,可能把正常传感器也剔除,导致系统降级过度;若过于保守,则故障数据持续进入融合,造成定位结果抖动。
四、案例与复盘:三类故障在同一场景中的表现
假设一辆低速无人车在城市峡谷中行驶,融合系统包含GNSS、IMU和轮速计。某次测试中出现以下现象:
- 车辆进入高楼遮挡区后,GNSS由FIX变为NOFIX,位置解在2秒内跳变约15米——这是硬故障,残差突变明显,应在确认后隔离GNSS,依靠IMU与轮速计短时递推。
- 行驶10分钟后,IMU温度由25℃升至65℃,陀螺零偏缓慢增大,航向角逐渐偏转——这是软故障,残差缓慢增大,需通过温补模型或长期统计检测识别。
- 轮速计在颠簸路段偶发丢包,速度观测时有时无,融合速度出现周期性抖动——这是间歇故障,需设置丢包计数与确认窗口,避免单次丢包即触发隔离。
复盘结论:三类故障应分别设计检测策略。硬故障用突变检测与幅值阈值;软故障用趋势检测、滑动窗口统计与温补模型;间歇故障用计数确认、滞回逻辑与恢复判据。隔离后还需评估系统可观测性,必要时降级输出并给出置信度,而不是简单停止定位。
综上,传感器故障模式分析是FDI工程的起点。只有把硬故障、软故障、间歇故障的形态差异,漂移、偏差、卡死、噪声异常、丢包等成因,以及它们对定位精度、连续性和可观测性的影响统一到一张“故障—原因—影响—策略”的认知框架中,后续的残差构造、阈值整定和隔离逻辑才能做到有的放矢。