Dual-station unscented particle filter algorithm with spatiotemporal soft constraint

Abstract

Abstract:

For the maneuvering target tracked via the dual-station bearing tracker, to solve the problem of the bounded mixture likelihood caused by the incomplete information and unstructured environment, an unscented particle filter with spatiotemporal soft constraint (SCUPF) algorithm is proposed. For the unknown target prior, the target's position is achieved via the spatial intersect measurement method with the epipolar geometric constraints, so as to predict the center of the camber to calculate the turn rate. To cover the multi-area likelihood, the target state is updated via the unscented transformation, and the importance distribution is modulated via a fuzzy measure. To keep the property of dimensionality invariant of the estimation variance, the posterior distribution of the target state is approximated by drawing the importance samples from the Dirac approximation. Simulation results demonstrate that for the typical scenario that the point target tracked by the dual-station theodolites, compared with the Rao-Blackwell multiple model particle filter (MMRBPF) algorithm, the computational complexity of the proposed SCUPF algorithm is on the same order as the single-model particle filter. Meanwhile, compared with the constrained auxiliary particle filter (CAPF) algorithm, the filtering accuracy is improved by 27%-41%.

Key words: dual-station bearing tracking, maneuvering target, bounded mixture likelihood, spatiotemporal soft constraint, unscented particle filter

CLC Number:

TN953

Hongwei ZHANG. Dual-station unscented particle filter algorithm with spatiotemporal soft constraint[J]. Systems Engineering and Electronics, 2023, 45(5): 1261-1269.

Figures/Tables 7

Fig.1

Fig.2

Fig.3

Fig.4

Fig.5

Fig.6

算法	RMSE/m	max/m	RTAMSE/m	时间/s
IMMUKF	15.4	42.6	15.1	0.04
MMRBPF	16.2	31.0	12.5	4.01
CAPF	13.6	30.0	17.6	2.11
SCUPF	12.0	22.0	10.7	2.47

Table 1

References 32

1	NARDONE S C , AIDALA V J . Observability criteria for bearings-only target motion analysis[J]. IEEE Trans.on Aerospace and Electronic systems, 1981, (2): 162- 166.
2	KODUKULA S . Three-dimensional submarine-to-submarine passive target tracking in the presence of non-gaussian noises[J]. International Journal of e-Collaboration (IJeC), 2021, 17 (3) doi: 10.4018/IJeC.2021070101
3	BAR-SHALOM Y , LI X R , KIRUBARAJAN T . Estimation with applications to tracking and navigation: theory algorithms and software[M]. Hoboken: Wiley, 2004.
4	王鼎, 李长胜, 张瑞杰. 基于无源定位观测方程的一类伪线性加权最小二乘定位闭式解及其理论性能分析[J]. 中国科学: 信息科学, 2015, 45 (9): 1197- 1217.
	WANG D , LI C S , ZHANG R J . The closed-form solution of quadratic positioning and its theoretical performance analysis for a class of pseudo-linear weighted minimum based on passive positioning observation equation[J]. Chinese Science: Information Science, 2015, 45 (9): 1197- 1217.
5	邱硕丰, 刘军. 无源双站交叉定位误差分析[J]. 舰船电子对抗, 2018, 41 (5): 22- 26.
	QIU S F , LIU J . Error analysis for passive double-station cross location[J]. Shipboard Electronic Countermeasure, 2018, 41 (5): 22- 26.
6	奚畅, 蔡志明, 袁骏. Leg-by-leg机动条件下纯方位跟踪的观测站机动策略[J]. 系统工程与电子技术, 2021, 43 (9): 2413- 2421.
	XI C , CAI Z M , YUAN J . Observer maneuver strategy for leg-by-leg bearing-only tracking[J]. Systems Engineering and Electronics, 2021, 43 (9): 2413- 2421.
7	SARKKA S . Bayesian filtering and smoothing[M]. Cambridge: Cambridge university press, 2013.
8	孙照强, 王志贵, 孟飞, 等. 基于EKF及弹道方程的弹道目标跟踪滤波器设计[J]. 系统工程与电子技术, 2022, 44 (10): 3207- 3212. doi: 10.12305/j.issn.1001-506X.2022.10.25
	SUN Z Q , WANG Z G , MENG F , et al. Novel ballistic tracking arithmetic based on EKF and ballistic kinematics equations[J]. Systems Engineering and Electronics, 2022, 44 (10): 3207- 3212. doi: 10.12305/j.issn.1001-506X.2022.10.25
9	SADHU S , MONDAL S , SRINIVASAN M , et al. Sigma point Kalman filter for bearing only tracking[J]. Signal processing, 2006, 86 (12): 3769- 3777. doi: 10.1016/j.sigpro.2006.03.006
10	GARCIA-FERNANDEZ A F , MORELANDE M R , GRAJAL J . Truncated unscented Kalman filtering[J]. IEEE Trans.on Signal Processing, 2012, 60 (7): 3372- 3386. doi: 10.1109/TSP.2012.2193393
11	VAN D M R, DOUCET A, DE F N. The unscented particle filter[C]//Proc. of the 13th International Conference on Neural Information Processing Systems, 2000.
12	孔云波, 冯新喜, 鹿传国, 等. 改进高斯混合粒子滤波的纯方位目标跟踪算法[J]. 宇航学报, 2012, (7): 971- 977.
	KONG Y B , FENG X X , LU C G , et al. An Improved Gaussian mixture particle filter based targets tracking algorithm for bearing-only tracking system[J]. Journal of Astronautics, 2012, (7): 971- 977.
13	ZHANG H W . Multiple importance unscented Kalman filtering with soft spatiotemporal constraint for multi-passive-sensor target tracking[J]. International Journal of Robust and Nonlinear Control, 2023, 33 (1): 264- 281. doi: 10.1002/rnc.5977
14	ELVIRA V , MARTINO L , CLOSAS P . Importance Gaussian quadrature[J]. IEEE Trans.on Signal Processing, 2020, 69, 474- 488.
15	LI X R , JILKOV V P . Survey of maneuvering target tracking. Part I. Dynamic models[J]. IEEE Trans.on Aerospace and Electronic Systems, 2003, 39 (4): 1333- 1364. doi: 10.1109/TAES.2003.1261132
16	李林, 王国宏, 张翔宇, 等. 临近空间高超声速目标滑跃式轨迹Sine-AIMM跟踪算法[J]. 宇航学报, 2021, 42 (5): 581- 590.
	LI L , WANG G H , ZHANG X Y , et al. A sine-AIMM tracking algorithm for near space hypersonic slippage leap maneuvering target[J]. Journal of Astronautics, 2021, 42 (5): 581- 590.
17	HOSTETTLER R , SÄRKKÄ S . Rao-blackwellized Gaussian smoothing[J]. IEEE Trans.on Automatic Control, 2019, 64 (1): 305- 312. doi: 10.1109/TAC.2018.2828087
18	ROBERT C P , ROBERTS G . Rao-Blackwellisation in the Markov chain Monte Carlo era[J]. International Statistical Review, 2021, 89 (2): 237- 249. doi: 10.1111/insr.12463
19	CHEN Y C , YAN Z B , ZHANG X . Rao-Blackwellized particle filter for asynchronously dependent noises[J]. International Journal of Control, Automation and Systems, 2021, 19 (6): 2026- 2037. doi: 10.1007/s12555-019-0832-8
20	AFTAB W , MIHAYLOVA L . A learning Gaussian process approach for maneuvering target tracking and smoothing[J]. IEEE Trans.on Aerospace and Electronic Systems, 2020, 57 (1): 278- 292.
21	SHARMA Y R , RATNOO A . A bearings-only trajectory shaping guidance law with look-angle constraint[J]. IEEE Trans.on Aerospace and Electronic Systems, 2019, 55 (6): 3303- 3315.
22	BADRIASL L , ARULAMPALAM S , VAN D H J . Bayesian WIV estimators for 3-D bearings-only TMA with speed constraints[J]. IEEE Trans.on Signal Processing, 2019, 67 (13): 3576- 3591.
23	张小虎, 金学军, 郭金虎, 等. 靶场光测多站图像多目标判读技术[J]. 光学技术, 2006, 32 (S1): 398- 400. 398-400, 403
	ZHANG X H , JIN X J , GUO J H , et al. Multitarget interpretation technique for multi-station images of optical measurement in range[J]. Optical technique, 2006, 32 (S1): 398- 400. 398-400, 403
24	ZHANG H , ZHOU X , WANG Z P . Maneuvering target tracking with event-based mixture Kalman filter in mobile sensor networks[J]. IEEE Trans.on Cybernetics, 2019, 50 (10): 4346- 4357.
25	GARCÍA-FERNÁNDEZ Á F, MORELANDE M R, GRAJAL J. Mixture truncated unscented Kalman filtering[C]//Proc. of the IEEE 15th International Conference on Information Fusion, 2012: 479-486.
26	LIM J , KIM H S , PARK H M . Minimax particle filtering for tracking a highly maneuvering target[J]. International Journal of Robust and Nonlinear Control, 2020, 30 (2): 636- 651.
27	ZHANG H , XIE W X . Constrained auxiliary particle filtering for bearings-only maneuvering target tracking[J]. Journal of Systems Engineering and Electronics, 2019, 30 (4): 684- 695.
28	SÄRKKÄ S , SOLIN A , HARTIKAINEN J . Spatiotemporal learning via infinite-dimensional Bayesian filtering and smoothing: a look at Gaussian process regression through Kalman filtering[J]. IEEE Signal Processing Magazine, 2013, 30 (4): 51- 61.
29	SÄRKKÄ S . Bayesian filtering and smoothing[M]. Cambridge: Cambridge University Press, 2013.
30	SIMON D . Kalman filtering with state constraints: a survey of linear and nonlinear algorithms[J]. IET Control Theory & Applications, 2010, 4 (8): 1303- 1318.
31	LIU C , LI B , CHEN W H . Particle filtering with soft state constraints for target tracking[J]. IEEE Trans.on Aerospace and Electronic Systems, 2019, 55 (6): 3492- 3504.
32	刘宗香, 谢维信, 黄敬雄. 一种用于三维空间杂波环境机动目标跟踪的数据互联方法[J]. 电子与信息学报, 2009, 31 (4): 848- 852.
	LIU Z X , XIE W X , HUANG J X . A data association method for maneuvering target tracking in three-dimensiond space under the circumstance of clutter[J]. Journal of Electronics & Information Technology, 2009, 31 (4): 848- 852.

[1]	Yuchao YANG, Ming FANG, Chenfan ZHAO, Gang FANG. Long-time coherent integration algorithm for high-speed maneuvering targets [J]. Systems Engineering and Electronics, 2023, 45(5): 1359-1370.
[2]	Zilin HOU, Ting CHENG, Han PENG. GMPHD based on measurement conversion sequential filtering for maneuvering target tracking [J]. Systems Engineering and Electronics, 2022, 44(8): 2474-2482.
[3]	Guang ZHAI, Yanxin WANG, Yiyong SUN. Cooperative tracking filtering technology of multi-target based on low orbit satellite constellation [J]. Systems Engineering and Electronics, 2022, 44(6): 1957-1967.
[4]	Xiaohai WANG, Xiuyun MENG, Feng ZHOU, Wenjie QIU. Sliding mode guidance law with impact angle constraint based on bias proportional navigation [J]. Systems Engineering and Electronics, 2021, 43(5): 1295-1302.
[5]	Yu LU, Haibin WANG. Maneuvering target tracking algorithm for airborne passive coherent localization system [J]. Systems Engineering and Electronics, 2021, 43(4): 875-882.
[6]	Juqi YIN, Zhen YANG, Yazhong LUO, Jianyong ZHOU. Improved adaptive IMM algorithm for space maneuvering target tracking [J]. Systems Engineering and Electronics, 2021, 43(12): 3658-3666.
[7]	Xing CHEN, Zhanwu LI, An XU, Xiaodong HU. VSMM algorithm based on target maneuver pattern recognition [J]. Systems Engineering and Electronics, 2020, 42(5): 999-1006.
[8]	Qinhao ZHANG, Baiqiang AO, Qinxue ZHANG. Reinforcement learning guidance law of Q-learning [J]. Systems Engineering and Electronics, 2020, 42(2): 414-419.
[9]	LIU Dai, ZHAO Yongbo, ZHOU Yongwei, CHEN Mingzhe, LI Wei. Maneuvering target tracking algorithm aided by a high resolution range profile [J]. Systems Engineering and Electronics, 2019, 41(9): 1967-1972.
[10]	LIU Songtao, WANG Zhan, WEI Baoyan. Image tracking system for conventional moving target and abrupt maneuvering target [J]. Systems Engineering and Electronics, 2019, 41(8): 1692-1698.
[11]	JING Liang, ZHANG Zhongyang, CUI Naigang, WU Rong. Fixed time disturbance observer based terminal sliding mode guidance law [J]. Systems Engineering and Electronics, 2019, 41(8): 1820-1826.
[12]	ZHANG Haowei, XIE Junwei, GE Jiaang, ZONG Binfeng, LU Wenlong. Strong tracking squareroot cubature Kalman filter overadaptive current statistical model [J]. Systems Engineering and Electronics, 2019, 41(6): 1186-1194.
[13]	LI Guanlin, CHAO Tao, WANG Songyan, YANG Ming. Guidance law for fixed-trim vehicle against maneuvering target [J]. Systems Engineering and Electronics, 2019, 41(3): 611-618.
[14]	ZHANG Bingrui, LEI Zhiyong, ZHOU Haifeng, ZHOU Yi. Maneuvering targets parameters estimation algorithm based on HHT in high-frequency radar [J]. Systems Engineering and Electronics, 2018, 40(3): 546-551.
[15]	HUANG Jingshuai, ZHANG Hongbo, TANG Guojian, BAO Weimin. Design of differential geometric guidance law against maneuvering targets [J]. Systems Engineering and Electronics, 2018, 40(10): 2288-2295.