基于组合滤波的低成本飞行器姿态解算算法

摘要 在低成本的飞行器姿态检测系统中，互补滤波器由于原理简单、计算量小，而被广泛应用。针对低成本飞行器在非匀速运动时因为加速度计不能区分重力加速度与运动加速度引起基于互补滤波的姿态解算误差较大的问题，提出了一种互补与自适应限幅组合滤波的姿态解算算法，并给出了自适应限幅滤波门阀的设计方法。通过融合陀螺仪输出的角速度与加速度计输出的加速度获取限幅滤波的限幅阀值；然后将归一化的加速度计输出增量通过限幅滤波的结果代替原互补滤波的加速度计输入，提高非匀速运动下姿态解算精度。经实际系统实时性能测试表明，所提算法估计精度高、计算量小，易于在低成本飞行器控制系统中实现