[发明专利]一种无人机惯性测量单元角速度计鲁棒校准方法

说明书

一种无人机惯性测量单元角速度计鲁棒校准方法，无人机处于静止状态，采集角速度计输出数据，对三个轴向输出数据分别求取均值，作为各个轴向角速度测量的零漂误差，后采用粒子滤波算法进行无人机惯性测量单元角速度计校准。采用改进的粒子滤波算法进行无人机惯性测量单元角速度计鲁棒校准，该算法能够在正态分布统计样本受到野点数据干扰混入的情况下，准确无偏估计该正态分布的统计参数，因此，在校准过程中，如果无人机受到短暂的运动冲击，即使此时角速度传感器测量数据会作为野点数据混入校准采集数据中，也不会影响零漂误差的估计，从而提升校准准确度。

技术领域

本申请涉及无人机航空电子设备技术领域，尤其是涉及一种无人机惯性测量单元角速度计鲁棒校准方法。

背景技术

无人机技术已经开始向实用发展，各种无人机航电系统发展日趋成熟，功能也日趋完善，其中惯性测量单元(IMU)是无人机航电系统中测量飞行姿态的核心部件。陀螺仪(角速度计)及加速度计是IMU的主要部件，加速度计原理上可单独测量飞行姿态，但是加速度计受外力加速度影响很大，尤其在运动和振动的工作环境中，输出姿态角误差较大，如果融合陀螺仪(角速度计)测量的瞬时角速度量，就可以使系统数据更加稳定。然而，陀螺仪(角速度计)输出的角速度是瞬时量，需要角速度与时间积分计算角度，角速度计的零漂误差会随着时间推移产生积累，从而破坏测量精度，因此，准确估计陀螺仪(角速度计)的零漂误差对无人机飞行姿态测量系统的稳定工作意义重大。

目前无人机航电系统惯性测量单元(IMU)校准，特别是陀螺仪(角速度计)校准，需要无人机保持静止状态，将角速度计输出数据进行算术平均，均值作为角速度计的零漂误差。然而，在无人机野外工作环境中，由于受到各种环境干扰因素的影响，保持绝对的静止是很困难的，在校准过程中，如果无人机受到外力产生微小运动或振动，将会影响校准精度，导致校准前功尽弃，必须重新开始校准。因此，开发一种无人机惯性测量单元角速度计鲁棒校准方法非常有必要。

发明内容

为了解决现有技术中在校准过程中如果无人机受到外力产生微小运动或振动，将会影响校准精度，导致校准前功尽弃，必须重新开始校准的问题，本申请提供一种无人机惯性测量单元角速度计鲁棒校准方法，采用如下的技术方案：

一种无人机惯性测量单元角速度计鲁棒校准方法，采用粒子滤波算法进行无人机角速度计校准。

通过采用上述技术方案，提高无人机航电系统惯性测量单元角速度计校准的成功率和精度。

可选的，无人机处于静止状态，采集角速度计输出数据，对三个轴向输出数据分别求取均值，作为各个轴向角速度测量的零漂误差，后采用粒子滤波算法进行无人机惯性测量单元角速度计校准。

通过采用上述技术方案，能够避免无人机受到外力产生微小运动或振动对角速度计校准的影响。

可选的，所述粒子滤波算法包括以下具体步骤：

假设有一个测量样本集(x₁，x₂，…，x_n)被野点测量样本集污染，所述测量样本集{x₁，…，x_n}的分布为正态分布所述测量样本集和野点样集组合成总体样本，测量样本集在样本总体中所占的比例为1-α，野点测量样本集在样本总体中所占的比例为α，

则总体样本的混合分布为

粒子滤波算法校准过程为：

估计混合样本的均值μ₁、方差和非参数概率分布函数f_nonpara(x)；

选取一组估计参数(μ_j，σ_j)，对于所有测量样本点(x₁，x₂，…，x_n)计算包络因子