运动加速度抑制的动态步长梯度下降姿态解算算法

Attitude Estimation Algorithm of Motion Acceleration Restrained with Dynamic Step Gradient Descent

  • 摘要: 为了提高微型四旋翼飞行器在强机动、高速运动情况下的姿态解算性能,提出了一种对运动加速度抑制的动态步长梯度下降姿态融合算法.该算法对强机动运动过程中机体产生的运动加速度进行抑制处理,消除运动加速度对姿态解算的不利影响,提高了微型四旋翼飞行器姿态解算的跟踪精度;对高速运动过程中梯度下降法的梯度步长进行动态处理,使得算法步长与四旋翼飞行器的运动合角速度成正比,增强了微型四旋翼飞行器姿态解算的动态性能.为了验证本文所设计算法的可行性和有效性,基于STM32单片机搭建微型四旋翼实验平台系统.实时在线性能实验结果表明,所设计算法提高了微型四旋翼飞行器在强机动、高速运动情况下的姿态跟踪精度、动态性能及增强姿态融合算法的抗干扰性,保证了微型四旋翼飞行器的稳定飞行.

     

    Abstract: To improve the performance of a quadrotor's attitude estimation under strong maneuverability and high-speed motion, we propose an attitude estimation of motion acceleration restrained with dynamic step gradient descent algorithm. This algorithm restrains motion acceleration under strong maneuverability to remove the adverse effect of motion acceleration to improve the tracking accuracy of the quadrotor's attitude estimation. The algorithm uses dynamic gradient step processing under high-speed movement to make the gradient step proportional to the quadrotor's angle velocity and enhance the dynamic performance of orientation determination. To verify the feasibility and the effectiveness of the proposed algorithm, a quadrotor experimental platform is set up based on the STM32 microcontroller. Real-time online experimental results show that the proposed algorithm has higher estimation accuracy, better dynamic performance, and anti-interference characteristics under strong maneuverability and high-speed motion. Overall, the proposed algorithm ensures the stability of a quadrotor's flight.

     

/

返回文章
返回