Adaptive Error Quaternion Unscented Kalman Filter Algorithm for Quadrotor Attitude Calculation

doi:10.7652/xjtuxb201903014

您当前的位置：

首页 >

文章列表页 >

Adaptive Error Quaternion Unscented Kalman Filter Algorithm for Quadrotor Attitude Calculation

更新时间：2025-07-09

- Adaptive Error Quaternion Unscented Kalman Filter Algorithm for Quadrotor Attitude Calculation
- Vol. 53, Issue 3, Pages: 97-102+110(2019)
- 作者机构：
  
  南京航空航天大学自动化学院,南京,211106
- 作者简介：
- 基金信息：
- DOI：10.7652/xjtuxb201903014
  CLC： TP274
- Online First：10 March 2019，
  
  Published：2019
- 稿件说明：
移动端阅览
Adaptive Error Quaternion Unscented Kalman Filter Algorithm for Quadrotor Attitude Calculation[J]. 2019, 53(3): 97-102+110.
DOI：

Adaptive Error Quaternion Unscented Kalman Filter Algorithm for Quadrotor Attitude Calculation[J]. 2019, 53(3): 97-102+110. DOI： 10.7652/xjtuxb201903014.

摘要

针对小型四旋翼飞行器在姿态解算时

使用的惯性器件在飞行器起飞、下降等过程中容易受到非重力加速度影响的问题

提出了一种自适应误差四元数无迹卡尔曼滤波的飞行器姿态解算方法。该方法在传统无迹卡尔曼滤波算法的基础上

结合陀螺仪漂移误差模型

使用误差四元数的方法构建无迹卡尔曼滤波的状态方程

选用加速度计和磁强计的输出作观测量

利用其构建无迹卡尔曼滤波的量测方程

并通过自适应调整量测噪声协方差矩阵

减小非重力加速度对姿态解算的影响。实验表明

当飞行器存在非重力加速度时

该方法可以有效减小非重力加速度影对姿态解算的影响。

Abstract

In view of the attitude calculation of a small quadrotor

the inertial device is easily affected by the acceleration of non-gravity during taking-off and landing. A new attitude calculation algorithm of quadrotor with adaptive error quaternion unscented Kalman filter is proposed. Following the traditional unscented Kalman filter algorithm

this algorithm combines the gyroscope drift error model and chooses the error quaternion to construct the state equation of the unscented Kalman filter. The measurement equation of the unscented Kalman filter is constructed by using the output signal of accelerometer and magnetometer. Adjusting the noise covariance matrix adaptively

the influence of non-gravity acceleration on attitude calculation is reduced. Experiment shows that when the quadrotor has non gravity acceleration

the algorithm can effectively reduce the influence of non-gravity acceleration shadow on the attitude calculation.

关键词

Keywords

references

楚仕彬, 袁亮. 小型四旋翼无人机姿态测量仿真研究 [J]. 计算机仿真, 2015, 32(2): 67-73.

CHU Shibin, YUAN Liang. Study on measurement and simulation of the low cost and compact four rotor UAV [J]. Computer Simulation, 2015, 32(2): 67-73.

CASTELLANOS C A, PICO L E A. Design and simulation of an attitude determination system based on the extended Kalman filter for Cube-Sat Colombia I [J]. Revista Facultad de Ingenieria-Universidad de Antioquia, 2014, 70: 146-154.

LI H, SUN Z W, ZHANG S J. Satellite Attitude estimation UKF algorithm based on star-sensor [C]∥Proceedings of the Multiconference on Computational Engineering in Systems Applications. Piscataway, New Jersey, USA: IEEE, 2007: 799-802.

薛亮, 姜澄宇, 常洪龙, 等. 基于状态约束的MIMU/磁强计组合姿态估计滤波算法 [J]. 中国惯性技术学报, 2009, 17(3): 338-343.

XUE Liang, JIANG Chengyu, CHANG Honglong, et al. MIMU/magnetometer integrated attitude estimation filtering algorithm based on state constraints [J]. Chinese Journal of Inertial Technology, 2009, 17(3): 338-343.

CHOUKROUN D, BAR-ITZHACK I Y, OSHMAN Y. Novel quaternion Kalman filter [J]. IEEE Transactions on Aerospace Electronic Systems, 2002, 42(1): 174-190.

LEFFERTS E J, MARKLEY F L, SHUSTER M D. Kalman filtering for spacecraft attitude estimation [J]. Journal of Guidance Control and Dynamics, 2012, 5(4): 536-542.

HALL J K, KNOEBEL N B, MCLAIN T W. Quaternion attitude estimation for miniature air vehicles using a multiplicative extended Kalman filter [C]∥Proceedings of IEEE/ION Position, Location and Navigation Symposium. Piscataway, New Jersey, USA: IEEE, 2008: 1230-1237.

FILIPE N, KONTITSIS M, TSIOTRAS P. Extended Kalman filter for spacecraft pose estimation using dual quaternions [C]∥Proceedings of 2015 American Control Conference. Piscataway, New Jersey, USA: IEEE, 2015: 3187-3192.

周卫东, 乔相伟, 任蕾, 等. QUKF算法及其在SINS初始对准中的应用 [J]. 仪器仪表学报, 2010, 31(2): 264-269.

ZHOU Weidong, QIAO Xiangwei, REN Lei, et al. QUKF algorithm and its application in SINS initial alignment [J]. Chinese Journal of Scientific Instrument, 2010, 31(2): 264-269.

乔相伟, 周卫东, 吉宇人. 用四元数状态切换无迹卡尔曼滤波器估计的飞行器姿态 [J]. 控制理论与应用, 2012, 29(1): 97-103.

QIAO Xiangwei, ZHOU Weidong, JI Yuren. Aircraft attitude estimation using quaternion state switching unscented Kalman filter [J]. Control Theory and Application, 2012, 29(1): 97-103.

SUH Y S. Orientation estimation using a quaternion-based indirect Kalman filter with adaptive estimation of external acceleration [J]. IEEE Transactions on Instrumentation Measurement, 2010, 59(12): 3296-3305.

MARINS J L, YUN X, BACHMANN E R, et al. An extended Kalman filter for quaternion-based orientation estimation using MARG sensors [C]∥Proceedings of 2001 International Conference on Intelligent Robots and Systems. Piscataway, New Jersey, USA: IEEE, 2002, 4: 2003-2011.

CREAMER G. Spacecraft attitude determination using gyros and quaternion measurements [J]. Journal of the Astronautical Sciences, 1996, 44(3): 357-371.

张静, 金志华. 空中平台航姿参考系统的设计 [J]. 中国惯性技术学报, 2004, 12(2): 47-52.

ZHANG Jing, JIN Zhihua. Design of aerial platform attitude reference system [J]. Chinese Journal of Inertial Technology, 2004, 12(2): 47-52.

CRASSIDIS J L, MARKLEY F L. Unscented filtering for spacecraft attitude estimation [J]. Journal of Guidance, Control, and Dynamics, 2003, 26(4): 536-542.

ZHANG L, YANG H, LU H, et al. Cubature Kalman filtering for relative spacecraft attitude and position estimation [J]. Acta Astronautica, 2014, 105(1): 254-264.

LEEGHIM H, CHOI Y, JAROUX B A. Uncorrelated unscented filtering for spacecraft attitude determination [J]. Acta Astronautica, 2010, 67(1): 135-144.

GARCIA R V, NICHOLAS D F O M, KUGA H K, et al. Unscented Kalman filter for spacecraft attitude estimation using modified Rodrigues parameters and real data [J]. Computational and Applied Mathematics, 2016, 35(3): 835-846.

BAE J, KIM Y. Nonlinear estimation for spacecraft attitude using decentralized unscented information filter [C]∥International Conference on Control, Automation and Systems. Piscataway, NJ, USA: IEEE, 2010: 1562-1566.

GARCIA R V, KUGA H K, ZANARDI M C F P S. Unscented Kalman filter applied to the spacecraft attitude estimation with Euler angles [J]. Mathematical Problems in Engineering, 2012(1): 161-174.

Views

下载量

CSCD

Alert me when the article has been cited

提交

Tools

Publicity Resources

An Attitude Estimation Method Using Multi-Sensor Fusion for Low-Cost Mobile Satellite Communication

Research on the Electrohydrodynamic Effects of Ionic Liquid-Modified Fuels

Windage Loss and Flow Characteristics in Impeller Back Gaps of sCO2 Radial Inflow Turbines

Study on the Thermodynamic Properties in the Anomalous Region of Supercritical Water

Sensitivity Analysis of Foil Geometrical Parameters for the Third-Generation CO2 Gas Foil Bearings Based on Design of Experiments Method

Related Author

伍宗伟 1

姚敏立 1

马红光 1

贾维敏 1

田方浩 1

Related Institution

Staff Room 403,The Second Artillery Engineering University

The 96265th Unit of PLA

⁰