约简二次扩展平方根容积卡尔曼滤波及其应用

doi:10.7527/S1000-6893.2014.0002

Abstract

Abstract:

The traditional nonaugmented cubature Kalman filter (CKF) fails to estimate the status of a nonlinear dynamic system because of its complex additive noises. By analyzing the accuracy of the nonaugmented and augmented cubature transformation, a reduction algorithm of twice augmented square-root CKF (RTA-SRCKF) is proposed based on the reduction of the augmented cubature points. The novel filter, by twice augmenting the process noise and the measurement noise respectively in the time-update and the measurement-update step, is suitable for estimating the states of the nonlinear dynamic system with complex additive noises. Without any loss of estimation accuracy, its complexity is simplified, the computational cost is reduced and real-time performance is also improved since its number of sampling points is greatly reduced. The theoretical analysis result is verified by the initial alignment simulation of the strapdown inertial navigation system (SINS) with large misalignment angles and the estimation accuracy of the azimuth misalignment angle is close to its limit precision in theory.

Key words: nonlinear filter, twice augmentation, square-root cubature Kalman filter, strapdown inertial navigation system, initial alignment, large misalignment angle, real-time performance

CLC Number:

V249.3
TN713

ZHAO Xijing, WANG Lixin, HE Zhikun, ZHANG Bo. Reducted Twice Augmented Square-root Cubature Kalman Filter and Its Application[J]. ACTA AERONAUTICAET ASTRONAUTICA SINICA, 2014, 35(8): 2286-2298.

References

[1] Sunahara Y. An approximate method of state estimation for nonlinear dynamical systems[J]. Journal of Fluids Engineering, 1970, 92(2): 385-393.

[2] Galkowski P J, Islam M A. An alternative derivation of modified gain function of song and speyer[J]. IEEE Transactions on Automatic Control, 1991, 36(11): 1323-1326.

[3] Sadeghi B, Moshiri B. Second-order EKF and unscented Kalman filter fusion for tracking maneuvering targets//IEEE International Conference on Information Reuse and Integration, 2007: 514-519.

[4] Gordon N J, Salmond D J, Smith A F M. Novel approach to nonlinear and non-Gaussian Bayesian state estimation[J]. IEE Proceedings F, Radar and Signal Processing 1993, 140(2): 107-113.

[5] Ito K, Xiong K Q. Gaussian filters for nonlinear filtering problems[J]. IEEE Transactions on Automatic Control, 2000, 45(5): 910-927.

[6] Nrgaard M, Poulsen N K, Ravn O. New developments in state estimation for nonlinear system[J]. Automatica, 2000, 36(11): 1627-1638.

[7] Julier S, Uhlmann J, Durrant-Whyte H F. A new method for the nonlinear transformation of means and covariances in filters and estimators[J]. IEEE Transactions on Automatic Control, 2000, 45(3): 477-482.

[8] Wu Y X. Research on dual-quaternion navigation algorithm and nonlinear Gaussian filtering. Changsha: National University of Defense Technology, 2005. (in Chinese) 武元新. 对偶四元数导航算法与非线性高斯滤波研究. 长沙: 国防科学技术大学, 2005.

[9] Arasaratnam I, Haykin S. Cubature Kalman filters[J]. IEEE Transactions on Automatic Control, 2009, 54(6): 1254-1269.

[10] Pesonen H, Piché R. Cubature-based Kalman filters for positioning//2010 7th Workshop on Positioning Navigation and Communication, 2010: 45-49.

[11] Mu J, Cai Y L, Zhang J M. Square root cubature particle filter[J]. Advanced Materials Research, 2011, 219-220: 727-731.

[12] Yan G M, Yan W S, Xu D M. Application of simplified UKF in SINS initial alignment for large misalignment angles[J]. Journal of Chinese Inertial Technology, 2008, 16(3): 253-264. (in Chinese) 严恭敏, 严卫生, 徐德民. 简化UKF滤波在SINS大失准角初始对准中的应用[J]. 中国惯性技术学报, 2008, 16(3): 253-264.

[13] Li P F, Yu J P, Wan M J, et al. The augmented form of cubature Kalman filter and quadrature Kalman filter for additive noise//IEEE Youth Conference on Information, Computing and Telecommunication, 2009: 295-298.

[14] Havlicek M, Jan J, Brazdil M, et al. Nonlinear estimation of BOLD signal based on cubature particle filter//3rd International Conference on Bio-inspired System and Signal Processing, 2010: 328-332.

[15] Wan E A, van der Merwe R. The unscented Kalman filter[M]//Kalman Filtering and Neural Networks. New York: John Wiley & Sons, Inc., 2001: 221-280.

[16] Sun F, Tang L J. Estimation precision comparison of cubature Kalman filter and unscented Kalman filter[J]. Control and Decision, 2013, 28(2): 303-308. (in Chinese) 孙枫, 唐李军. Cubature卡尔曼滤波与Unscented卡尔曼滤波估计精度比较[J]. 控制与决策, 2013, 28(2): 303-308.

[17] Zhou Z X, Gao Y N, Chen J B. Application of unscented Kalman filter for large misalignment errors in INS alignment[J]. Journal of System Simulation, 2006, 18(1): 173-175. (in Chinese) 周战馨, 高亚楠, 陈家斌. 基于无轨迹卡尔曼滤波的大失准角INS初始对准[J]. 系统仿真学报, 2006, 18(1): 173-175.

[18] Ding Y B, Shen G X. Study on unscented particle filter applied in initial alignment of large azimuth misalignment on static base of SINS[J]. Acta Aeronautica et Astronautica Sinica, 2007, 28(2): 397-401. (in Chinese) 丁杨斌, 申功勋. Unscented粒子滤波在静基座捷联惯导系统大方位失准角初始对准中的应用研究[J]. 航空学报, 2007, 28(2): 397-401.

[19] Hao Y L, Yang J W, Chen L, et al. Initial alignment of large azimuth misalignment based on square root central difference Kalman filter[J]. Journal of Chinese Inertial Technology, 2011, 19(2): 180-184. (in Chinese) 郝燕玲, 杨峻巍, 陈亮, 等. 基于平方根中心差分卡尔曼滤波的大方位失准角初始对准[J]. 中国惯性技术学报, 2011, 19(2): 180-184.

[20] Xiang L. Nonlinear filtering method and its application in navigation system. Harbin: Harbin Institute of Technology, 2009. (in Chinese) 向礼. 非线性滤波方法及其在导航中的应用研究. 哈尔滨: 哈尔滨工业大学, 2009.

Reducted Twice Augmented Square-root Cubature Kalman Filter and Its Application

PDF (PC)

Knowledge

Abstract

Cite this article

share this article

References

Related Articles 15

Recommended Articles

Metrics

Comments

[1]	Yifan GAO, Feng HE, Sifan YU. Online time-triggered scheduling method based on publish/subscribe architecture [J]. Acta Aeronautica et Astronautica Sinica, 2023, 44(18): 328125-328125.
[2]	FANG Anran, LI Dan, ZHANG Jianqiu. Nonlinear filter robust to outlier and unknown observation noise [J]. ACTA AERONAUTICAET ASTRONAUTICA SINICA, 2021, 42(7): 324675-324675.
[3]	YAN Wenxu, LAN Hua, WANG Zengfu, JIN Shuling, PAN Quan. Nonlinear filtering for spaceborne radars based on variational Bayes [J]. ACTA AERONAUTICAET ASTRONAUTICA SINICA, 2020, 41(S2): 724395-724395.
[4]	WANG Zhiwei, WANG Fengjie, DI Changchun, SHI Zhiyong, YANG Gongliu. Nonlinear alignment method for land SINS [J]. ACTA AERONAUTICAET ASTRONAUTICA SINICA, 2018, 39(1): 321554-321554.
[5]	GUO Qi, ZHOU Zhaofa, SUN Lijiang, XU Zihao, CHEN He. Size parameters identification and rotation project design for single-axis rotary SINS [J]. ACTA AERONAUTICAET ASTRONAUTICA SINICA, 2017, 38(10): 320841-320841.
[6]	LI Haijun, ZHAO Guorong, HUANG Jingli, ZHOU Dawang. A Spacecraft Attitude Estimation Method Based on NGA-QPF [J]. ACTA AERONAUTICAET ASTRONAUTICA SINICA, 2014, 35(6): 1694-1702.
[7]	GUO Ze, MIAO Lingjuan, ZHAO Hongsong. An Improved Strong Tracking UKF Algorithm and Its Application in SINS Initial Alignment Under Large Azimuth Misalignment Angles [J]. ACTA AERONAUTICAET ASTRONAUTICA SINICA, 2014, 35(1): 203-214.
[8]	HE Zhikun, LIU Guangbin, ZHAO Xijing, LIU Dong, ZHANG Bo. Adaptive Square-root Cubature Kalman Filter Algorithm Based on Gaussian Process Regression Models [J]. ACTA AERONAUTICAET ASTRONAUTICA SINICA, 2013, 34(9): 2202-2211.
[9]	XIE Yangguang, YI Guoxing, WANG Changhong, QU Yaobin. Application of Gauss-Hermite Filter in SINS Alignment [J]. ACTA AERONAUTICAET ASTRONAUTICA SINICA, 2012, (3): 554-560.
[10]	WANG Yuegang, YANG Jiasheng, YANG Bo. SINS Initial Alignment of Swaying Base Under Geographic Latitude Uncertainty [J]. ACTA AERONAUTICAET ASTRONAUTICA SINICA, 2012, 33(12): 2322-2329.
[11]	YANG Jing, JI Hongxia, WEI Mingkun. Error Analysis and Application of a Nonlinear Filter [J]. ACTA AERONAUTICAET ASTRONAUTICA SINICA, 2011, 32(8): 1469-1477.
[12]	Liu Jianye;Qian Weixing;Zeng Qinghua;Sun Qian. Rapid Transfer Alignment Method of Strapdown Navigation System Fitted in Targeting Pod [J]. ACTA AERONAUTICAET ASTRONAUTICA SINICA, 2010, 31(11): 2238-2244.
[13]	Qian Weixing;Liu Jianye;Li Rongbing;Zheng Zhiming. In-flight Rapid Alignment Method of INS/GNSS Integrated Navigation System [J]. ACTA AERONAUTICAET ASTRONAUTICA SINICA, 2009, 30(12): 2395-2400.
[14]	Gao Qingwei;Zhao Guorong;Wang Xibin;Wu Fang. Incorporate Modeling and Simulation of Transfer Alignment withFlexure of Carrier and Leverarm Effect [J]. ACTA AERONAUTICAET ASTRONAUTICA SINICA, 2009, 30(11): 2172-2177.
[15]	Cao Juanjuan;Fang Jiancheng;Sheng Wei;Tao Ye. Study and Application of Low-cost Multi-sensor Integrated Navigation for Small UAV Autonomous Flight [J]. ACTA AERONAUTICAET ASTRONAUTICA SINICA, 2009, 30(10): 1923-1929.