多旋翼无人机自适应DUKF姿态估计算法

简介

为解决存在外部加速度和外部电磁场干扰的多旋翼无人机姿态估计问题,首先以四元数为参数建立姿态估计模型,然后使用一种解算精度高、计算量较小的衍生无迹卡尔曼滤波算法(DUKF),在量测更新阶段引入根据残差构造加速度计和磁力计的噪声协方差的自适应策略,提出一种基于DUKF的多旋翼无人机自适应姿态估计算法。通过使用PIXHAWK飞控的数据进行相关的仿真实验,实验表明,所提算法能极大的减小外部加速度和外部电磁场对多旋翼无人机姿态估计的干扰。