科研之友
微信
新浪微博
Facebook
分享链接
摘要
针对低成本微机电系统(MEMS)惯性测量器件易发散,单一的姿态估计算法存在精度低、抗干扰性弱等问题,提出了一种动态权值共轭梯度法与自适应互补滤波融合的姿态估计算法。该算法在共轭梯度算法中加入动态权值,根据载体运动加速度大小对权值进行动态调整,消除运动加速度对姿态估计的不利影响;将加速度计的输出采用动态权值共轭梯度法估计出姿态四元数,并将其与陀螺仪的输出通过自适应互补滤波算法融合以减小惯性测量单元(IMU)的漂移和噪声干扰,提高微型四旋翼飞行器姿态估计的跟踪精度。为了验证所设计算法的可行性和有效性,搭建了基于STM32单片机的四旋翼飞行器实验平台,实验结果表明该算法提高了姿态估计的跟踪精度以及非重力运动加速度干扰下的抗干扰能力。
- 单位
