Abstract
The central differential Kalman filter (CDKF) and square root central differential Kalman filter (SR-CDKF) are widely used methods for addressing nonlinear problems in target motion analysis. However, for the bearings-only target motion analysis by single observer, sometimes the CDKF and the SR-CDKF experience the divergence problem or even filter interruption due to the observer’s mobility and system noise. To solve these problems, SR-CDKF is improved, and an adaptive singular value decomposition square root center difference Kalman filter (ASVDSR-CDKF) is proposed. The covariance square root update method based on the singular value decomposition method is deduced. The error discriminant statistics and adaptive factors are constructed. When the disturbance is too large, the adaptive factor is automatically adjusted and the square root updating form is selected. The simulation of bearings only target motion analysis is carried out under three different conditions, and the performance of CDKF, SR-CDKF, square root unscented Kalman filter (SR-UKF) and the proposed ASVDSR-CDKF method are compared. The simulation results demonstrate that the proposed method not only has high accuracy, but is also more stable than the other three methods.
This is a preview of subscription content, log in via an institution.
Buying options
Tax calculation will be finalised at checkout
Purchases are for personal use only
Learn about institutional subscriptionsReferences
Nardone, S., Lindgren, A., Gong, K.: Fundamental properties and performance of conventional bearings-only target motion analysis. IEEE Trans. Autom. Control 29(9), 775–787 (1984)
Isbitiren, G., Akan, O.B.: Three-dimensional underwater target tracking with acoustic sensor networks. IEEE Trans. Veh. Technol. 60(8), 3897–3906 (2011)
Fang, X., Jiang, Z.H., Nan, L., Chen, L.J.: Noise-aware localization algorithms for wireless sensor networks based on multidimensional scaling and adaptive Kalman filtering. Comput. Commun. 101, 57–68 (2017)
Dogancay, K.: 3D Pseudolinear target motion analysis from angle measurements. IEEE Trans. Signal Process. 63(6), 1570–1580 (2015)
Alexandri, T., Diamant, R.: A reverse bearings only target motion analysis for autonomous underwater vehicle navigation. IEEE Trans. Mob. Comput. 18(3), 494–506 (2019)
Mao, D., Fang, Y., Gao, X.: Target tracking method with bearings-only measurements based on reinforcement learning. IEICE Commun. Express 5(1), 19–26 (2016)
Kim, J., Suh, T., Ryu, J.: Bearings-only target motion analysis of a highly manoeuvring target. IET Radar Sonar Navig. 11(6), 1011–1019 (2017)
Jauffret, C., Perez, A., Pillon, D.: Observability: range-only versus bearings-only target motion analysis when the observer maneuvers smoothly. IEEE Trans. Aerosp. Electron. Syst. 53(6), 2814–2832 (2017)
Zheng, Y., Wang, M.Z.: A sliding backward recursive EKF bearings-only target tracking method. J. Unmanned Undersea Syst. 6(28), 663–669 (2020)
Badriasl, L., Arulampalam, S., Nguyen, N.H., Finn, A.: An algebraic closed-form solution for bearings-only maneuvering target motion analysis from a nonmaneuvering platform. IEEE Trans. Signal Process. 68, 4672–4687 (2020)
Shalom, Y., Li, X., Thiagalingam, R.K.: Estimation with Applications to Tracking and Navigation. Wiley, New York (2001)
Lin, X., Kirubarajan, T., Bar-Shalom, Y., Maskell, S.: Comparison of EKF, pseudomeasurement, and particle filters for a bearing-only target tracking problem. In: Signal and Data Processing of Small Targets 2002, Orlando, FL, USA, pp. 240–250 (2002)
Konatowski, S., Kaniewski, P., Matuszewski, J.: Comparison of estimation accuracy of EKF, UKF and PF filters. Ann. Navig. 23(1), 69–87 (2016)
Gordon, N.J., Salmond, D.J., Smith, A.F.M.: Novel approach to nonlinear/non-Gaussian Bayesian state estimate. IEEE Proc. Radar Sonar Navig. 140(2), 107–113 (1993)
Zhang, H.W., Xie, W.X.: Constrained auxiliary particle filtering for bearings-only maneuvering target tracking. J. Syst. Eng. Electron. 13(4), 684–695 (2019)
Tiwari, R.K., Radhakrishnan, R., Bhaumik, S.: Particle filter for underwater passive bearings-only target tracking with random missing measurements. In: European Control Association (EUCA), Limassol, Cyprus, pp. 2732–2737 (2018)
Julier, S.J., Uhlmann, J.K.: Unscented filtering and nonlinear estimation. Proc. IEEE 92(3), 401–422 (2001)
Arasaratnam, I., Haykin, S.: Cubature Kalman Filters. IEEE Trans. Autom. Control 54(6), 1254–1269 (2009)
Ito, K., Xiong, K.: Gaussian filter for nonlinear filtering problems. IEEE Trans. Autom. Control 5, 910–927 (2000)
Nørgaard, M., Poulsen, N.K., Ravn, O.: New developments in state estimation for nonlinear systems. Automatica 36(11), 1627–1638 (2000)
Li, L., Qin, H.: An UKF‐based nonlinear system identification method using interpolation models and backward integration. Struct. Control Health Monit. 25(4), 2129 (2018)
Zhao, J., Mili, L.: Robust unscented Kalman Filter for power system dynamic state estimation with unknown noise statistics. IEEE Trans. Smart Grid 10(2), 1215–1224 (2019)
Costanzi, R., Fanelli, F., Meli, E., Ridolfi, A., Caiti, A., Allotta, B.: UKF-based navigation system for AUVs: online experimental validation. IEEE J. Ocean. Eng. 44(3), 633–641 (2019)
Yao, Q., Su, Y., Li, L.: Application of square-root unscented Kalman filter smoothing algorithm in tracking underwater target. Adv. Eng. Res. 150, 526–531 (2017)
Menegaz, H.M.T., Ishihara, J.Y.: Unscented and square-root unscented Kalman filters for quaternionic systems. Int. J. Robust Nonlinear Control 28, 4500–4527 (2018)
Li, X., Zhao, C., Yu, J., Wei, W.: Underwater bearing-only and bearing-doppler target tracking based on square root unscented Kalman filter. Entropy 21(8), 740 (2019)
Lou, T., Yang, N., Wang, Y., Chen, N.H.: Target tracking based on incremental center differential Kalman filter with uncompensated biases. IEEE Access 6, 66285–66292 (2018)
Dai, J., Li, X., Wang, K., Liang, Y.: A novel STSOSLAM algorithm based on strong tracking second order central difference Kalman filter. Robot. Auton. Syst. 116, 114–125 (2019)
Ye, W., Li, J., Fang, J., Yuan, X.: EGP-CDKF for performance improvement of the SINS/GNSS integrated system. IEEE Trans. Industr. Electron. 65(4), 3601–3609 (2018)
Merwe, R.V.D.: Sigma-point Kalman filters for probabilistic inference in dynamic state-space models. Ph.D. dissertation, Dept. Elec. Comp., Oregon Health & Science Univ., Oregon, Portland (2004)
Liu, D., Duan, J., Shi, H.: A strong tracking square root central difference fast SLAM for unmanned intelligent vehicle with adaptive partial systematic resampling. IEEE Trans. Intell. Transp. Syst. 17(11), 3110–3120 (2016)
Xie, J., Ma, J., Chen, J.: Available power prediction limited by multiple constraints for LiFePO 4 batteries based on central difference Kalman filter. Int. J. Energy Res. 42(15), 4730–4745 (2018)
Li, X.R., Jilkov, V.P.: Survey of maneuvering target tracking-Part I. dynamic models. IEEE Trans. Aerosp. Electron. Syst. 39(4), 1333–1364 (2004)
Author information
Authors and Affiliations
Corresponding author
Editor information
Editors and Affiliations
Rights and permissions
Copyright information
© 2022 The Author(s), under exclusive license to Springer Nature Singapore Pte Ltd.
About this paper
Cite this paper
Zheng, Y., Wang, M., Hu, Y., Yang, Y., Yang, X. (2022). A Method of Square Root Central Difference Kalman Filter for Target Motion Analysis. In: Fan, W., Zhang, L., Li, N., Song, X. (eds) Methods and Applications for Modeling and Simulation of Complex Systems. AsiaSim 2022. Communications in Computer and Information Science, vol 1713. Springer, Singapore. https://doi.org/10.1007/978-981-19-9195-0_27
Download citation
DOI: https://doi.org/10.1007/978-981-19-9195-0_27
Published:
Publisher Name: Springer, Singapore
Print ISBN: 978-981-19-9194-3
Online ISBN: 978-981-19-9195-0
eBook Packages: Computer ScienceComputer Science (R0)