基于修正的自适应平方根容积卡尔曼滤波算法

doi:10.12305/j.issn.1001-506X.2021.07.13

Abstract

Abstract:

The uncertainty of target modeling will lead to the performance degradation of the filter algorithm, and the self-adaptability of the filter algorithm can be improved by constructing strong tracking filter (STF). However, there are limitations and deficiencies in the construction of STF, such as complex theoretical derivation and large amount of calculation. To solve the above problems, an adaptive square-root cubature Kalman filter (SRCKF) algorithm based on amending is proposed which is based on SRCKF. By setting judgment threshold and amending rules, the proposed algorithm directly amends the predicted state value or filter gain to balance the proportion of the predicted prior value and the measured posterior feedback value in the filtering, which can reduce the state estimation error. Simulation results show that the algorithm has good filtering performance and numerical stability when the target state is suddenly changed and the measurement is nonlinear. Meanwhile, compared with the STF algorithm which needs to calculate the fading factor, the proposed algorithm has advantages in calculation amount and convergence speed.

Key words: target model, square-root cubature Kalman filter (SRCKF), amending algorithm, adaptive filtering

CLC Number:

TP273

Chunhui LI, Jian MA, Yongjian YANG, Bingsong XIAO, Youwei DENG, Tao SHENG. Adaptive square-root cubature Kalman filter algorithm based on amending[J]. Systems Engineering and Electronics, 2021, 43(7): 1824-1830.

Figures/Tables 9

Fig.1

Fig.2

Table 1

Fig.3

Fig.4

Fig.5

Fig.6

Fig.7

Fig.8

References 24

1	王小旭, 潘泉, 黄鹤, 等. 非线性系统确定采样型滤波算法综述[J]. 控制与决策, 2012, 27 (6): 801- 812.
	WANG X X , PAN Q , HUANG H , et al. Overview of deterministic sampling filtering algorithms for nonlinear system[J]. Control and Decision, 2012, 27 (6): 801- 812.
2	JULIER S J , UHLMANN J K , DURRANT-WHYTE H F . A new method for the nonlinear transformation of means and covariances in filters and estimators[J]. IEEE Trans.on Automa-tic Control, 2000, 45 (3): 477- 482. doi: 10.1109/9.847726
3	MERWE R V, WAN E A. Sigma-point Kalman filters for integrated navigation[C]//Proc. of the 60th Annual Meeting of the Institute of Navigation, 2004: 641-654.
4	ARASARATNAM I , HAYKIN S . Cubature Kalman filters[J]. IEEE Trans.on Automatic Control, 2009, 54 (6): 1254- 1269. doi: 10.1109/TAC.2009.2019800
5	ARASARATNAM I , HAYKIN S . Cubature Kalman filtering for continuous-discrete systems: theory and simulations[J]. IEEE Trans.on Signal Processing, 2010, 58 (10): 4977- 4993. doi: 10.1109/TSP.2010.2056923
6	张浩为, 谢军伟, 葛佳昂, 等. 自适应CS模型的强跟踪平方根容积卡尔曼滤波算法[J]. 系统工程与电子技术, 2019, 41 (6): 19- 27.
	ZHANG H W , XIE J W , GE J A , et al. Strong tracking square-root cubature Kalman filter over adaptive current statistical model[J]. Systems Engineering and Electronics, 2019, 41 (6): 19- 27.
7	HAN B , HUANG H Q , LEI L , et al. An improved IMM algorithm based on STSRCKF for maneuvering target tracking[J]. IEEE Access, 2019, 7, 57795- 57804. doi: 10.1109/ACCESS.2019.2912983
8	徐树生, 林孝工, 李新飞. 强跟踪自适应平方根容积卡尔曼滤波算法[J]. 电子学报, 2014, 42 (12): 2394- 2400. doi: 10.3969/j.issn.0372-2112.2014.12.009
	XU S S , LIN X G , LI X F . Strong tracking adaptive square-root cubature Kalman filter algorithm[J]. Acta Electronica Sinica, 2014, 42 (12): 2394- 2400. doi: 10.3969/j.issn.0372-2112.2014.12.009
9	徐树生, 林孝工, 赵大威, 等. 强跟踪SRCKF及其在船舶定位中的应用[J]. 仪器仪表学报, 2013, 34 (6): 1266- 1272. doi: 10.3969/j.issn.0254-3087.2013.06.010
	XU S S , LIN X G , ZHAO D W , et al. Strong tracking SRCKF and its application in vessel dynamic positioning[J]. Chinese Journal of Scientific Instrument, 2013, 34 (6): 1266- 1272. doi: 10.3969/j.issn.0254-3087.2013.06.010
10	ZHAO L Q , WANG J L , YU T , et al. Design of adaptive robust square-root cubature Kalman filter with noise statistic estimator[J]. Applied Mathematics and Computation, 2015, 256, 352- 367. doi: 10.1016/j.amc.2014.12.036
11	WANG Y H, TUO Y L, CHI C, et al. Improved strong trac-king filter algorithm for dynamic positioning vessels[C]//Proc. of the 34th Chinese Control Conference, 2015: 4624-4628.
12	NARASIMHAPPA M , SABAT S L , NAYAK J . Adaptive sampling strong tracking scaled unscented Kalman filter for denoising the fibre optic gyroscope drift signal[J]. IET Science Measurement & Technology, 2015, 9 (3): 241- 249.
13	GE Q B , LI W B , WEN C L . SCKF-STF-CN: a universal nonlinear filter for maneuver target tracking[J]. Journal of Zhejiang University Science C, 2011, 12 (8): 678- 686. doi: 10.1631/jzus.C10a0353
14	LI N, ZHU R, ZHANG Y. A strong tracking square-root CKF algorithm based on multiple fading factors for target tracking[C]//Proc. of the 7th International Joint Conference on Computational Sciences and Optimization, 2014: 16-24.
15	ZHANG A , BAO S D , BI W H , et al. Low-cost adaptive square-root cubature Kalman filter for systems with process model uncertainty[J]. Journal of Systems Engineering and Electronics, 2016, 27 (5): 945- 953. doi: 10.21629/JSEE.2016.05.01
16	ZHANG A , BAO S D , GAO F , et al. A novel strong tracking cubature Kalman filter and its application in maneuvering target tracking[J]. Chinese Journal of Aeronautics, 2019, 32 (11): 2489- 2502. doi: 10.1016/j.cja.2019.07.025
17	ZHANG H W , XIE J W , GE J A , et al. Adaptive strong tracking square-root cubature Kalman filter for maneuvering aircraft tracking[J]. IEEE Access, 2018, 6, 10052- 10061. doi: 10.1109/ACCESS.2018.2808170
18	ZHANG H W , XIE J W , GE J A , et al. Strong tracking SCKF based on adaptive CS model for manoeuvring aircraft tracking[J]. IET Radar, Sonar & Navigation, 2018, 12 (7): 742- 749.
19	YUE Z , LIAN B W , TONG K X , et al. Novel strong tracking square-root cubature Kalman filter for GNSS/INS integrated navigation system[J]. IET Radar, Sonar & Navigation, 2019, 13 (6): 976- 982.
20	SINGER R A . Estimating optimal tracking filter performance for manned maneuvering targets[J]. IEEE Trans.on Aerospace and Electronic Systems, 1970, 6 (4): 473- 483.
21	RONG L X , JILKOV V P . Survey of maneuvering target tracking. Part V: multiple-model methods[J]. IEEE Trans.on Aerospace and Electronic Systems, 2005, 41 (4): 1255- 1321. doi: 10.1109/TAES.2005.1561886
22	RONG L X , ZHANG Y . Multiple-model estimation with variable structure. Part V: Likely-model set algorithm[J]. IEEE Trans.on Aerospace and Electronic Systems, 2000, 36 (2): 448- 466. doi: 10.1109/7.845222
23	张鑫春, 郭承军. 均方根嵌入式容积卡尔曼滤波[J]. 控制理论与应用, 2013, 30 (9): 1116- 1121.
	ZHANG X C , GUO C J . Square-root imbedded cubature Kalman filtering[J]. Control Theory & Applications, 2013, 30 (9): 1116- 1121.
24	ZHANG X C , GUO C J . Cubature Kalman filters: derivation and extension[J]. Chinese Physics B, 2013, 22 (12): 501- 506.

算法	平均均方误差			平均耗时/s
算法	位置/m	速度/(m·s^-1)	加速度/(m·s^-2)	平均耗时/s
本文算法	9.712 1	10.243 6	7.019 0	0.007 5
文献[8]算法	14.507 7	14.996 7	8.067 9	0.032 7

[1]	Jinli MENG, Yafeng WANG, Jingbei YANG, Ning WANG. Spatial adaptive filtering of polarization agility jamming [J]. Systems Engineering and Electronics, 2022, 44(11): 3305-3312.
[2]	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.
[3]	ZOU Zisheng, CONG Shuang, SHANG Weiwei, CHEN Ding. State filtering and controller design for fine tracking system in quantum positioning [J]. Systems Engineering and Electronics, 2019, 41(3): 601-610.
[4]	ZHAO Zhixin, ZHOU Xinhua, ZHU Sihang, HONG Sheng, WANG Yuhao. Waveform characteristic based clutter suppression algorithm for passive bistatic radar [J]. Systems Engineering and Electronics, 2018, 40(9): 1966-1972.
[5]	ZENG Le-ya, XU Hua, WANG Tian-rui. Low computational complexity variable step-size CLMS algorithm based on Lorentzian function [J]. Systems Engineering and Electronics, 2016, 38(5): 998-.
[6]	LIU Hua, WU Wen, WANG Shi-yuan. Multi-sensor sequential fusion tracking algorithm based on square-root cubature Kalman filter [J]. Systems Engineering and Electronics, 2015, 37(7): 1494-1498.
[7]	SHEN Chen， XU Ding-jie， SHEN Feng， CAI Jia-nan. Generalized noises adaptive Kalman filtering based on variational inference [J]. Systems Engineering and Electronics, 2014, 36(8): 1466-1472.
[8]	GAO Wei， HUANG Jian-guo， HAN Jing. Online nonlinear adaptive filtering based on multikernel learning algorithm [J]. Systems Engineering and Electronics, 2014, 36(8): 1473-1477.
[9]	CUI Song-qi, AN Jian-ping, WANG Ai-hua. Kalman filter used for carrier tracking algorithm based on matched maneuvering target model [J]. Systems Engineering and Electronics, 2014, 36(2): 376-381.
[10]	TIAN Fuqing, LUO Rong, LI Keyu, DING Qingxi. New variable step size LMS algorithm based on modified hyperbolic tangent function [J]. Journal of Systems Engineering and Electronics, 2012, 34(9): 1758-1763.
[11]	HAO Yan-ling, SHAN Zhi-ming, SHEN Feng. Gradient norm based VSS-NLMP algorithm in α stable environments [J]. Journal of Systems Engineering and Electronics, 2012, 34(4): 652-656.
[12]	LIU Wang-sheng, LI Ya-an, CUI Lin. Adaptive strong tracking algorithm for maneuvering targets based on current statistical model [J]. Journal of Systems Engineering and Electronics, 2011, 33(9): 1937-1940.
[13]	LU Gang，TANG Bin，LUO Shuang-cai. Adaptive cancellation of DRFM false targets for LFM radar [J]. Journal of Systems Engineering and Electronics, 2011, 33(8): 1760-1764.
[14]	XIE Chun-ming1,2, ZHAO Yan1, DENG Jun-yun1,2. Improved adaptive square root filtering algorithm for transfer alignment [J]. Journal of Systems Engineering and Electronics, 2011, 33(3): 622-626.
[15]	SHI Wei, XING Jian-jun, CHEN Jian-qun. New Quasi-Newton LMS adaptive noise canceling in interval wavelet transform domain [J]. Journal of Systems Engineering and Electronics, 2011, 33(12): 2762-2766.

Adaptive square-root cubature Kalman filter algorithm based on amending

RichHTML

PDF (PC)

Knowledge

Abstract

Cite this article

share this article

Figures/Tables 9

References 24

Related Articles 15

Recommended Articles

Metrics

Comments