基于变增益互补滤波的FADS/INS融合方法

摘要

针对嵌入式大气数据传感(FADS)系统与惯性导航系统(INS)组合滤波计算攻角/侧滑角时,机动飞行和平飞时对滤波常数的大小需求不一致的问题,提出一种滤波常数能够随着飞行状态自适应调整的变增益互补滤波算法。算法可以随着飞行状态的变化,改变滤波常数τ,保持整个飞行阶段具有更好的攻角融合结果,以提高角度的估计精度。同时将测压孔分组计算攻角,对攻角的延迟进行检测,若延迟过大,则判定为该组攻角失效。仿真结果表明:提出的滤波算法能保持整个飞行阶段内的攻角/侧滑角估计结果误差不超过0.2°,并且相比于固定增益互补滤波器,变增益互补滤波的估计误差更小。