10.16208/j.issn1000-7024.2018.10.021
基于共轭梯度的EKF姿态估计算法
针对在低成本捷联惯性测量器件中,扩展卡尔曼姿态估计算法存在的精度低、抗干扰性弱等问题,提出一种基于共轭梯度的EKF姿态估计算法.以姿态四元数为状态量,在观测模型中将基于共轭梯度算法估计出来的姿态四元数作为观测量;将非重力运动加速度引入噪声协方差矩阵,实现噪声的自适应动态估计;采用倾角补偿的方法计算偏航角,提高飞行器姿态估计的精度和抗干扰能力.为验证所设计姿态估计算法的有效性,搭建基于ARM Cortex M4的四旋翼飞控系统,实验结果表明,该算法提高了姿态估计的精度以及四旋翼飞行器在非重力运动加速度和磁干扰下的抗干扰能力.
姿态估计、共轭梯度、扩展卡尔曼滤波、自适应动态噪声、倾角补偿
39
TP274(自动化技术及设备)
冶金自动化与检测技术教育部工程研究中心开放基金项目MADT201603
2018-11-06(万方平台首次上网日期,不代表论文的发表时间)
共8页
3118-3124,3161