|
|
论文:2021,Vol:39,Issue(2):350-358 |
|
|
引用本文： |
|
|
杨跃, 刘小雄, 章卫国, 刘旭航, 郭一聪. 一种基于SVDCKF的无人机动态自适应航姿算法[J]. 西北工业大学学报 |
|
|
YANG Yue, LIU Xiaoxiong, ZHANG Weiguo, LIU Xuhang, GUO Yicong. A dynamic adaptive AHRS algorithm for UAV based on SVDCKF[J]. Northwestern polytechnical university |
|
|
|
|
|
|
|
| 一种基于SVDCKF的无人机动态自适应航姿算法 |
|
| 杨跃, 刘小雄, 章卫国, 刘旭航, 郭一聪 |
|
| 西北工业大学 自动化学院, 陕西 西安 710129 |
| 摘要: |
| 针对小型无人机在复杂飞行条件下的航姿解算精度和鲁棒性问题，提出了一种动态自适应调节的奇异值容积卡尔曼滤波航姿估计算法。考虑到低成本航姿传感器随机偏差大的问题，将航姿传感器随机偏差作为待估计参数，以消除传感器随机偏差的影响。由于无人机航姿模型的非线性和滤波中协方差矩阵的非正定问题，设计了一种融合容积卡尔曼滤波（cubature Kalman filter，CKF）和奇异值分解（singular value decomposition，SVD）的非线性航姿滤波器来改善航姿解算精度。另外考虑到不同的飞行条件下，航姿传感器中三轴加速度对无人机航姿解算的影响，基于自适应滤波的思想，提出了一种动态自适应因子来不断地调节加速度测量噪声方差，提高了航姿滤波在复杂条件下的鲁棒性。实验结果表明，所提算法不仅有效地改善了非线性航姿模型的航姿解算精度，满足小型无人机的飞行需求，而且消除了航姿传感器随机偏差和三轴加速度测量噪声对航姿解算的影响，提高了算法的鲁棒性和抗扰性。 |
| 关键词:
小型无人机
奇异值分解
容积卡尔曼滤波
低成本航姿传感器
动态自适应因子
|
|
| A dynamic adaptive AHRS algorithm for UAV based on SVDCKF |
|
| YANG Yue, LIU Xiaoxiong, ZHANG Weiguo, LIU Xuhang, GUO Yicong |
|
| School of Automation, Northwestern Polytechnical University, Xi'an 710129, China |
| Abstract: |
| Aiming at the attitude solution accuracy and robustness for small UAVs in complex flight conditions, this paper proposes a dynamic adaptive attitude and heading systems(AHRS) estimator with singular value decomposition Cubature Kalman filter(SVDCKF). Considering the problem of random bias for the low-cost attitude sensor, this paper designs a method that the sensor random bias is used as the state vector to eliminate the effect of the sensor random bias. Due to the non-linearity of small UAVs AHRS model and the non-positive definite phenomenon of the covariance matrix, a nonlinear AHRS filter combined with the Cubature Kalman filter and singular value decomposition is designed to improve the attitude solution accuracy. In addition, when the UAV flies in the different flight conditions, the three-axis acceleration of the attitude sensor will affect the attitude solution. Thus, a dynamic adaptive factor based on adaptive filtering is used to adjust continuously the acceleration noise variance to improve the robustness of the AHRS. The experimental results show that the method and algorithm proposed not only improve the attitude solution accuracy, and satisfy the flight requirements of small UAVs, but also eliminate the influence of the attitude sensor random bias and three-axis acceleration for the attitude solution to improve the proposed algorithm robustness and anti-interference. |
| Key words:
small UAVs
singular value decomposition
cubature Kalman filter
low-cost attitude sensor
dynamic adaptive factor
|
|
| 收稿日期: 2020-06-29
修回日期:
|
| DOI: 10.1051/jnwpu/20213920350 |
| 基金项目: 国家自然科学基金（61573286，62073266）与航空科学基金（201905053003）资助 |
| 通讯作者: 刘小雄(1973-),西北工业大学副教授,主要从事导航制导与控制研究。e-mail:liuxiaoxiong@nwpu.edu.cn。
Email：liuxiaoxiong@nwpu.edu.cn |
| 作者简介: 杨跃(1994-),西北工业大学博士研究生,主要从事无人机多传感器组合导航和视觉感知定位研究。
|
|
|
|
|
|
|
|
参考文献: |
|
|
[1] LASZLO B, AGOSTON R, XU Q. Conceptual approach of measuring the professional and economic effectiveness of drone applications supporting forest fire management[J]. Procedia Engineering, 2018, 211:8-17
[2] ESRAFILIAN O, GANGULA R, GESBERT D. Learning to communicate in UAV-aided wireless networks:map-based approaches[J]. IEEE Internet of Things Journal, 2018, 6(2):1791-1802
[3] KASHINO Z, NEJAT G, BENHABIB B. Multi-UAV based autonomous wilderness search and rescue using target isoprobability curves[C]//2019 International Conference on Unmanned Aircraft Systems, 2019:636-643
[4] WU J, ZHOU Z, FOURATI H, et al. Generalized linear quaternion complementary filter for attitude estimation from multisensor observations:an optimization approach[J]. IEEE Trans on Automation Science and Engineering, 2019, 16(3):1330-1343
[5] MEINHOLD R J, SINGPURWALLA N D. Understanding the Kalman filter[J]. The American Statistician, 1983, 37(2):123-127
[6] 王小旭, 潘泉, 黄鹤, 等. 非线性系统确定采样型滤波算法综述[J]. 控制与决策, 2012, 27(6):801-812 WANG Xiaoxu, PAN Quan, HUANG He, et al. Overview of deterministic sampling filtering algorithms for nonlinear system[J]. Control and Decision, 2012, 27(6):801-812(in Chinese)
[7] 宋宇, 翁新武, 郭昕刚. 基于四元数EKF算法的小型无人机姿态估计[J]. 吉林大学学报, 2015, 53(3):511-518 SONG Yu, WENG Xinwu, GUO Xingang. Small UAV attitude estimation based on the algorithm of quaternion extended kalman filter[J]. Journal of Jilin University, 2015, 53(3):511-518(in Chinese)
[8] YANG Y, LIU X, LIU X, et al. Multi-level variable dimension extended Kalman filter algorithm for UAV[C]//2019 Chinese Automation Congress, 2019:1615-1620
[9] WAN E A, VAN DER MERWE R. The unscented Kalman filter for nonlinear estimation[C]//Proceedings of the IEEE 2000 Adaptive Systems for Signal Processing, Communications, and Control Symposium, 2000:153-158
[10] ARASARATNAM I, HAYKIN S. Cubature Kalman filters[J]. IEEE Trans on Automatic Control, 2009, 54(6):1254-1269
[11] ARULAMPALAM M S, MASKELL S, GORDON N, et al. A tutorial on particle filters for online nonlinear/non-Gaussian Bayesian tracking[J]. IEEE Trans on Signal Processing, 2002, 50(2):174-188
[12] POURTAKDOUST S H, ASL H G. An adaptive unscented Kalman filter for quaternion-based orientation estimation in low-cost AHRS[J]. Aircraft Engineering and Aerospace Technology, 2007, 79(5):485-493
[13] CHOUKROUN D, BAR-ITZHACK I Y, OSHMAN Y. Novel quaternion Kalman filter[J]. IEEE Trans on Aerospace and Electronic Systems, 2006, 42(1):174-190
[14] ZHENBING Q I U, HUAMING Q, GUOQING W. Adaptive robust cubature Kalman filtering for satellite attitude estimation[J]. Chinese Journal of Aeronautics, 2018, 31(4):806-819 |
|
|
|
|
|
|
|
