基于正交变换的五阶容积卡尔曼滤波导航算法

doi:10.3969/j.issn.1001-506X.2020.03.024

Abstract

Abstract:

In view of the problem that the high-order cubature Kalman filter has large high-order sampling error in high-dimension nonlinear systems, an orthogonal transformed fifth-order cubature Kalman filter (OT5-CKF) is proposed. Based on the orthogonality of the trigonometric function, the original cubature point is subjected to the appropriate volume transformation and brought into the Kalman filter model. The new cubature point can well avoid the high-order sampling error of high-dimension systems. Finally, the unmanned aerial vehicle integrated navigation system is used as the application background. The third-order CKF, fifth-order CKF and OT5-CKF are compared and analyzed. The results show that the filtering estimation accuracy of OT5-CKF is higher than others under the same observation conditions.

Key words: nonlinear filters, Kalman filters, orthogonal transformation, sampling error, integrated navigation

CLC Number:

TP242.6

Kanghui HE, Chaoyang DONG. Orthogonal transformed fifth-order cubature Kalman filter for navigation[J]. Systems Engineering and Electronics, 2020, 42(3): 680-685.

Figures/Tables 5

References 24

1	KALMAN R E . A new approach to linear filtering and prediction problems[J]. Journal of Basic Engineering Transactions, 1960, 82, 35- 45. doi: 10.1115/1.3662552
2	陆志毅, 李相平, 陈麒, 等. 基于粒子群优化的卡尔曼滤波去耦算法[J]. 系统工程与电子技术, 2018, 40 (4): 751- 755.
	LU Z Y , LI X P , CHEN Q , et al. Kalman filter decoupling algorithm based on particle swarm optimization[J]. Systems Engineering and Electronics, 2018, 40 (4): 751- 755.
3	许兆新, 李航洲, 李亮, 等. 基于EKF/SF的BDS短基线多径抑制方法[J]. 系统工程与电子技术, 2017, 39 (6): 1334- 1340.
	XU Z X , LI H Z , LI L , et al. EKF/SF-based short-baseline BDS multipath mitigation method[J]. Systems Engineering and Electronics, 2017, 39 (6): 1334- 1340.
4	JIANG T , SIDIROPOULOS N D , GIANNAKIS G B . Kalman filtering for power estimation in mobile communications[J]. IEEE Trans.on Wireless Communications, 2003, 2 (1): 151- 161. doi: 10.1109/TWC.2002.806386
5	JIANG Z , ZHOU W , LI H , et al. A new kind of accurate calibration method for robotic kinematic parameters based on the extended Kalman and particle filter algorithm[J]. IEEE Trans.on Industrial Electronics, 2018, 65 (4): 3337- 3345. doi: 10.1109/TIE.2017.2748058
6	DAVARI N , GHOLAMI A . An asynchronous adaptive direct Kalman filter algorithm to improve underwater navigation system performance[J]. IEEE Sensors Journal, 2017, 17 (4): 1061- 1068. doi: 10.1109/JSEN.2016.2637402
7	BO W , QIAN R , DENG Z , et al. A self-calibration method for nonorthogonal angles between gimbals of rotational inertial navigation system[J]. IEEE Trans.on Industrial Electronics, 2015, 62 (4): 2353- 2362. doi: 10.1109/TIE.2014.2361671
8	ZHAO X , WANG S C , LIAO S Y , et al. An ultra-tightly coupled tracking method based on robust adaptive cubature Kalman filter[J]. Acta Automatica Sinica, 2014, 40 (11): 2530- 2540.
9	GUPTA S D, YU J Y, MALLICK M, et al.Comparison of angle-only filtering algorithms in 3D using EKF, UKF, PF, PFF, and ensemble KF[C]// Proc.of the International Conference on Information Fusion, 2015: 1649-1656.
10	黄平, 孙婷婷, 仝彦龙. 基于自适应的单形采样UKF组合导航算法[J]. 系统工程与电子技术, 2018, 40 (7): 1567- 1572.
	HUANG P , SUN T T , TONG Y L . UKF integrated navigation algorithm based on adaptive simplex sampling[J]. Systems Engineering and Electronics, 2018, 40 (7): 1567- 1572.
11	COSTANZI R , FANELLI F , MELI E , et al. UKF-based navigation system for AUVs: online experimental validation[J]. IEEE Journal of Oceanic Engineering, 2018, 44 (3): 633- 641.
12	鲍水达, 张安, 毕文豪. 快速强跟踪UKF算法及其在机动目标跟踪中的应用[J]. 系统工程与电子技术, 2018, 40 (6): 1189- 1196.
	BAO S D , ZHANG A , BI W H . Speedy strong tracking unscented Kalman filter and its application in maneuvering target tracking[J]. Systems Engineering and Electronics, 2018, 40 (6): 1189- 1196.
13	秦永元, 张洪钺, 汪叔华. 卡尔曼滤波与组合导航原理[M]. 西安: 西北工业大学出版社, 2015.
	QIN Y Y , ZHANG H Y , WANG S H . Kalman filter and integrated navigation principle[M]. Xi'an: Northwest Polytechnic University Press, 2015.
14	WU Y , HU D , WU M , et al. A numerical-integration perspective on Gaussian filters[J]. IEEE Trans.on Signal Processing, 2006, 54 (8): 2910- 2921. doi: 10.1109/TSP.2006.875389
15	JIA B , XIN M , CHENG Y . High-degree cubature Kalman filter[J]. Automatica, 2013, 49 (2): 510- 518. doi: 10.1016/j.automatica.2012.11.014
16	SINGH A K, BHAUMIK S. Improved high-degree cubature Kalman filter[C]//Proc.of the IEEE Sensor Signal Processing for Defence, 2015. DOI: 10.1109/SSPD.2015.7288506.
17	MENG D , MIAO L , SHAO H , et al. A seventh-degree cubature Kalman filter[J]. Asian Journal of Control, 2018, 20 (1): 250- 262. doi: 10.1002/asjc.1537
18	MERWE R V D. Sigma-point Kalman filters for probabilistic inference in dynamic state-space models[M]. ResearchGate GmbH, 2004.
19	MARINA H G D . UAV attitude estimation using unscented Kalman filter and TRIAD[J]. IEEE Trans.on Industrial Electronics, 2011, 59 (11): 4465- 4474.
20	MAMMARELLA M , CAMPA G , NAPOLITANO M R , et al. Machine vision/GPS integration using EKF for the UAV aerial refueling problem[J]. IEEE Trans.on Systems Man and Cybernetics Part C (Applications and Reviews), 2008, 38 (6): 791- 801. doi: 10.1109/TSMCC.2008.2001693
21	TARHAN M , ALTU E . EKF based attitude estimation and stabilization of a quadrotor UAV using vanishing points in catadioptric images[J]. Journal of Intelligent & Robotic Systems, 2011, 62 (3/4): 587- 607.
22	WEN S , MIAO S , MA C , et al. Camera recognition and laser detection based on EKF-SLAM in the autonomous navigation of humanoid robot[J]. Journal of Intelligent & Robotic Systems, 2018, 92, 265- 277.
23	秦永元. 惯性导航[M]. 北京: 科学出版社, 2014.
	QIN Y Y . Inertial navigation[M]. Beijing: Science Press, 2014.
24	何康辉, 董朝阳, 王青. 一种考虑GPS信号中断的导航滤波算法[J]. 北京航空航天大学学报, 2019, 45 (9): 1874- 1881.
	HE K H , DONG C Y , WANG Q . A navigation filtering algorithm considering GPS signal interruption[J]. Journal of Beijing University of Aeronautics and Astronautics, 2019, 45 (9): 1874- 1881.

滤波算法	估计误差均方根值/m
三阶CKF	7.46
五阶CKF	4.25
OT5-CKF	2.96

[1]	Yingying JIANG, Shuguo PAN, Fei YE, Wang GAO, Chun MA, Hao WANG. Approach for detection of slowly growing fault based on robust estimation and improved AIME [J]. Systems Engineering and Electronics, 2022, 44(9): 2894-2902.
[2]	Yiping DONG, Ning LIU, Zhong SU, Jingxiao WANG, Hongyang BAI. Integrated navigation method of high-speed spinning flying bodybased on AEKF [J]. Systems Engineering and Electronics, 2022, 44(6): 1977-1983.
[3]	Wenhua LI, Lixin WANG, Qiang SHEN, Can LI, Zongshou WU. MEMS-INS/GNSS/VO integrated navigation method based on robust EKF [J]. Systems Engineering and Electronics, 2022, 44(6): 1994-2000.
[4]	Shuguang SUN, Qixin WEN. Aircraft height optimization algorithm of integrated navigation in terminal area based on height anomaly compensation [J]. Systems Engineering and Electronics, 2021, 43(9): 2612-2619.
[5]	Zhe WEN, Hongwei BIAN, Heng MA, Tao ZANG. Simulation test method of inertial navigation polar performance at middle and low latitudes [J]. Systems Engineering and Electronics, 2021, 43(9): 2620-2627.
[6]	Renjie ZHAO, Baiqing HU, Xu LYU, Jiayu TIAN. Filtering algorithm of UKF integrated navigation based on dual-Euler angles [J]. Systems Engineering and Electronics, 2021, 43(7): 1912-1920.
[7]	Baojie CAI, Lei SHAO. Robust filtering algorithm based on three discriminant domain and least squares fitting [J]. Systems Engineering and Electronics, 2021, 43(5): 1346-1353.
[8]	Jing SU, Huafeng HE, Yaomin HE, Yifan WANG, Xiaofei HAN. Filtering algorithm of missile-borne SINS/SAR integrated navigation considering SAR measurement characteristics [J]. Systems Engineering and Electronics, 2021, 43(4): 1044-1049.
[9]	Xu LYU, Baiqing HU, Yongbin DAI, Renjie ZHAO. Application of USQUE based on PSO in attitude estimation of integrated navigation [J]. Systems Engineering and Electronics, 2020, 42(6): 1366-1371.
[10]	Kaixin LUO, Meiping WU, Ying FAN. Robust adaptive filtering based on maximum entropy method and its application [J]. Systems Engineering and Electronics, 2020, 42(3): 667-673.
[11]	ZHANG Chuang, GUO Chen, ZHANG Daheng. Adaptive iterative particle filter and its application for ship integrated navigation [J]. Systems Engineering and Electronics, 2019, 41(4): 883-888.
[12]	DONG Ping, CHENG Jianhua, LIU Liqiang, MOU Hongjie. INS/USBL nonlinear integrated navigation method based on observations of relative information [J]. Systems Engineering and Electronics, 2019, 41(2): 402-408.
[13]	GE Baoshuang, ZHANG Hai, JIN Yanqiong. Redundant measurement based method for online mitigation of GNSS multipath errors [J]. Systems Engineering and Electronics, 2019, 41(11): 2581-2587.
[14]	CHENG Jianhua, FAN Shilong, LI Liang, DONG Ping. Time synchronization technology of integrated navigation based on measurement correction [J]. Systems Engineering and Electronics, 2019, 41(10): 2328-2333.
[15]	GAO Junqiang, TANG Xiaqing, ZHANG Huan, WU Meng. Vehicle INS/GNSS/OD integrated navigation algorithm based on factor graph [J]. Systems Engineering and Electronics, 2018, 40(11): 2547-.

Orthogonal transformed fifth-order cubature Kalman filter for navigation

RichHTML

PDF (PC)

Knowledge

Abstract

Cite this article

share this article

Figures/Tables 5

References 24

Related Articles 15

Recommended Articles

Metrics

Comments