Underwater Bearing-only and Bearing-Doppler Target Tracking Based on Square Root Unscented Kalman Filter

摘要

Underwater target tracking system can be kept covert using the bearing-only or the bearing-Doppler measurements (passive measurements), which will reduce the risk of been detected. According to the characteristics of underwater target tracking, the square root unscented Kalman filter (SRUKF) algorithm, which is based on the Bayesian theory, was applied to the underwater bearing-only and bearing-Doppler non-maneuverable target tracking problem. Aiming at the shortcomings of the unscented Kalman filter (UKF), the SRUKF uses the QR decomposition and the Cholesky factor updating, in order to avoid that the process noise covariance matrix loses its positive definiteness during the target tracking period. The SRUKF uses sigma sampling to avoid the linearization of the nonlinear bearing-only and the bearing-Doppler measurements. To ensure the target state observability in underwater target tracking, the paper uses single maneuvering observer to track the single non-maneuverable target. The simulation results show that the SRUKF has better tracking performance than the extended Kalman filter (EKF) and the UKF in tracking accuracy and stability, and the computational complexity of the SRUKF algorithm is low.