Gaussian sum pseudolinear Kalman filter for bearings-only tracking
The efficacy of a bearings-only tracking algorithm, to a great extent, depends on the target-sensor geometry and motion. Although the pseudolinear Kalman filter and its variants have demonstrated comparable performance with the elite non-linear filters, they still suffer from bias problems and the tracking performance is inevitably affected by the relative geometry and motion relationships. In this study, an observability metric based on classical control theory is first presented to characterise the relative relationships between the target and the sensor. Then an efficient bearings-only tracking algorithm called Gaussian sum pseudolinear Kalman filter is developed. It is based on the bias-compensated pseudolinear Kalman filter and is built within a Gaussian sum framework. In the novel algorithm, a splitting and merging procedure will be triggered when a low degree of observability is detected. Simulation results show the significant performance improvement of the proposed algorithm.