A Monte Carlo-Based Iterative Extended Kalman Filter for Bearings-Only Tracking of Sea Targets

Abstract

In this paper, a Monte Carlo (MC)-based extended Kalman filter is proposed for a two-dimensional bearings-only tracking problem (BOT). This problem addresses the processing of noise-corrupted bearing measurements from a sea acoustic source and estimates state vectors including position and velocity. Due to the nonlinearity and complex observability properties in the BOT problem, a wide area of research has been focused on improving its state estimation accuracy. The objective of this research is to present an accurate approach to estimate the relative position and velocity of the source with respect to the maneuvering observer. This approach is implemented using the iterated extended Kalman filter (IEKF) in an MC-based iterative structure (MC-IEKF). Re-linearizing dynamic and measurement equations using the IEKF along with the MC campaign applied to the initial conditions result in significantly improved accuracy in the estimation process. Furthermore, an observability analysis is conducted to show the effectiveness of the designed maneuver of the observer. A comparison with the widely used UKF algorithm is carried out to demonstrate the performance of the proposed method.