自适应误差四元数无迹卡尔曼滤波四旋翼飞行器姿态解算方法

崔培林; 周翟和; 吕品; 胡斌

doi:10.7652/xjtuxb201903014

您当前的位置：

首页 >

文章列表页 >

自适应误差四元数无迹卡尔曼滤波四旋翼飞行器姿态解算方法

更新时间：2025-07-09

- 自适应误差四元数无迹卡尔曼滤波四旋翼飞行器姿态解算方法
- Adaptive Error Quaternion Unscented Kalman Filter Algorithm for Quadrotor Attitude Calculation
- 西安交通大学学报 2019年53卷第3期页码：97-102+110
- 作者机构：
  
  南京航空航天大学自动化学院,南京,211106
- 作者简介：
- 基金信息：
  
  : 2018-07-13。作者简介: 崔培林(1993—),男,硕士生;周翟和(通信作者),男,副教授。基金项目: 国家自然科学基金资助项目(61703207);航空科学基金资助项目(2017ZC52017)
- DOI：10.7652/xjtuxb201903014
  中图分类号： TP274
- 网络首发：2019-03-10，
  
  纸质出版：2019
- 稿件说明：
移动端阅览
崔培林, 周翟和, 吕品, 等. 自适应误差四元数无迹卡尔曼滤波四旋翼飞行器姿态解算方法[J]. 西安交通大学学报, 2019,53(3):97-102+110.

Adaptive Error Quaternion Unscented Kalman Filter Algorithm for Quadrotor Attitude Calculation[J]. 2019, 53(3): 97-102+110.
崔培林, 周翟和, 吕品, 等. 自适应误差四元数无迹卡尔曼滤波四旋翼飞行器姿态解算方法[J]. 西安交通大学学报, 2019,53(3):97-102+110. DOI： 10.7652/xjtuxb201903014.

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.

浏览量

下载量

CSCD

文章被引用时，请邮件提醒。

提交

工具集

关联资源

移动卫星通信低成本多传感器融合姿态估计方法

采用试验设计方法的第三代CO2气体箔轴承箔片几何参数敏感性分析

不同板叠材料热声热机能量转换过程数值模拟研究

扇贝仿生密封腔室内超临界二氧化碳泄漏流湍动能耗散机理研究

三塔合一间接空冷系统结构参数对夏季运行特性的影响研究