基于四元数SRCKF-SLAM算法的植保无人机姿态估计

Attitude estimation for plant protect UAV based on quaternion SRCKF-SLAM algorithm

  • 摘要: 以传统四元数作为飞行器非线性状态模型描述参数,进行姿态估计时存在精度不足问题,提出了一种基于四元数的平方根容积卡尔曼滤波算法。该算法以姿态四元数误差及陀螺仪漂移误差为状态量,以SINS/SLAM组合导航的姿态四元数为观测量,并采用平方根容积卡尔曼滤波算法进行姿态估计,既解决了传统四元数的规范化问题,又降低了传统四元数的平方根UKF算法的状态维数及复杂度,提高了数值稳定性。与四元数SRUKF、四元数SRCDKF算法比较,仿真实验结果表明新算法估计横滚角、俯仰角、偏航角误差均值分别为231,误差均最小,且算法精度较四元数SRUKF-SLAM算法提高了约30%,具有较高的滤波精度及数值稳定性,计算效率最优。

     

    Abstract: The traditional quaternion served as the description parameter of the nonlinear state model of the UAV, and the accuracy of the attitude estimation was presented. A square-root cubature Kalman filter algorithm based on quaternion was proposed. The algorithm took the attitude quaternion error and the gyro drift error as the state quantities, and measured the attitude quaternion of SINS/SLAM navigation. The square root cubature Kalman filter algorithm was used for pose estimation, which not only can solve the normalization issue of traditional quaternion, but also can reduce the state dimension and computational complexity of the square-root UKF algorithm of traditional quaternion and improve the numerical stability. Compared with the quaternion-based SRUKF and quaternion SRCDKF algorithm, the simulation results showed that the new algorithm estimated the error mean values of the roll angle, pitch angle and yaw angle, which were 2,31, respectively. The errors were the smallest, and algorithm’s accuracy was about 30% higher than that of the quaternion SRUKF-SLAM algorithm, and it exhibited high filtering accuracy and numerical stability and the lowest computational cost.

     

/

返回文章
返回