In order to solve the problems of having nonlinear observation equations and being susceptible to initial value of filtering in bearings-only target tracking, a range-parameterized hybrid coordinates Square Root Cubature Kalman Filter (SRCKF) algorithm was proposed. Firstly,it applied the SRCKF to hybrid coordinates,obtained better tracking effect than the SRCKF under Cartesian coordinates. And then it combined the range parameterization strategy with the SRCKF under hybrid coordinates, and eliminated the impact of unobservable range. The simulation results show that the proposed algorithm can significantly improve the accuracy and robustness although the computational complexity increases slightly.
[1] SONG T L. Observability of target tracking with bearing-only measurements[J]. IEEE Transactions on Aerospace and Electronic Systems,1996, 32(4): 1468-1471. [2] WANG J, BAO F, ZHANG S.Passive detection and tracking radar systems technology and development[J].Radar Science and Technology, 2004, 2(3):129-135.(王俊,保锋,张守宏.无源探测系统与跟踪雷达系统技术及其发展[J].雷达科学与技术,2004, 2(3):129-135.) [3] HATEM H, KUTLUYIL D.Passive localization of scanning emitters [J].IEEE Transactions on Aerospace and Electronic Systems, 2010, 46(2): 944-951. [4] AIDALA V J.Kalman filter behavior in bearing-only tracking application[J]. IEEE Transactions on Aerospace and Electronic Systems,1979,15(1):29-39. [5] JULIER S J, UHLMANN J K. Unscented filtering and nonlinear estimation[J]. Proceedings of the IEEE, 2004,92(3):401-422. [6] IENKARAN A, SIMON H. Cubature Kalman filters[J]. IEEE Transactions on Automatic Control, 2009, 54(6):1254-1279. [7] HAO Y, YANG J, CHEN L, et al. Square root cubature Kalman filter[J]. Journal of Projectiles Rockets Missiles and Guidance, 2012,32(2):169-172. (郝燕玲,杨峻巍, 陈亮, 等. 平方根容积卡尔曼滤波器[J].弹箭与制导学报,2012,32(2):169-172.) [8] LI W, YANG Y, HOU J. Bearings-only tracking algorithm performance analysis based on infrared sensor [J]. Journal of Northwestern Polytechnical University, 2014,32(3):383-393. (李伟, 羊彦,侯静. 基于红外传感器方位跟踪算法的性能分析[J].西北工业大学学报, 2014,32(3):383-393.) [9] DING G, FENG X. Infrared target tracking based on modified spherical coordinates[J]. Modern Defense Technology, 2007, 35(5):101-104. (丁光庆,冯新喜.基于修正球坐标的红外目标跟踪[J].现代防御技术, 2007, 35(5):101-104.) [10] PEACH N.Bearings-only tracking using a set of range parameterized extended Kalman filters[J].IEEE Proceedings of the Control Theory Application,1995,142(1):73-80. [11] KARLSSON R, GAUSTAFSSON F.Recursive Bayesian estimation:bearing-only applications[J].IEEE Proceedings of Radar, Sonar and Navigation,2005,152(5):305-313. [12] KOZICK R J, SADLER B M. Source localization with distributed sensor arrays and practical spatial coherence[J]. IEEE Transactions on Signal Processing,2004,52(3):601-616.