%0 Journal Article %A 李永威 %A 刘晓平 %A 王刚 %A 赵云龙 %A 黎星华 %T 一种自适应混合滤波姿态解算算法 %D 2021 %R 10.13190/j.jbupt.2020-207 %J 北京邮电大学学报 %P 79-86 %V 44 %N 3 %X 针对低成本惯性测量器件采用基于滤波的姿态解算算法存在精度低、抗干扰性差等问题,提出了一种基于共轭梯度法与互补滤波相融合的自适应参数调节的混合滤波算法.该算法首先利用共轭梯度算法对加速度计和磁力计的数据进行姿态四元数的迭代估算,再通过互补滤波算法将陀螺仪更新的姿态与其进行信息融合,最后根据载体的运动状态自适应调节滤波参数,实现最优姿态估计.为验证所提算法的可行性和抗干扰性,与其他滤波融合算法在移动机器人平台上进行抗磁干扰和抗运动加速度干扰实验.实验结果表明,该算法可以有效地降低磁干扰和运动加速度干扰对姿态角解算的影响,其姿态角解算精度优于传统的梯度下降法、高斯牛顿法和共轭梯度法的滤波融合算法. %U https://journal.bupt.edu.cn/CN/10.13190/j.jbupt.2020-207