基于指数平滑滤波与边界约束的车载IMU零速检测方法与流程

摘要: 本发明涉及组合导航,尤其涉及一种基于指数平滑滤波与边界约束的车载imu零速检测方法。背景技术:1、基于微机电系统(micro-electro-mechanica...
基于指数平滑滤波与边界约束的车载IMU零速检测方法与流程

本发明涉及组合导航,尤其涉及一种基于指数平滑滤波与边界约束的车载imu零速检测方法。

背景技术:

1、基于微机电系统(micro-electro-mechanical system,mems)的惯性测量单元(inertial measurement unit,imu)具有体积小、成本低、功耗低等优势,已广泛应用于车载组合导航系统。在全球导航卫星系统(global navigation satellite system,gnss)信号良好时,车辆可通过gnss/ins组合导航获得高精度定位结果;然而,当车辆行驶于隧道、地下车库、城市峡谷等gnss信号拒止环境时,纯惯性导航的误差随积分操作迅速发散,数秒内即可产生米级甚至十米级的位置漂移。为抑制导航误差发散,利用车辆在交通信号灯、拥堵停车等短暂静止时段进行零速更新(zero velocity update,zupt)是一种行之有效的技术手段。零速更新的核心前提在于准确识别车辆静止状态,即零速检测。零速检测的性能直接决定了zupt修正的有效性,进而影响整个导航系统在gnss信号拒止期间的定位精度。

2、在车载环境中,零速检测面临诸多独特挑战。车辆静止时,发动机怠速会产生持续的低频振动,路面不平导致的残余晃动以及传感器自身噪声均会使imu输出呈现非零波动。传统固定阈值检测方法(如加速度滑动方差检测器)难以适应上述动态噪声环境,往往导致误检或漏检。近年来,研究人员提出了多种自适应零速检测方法,其中基于统计量特征的自适应阈值方法因其结构简单、无需人工预设阈值而受到关注。该类方法通过实时分析imu各轴方差等统计量的历史信息(如跟踪窗口内的最小值),并乘以固定安全系数生成动态阈值,实现了对传感器噪声基底的自动跟随。然而,实际工程应用表明,该类方法存在阈值阶跃跳变后单向锁死的问题,严重制约其在车载复杂工况下的稳定性和可靠性。

3、与本发明最接近的现有技术为基于统计量特征的自适应阈值方法。该技术方案的核心流程如下:首先,以固定长度滑动窗口逐轴计算imu六轴(三轴加速度计、三轴陀螺仪)的方差时序序列;其次,持续跟踪每个轴从系统上电至今的全局最小方差,将该最小值作为噪声基底基准;然后,根据预设的安全系数(通常取1.2~1.5)乘以该基准,生成各轴的动态判决阈值;最后,将当前窗口方差与动态阈值进行比较,判定车辆是否处于静止状态。该类算法的关键特征在于:阈值完全由历史统计量(如最小方差)自适应生成,无需人工设定初始阈值;算法仅在检测到更小方差时下调阈值,阈值变化方向为单向收敛。该技术方案在静态实验室环境或理想静止条件下能够取得较好的检测效果,且计算量小、易于嵌入式实现。

4、然而,上述现有技术存在阈值阶跃跳变后单向锁死的突出问题,难以直接应用于车载复杂工况。具体而言,当滑动窗口偶然出现一个极小的方差值时,全局最小方差基准瞬时跳变为该极小值,导致动态阈值发生阶跃式突变;同时,由于全局最小方差序列具有单调非增特性,阈值一旦跳变至极小值便被锁定在该水平,无法随噪声环境升高而自动回升。当传感器经历极低噪声工况后,发动机产生正常振动时,所有窗口方差均大于被锁定的极小基准,导致动态阈值始终低于实际噪声水平,算法永久失去检测静止状态的能力。若要人为设置阈值重新上升的条件,不仅需要额外手动设定多个参数,而且系统的鲁棒性也会明显降低,进一步限制了该类方法的工程实用性。上述缺陷使得现有基于统计量特征的自适应阈值方法在车载环境下的工程应用受到严重限制。

5、综上所述,现有的技术普遍存在以下缺陷:阈值阶跃跳变后单向锁死导致零速检测失效且无法恢复,难以满足实际应用的需求。

技术实现思路

1、本发明提供一种基于指数平滑滤波与边界约束的车载imu零速检测方法,用以解决现有技术中阈值阶跃跳变后单向锁死导致零速检测失效且无法恢复的缺陷。

2、第一方面,本发明提供一种基于指数平滑滤波与边界约束的车载imu零速检测方法,包括:

3、基于滑动窗口逐轴计算惯性测量单元六轴数据的实时方差,持续跟踪各轴的历史最小方差作为噪声基底基准,以所述噪声基底基准为依据自适应确定各轴的动态平稳波动范围,用于筛选车辆疑似静止时段;

4、采用一阶指数平滑滤波对所述历史最小方差基准进行加权迭代更新,以消除因窗口随机极小值引起的基准阶跃跳变,对平滑更新后的基准施加预设的上下边界约束,以防止基准向下单向锁死或向上长期漂移,实现基准的双向自适应调整;

5、根据加速度计与陀螺仪的噪声特性差异,分别为各轴设置自适应系数,结合所述平滑约束后的基准生成各轴的动态判决阈值,根据当前全局噪声水平动态调整多轴表决门限,将各轴判决结果进行联合表决,完成车辆静止状态判定并输出静态数据。

6、根据本发明提供的基于指数平滑滤波与边界约束的车载imu零速检测方法,所述逐轴计算惯性测量单元六轴数据的实时方差包括:

7、以固定长度滑动窗口截取各轴连续采样数据,计算窗口内各轴数据的样本方差,其中所述样本方差用于表征窗口内信号的波动程度,方差越小表明传感器状态越接近理想静止。

8、根据本发明提供的基于指数平滑滤波与边界约束的车载imu零速检测方法,所述持续跟踪各轴的历史最小方差作为噪声基底基准包括:

9、自系统上电时刻起,将各轴当前窗口方差与在此之前记录的历史最小方差进行比较,若当前窗口方差更小则以当前窗口方差替换历史最小方差,否则保持历史最小方差不更新;

10、所述历史最小方差对应于传感器经历的最优静止工况。

11、根据本发明提供的基于指数平滑滤波与边界约束的车载imu零速检测方法,所述采用一阶指数平滑滤波对所述历史最小方差基准进行加权迭代更新包括:

12、将当前窗口的原始历史最小方差与上一窗口平滑基准按预设平滑因子进行凸组合;

13、其中,所述平滑因子控制历史数据权重衰减速率,使得平滑基准以渐近形式跟踪原始最小方差序列,而非瞬时跳变至新值。

14、根据本发明提供的基于指数平滑滤波与边界约束的车载imu零速检测方法,所述对平滑更新后的基准施加预设的上下边界约束包括:

15、设置下限阈值,所述下限阈值取传感器本底噪声方差的物理最小值,防止基准衰减至零或负值;

16、设置上限阈值,所述上限阈值取初始基准的预设倍数或根据传感器量程设定的合理最大方差值,防止基准无限增长;

17、经边界约束后,基准始终处于闭区间内。

18、根据本发明提供的基于指数平滑滤波与边界约束的车载imu零速检测方法,所述根据加速度计与陀螺仪的噪声特性差异分别为各轴设置自适应系数包括:

19、为加速度计各轴设置第一系数值,为陀螺仪各轴设置第二系数值,所述第一系数值和所述第二系数值分别根据加速度计和陀螺仪的量纲差异及对运动灵敏度的不同特性预先设定,无需在线标定。

20、根据本发明提供的基于指数平滑滤波与边界约束的车载imu零速检测方法,所述根据当前全局噪声水平动态调整多轴表决门限包括:

21、将加速度计三轴平滑基准的均值与标称静止方差参考值进行比较,当所述均值显著小于所述参考值时,表决门限设置为要求三轴全部通过;

22、当所述均值接近或超过所述参考值时,表决门限自动降低,以避免因噪声水平升高导致的漏检。

23、根据本发明提供的基于指数平滑滤波与边界约束的车载imu零速检测方法,所述输出静态数据包括:

24、将满足静止判定条件的窗口内原始惯性测量单元数据标记为高质量静态数据段,输出至惯性测量单元安装角标定模块或零速修正模块,用于后续导航误差校正。

25、第二方面,本发明还提供一种基于指数平滑滤波与边界约束的车载imu零速检测系统,包括:

26、统计与跟踪模块,用于基于滑动窗口逐轴计算惯性测量单元六轴数据的实时方差,持续跟踪各轴的历史最小方差作为噪声基底基准,以所述噪声基底基准为依据自适应确定各轴的动态平稳波动范围,用于筛选车辆疑似静止时段;

27、平滑与约束模块,用于采用一阶指数平滑滤波对所述历史最小方差基准进行加权迭代更新,以消除因窗口随机极小值引起的基准阶跃跳变,对平滑更新后的基准施加预设的上下边界约束,以防止基准向下单向锁死或向上长期漂移,实现基准的双向自适应调整;

28、表决判决模块,用于根据加速度计与陀螺仪的噪声特性差异,分别为各轴设置自适应系数,结合所述平滑约束后的基准生成各轴的动态判决阈值,根据当前全局噪声水平动态调整多轴表决门限,将各轴判决结果进行联合表决,完成车辆静止状态判定并输出静态数据。

29、第三方面,本发明还提供一种电子设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述程序时实现如上述任一种所述基于指数平滑滤波与边界约束的车载imu零速检测方法。

30、本发明提供的基于指数平滑滤波与边界约束的车载imu零速检测方法,针对车载零速检测中阈值阶跃跳变与单向锁死问题,提出指数平滑滤波与边界约束机制,实现基准平滑更新与双向自适应;采用分轴自适应系数与动态多轴表决,免人工标定。算法计算轻量,显著提升复杂工况下零速检测稳定性与鲁棒性,适于嵌入式实时应用。