Bearing-only target tracking using a bank of MAP estimators

Guoquan P. Huang, Ke X. Zhou, Nikolas Trawny, Stergios I. Roumeliotis

Research output: Chapter in Book/Report/Conference proceedingConference contribution

5 Scopus citations

Abstract

Nonlinear estimation problems, such as bearing-only tracking, are often addressed using linearized estimators, e.g., the extended Kalman filter (EKF). These estimators generally suffer from linearization errors as well as the inability to track multimodal probability density functions (pdfs). In this paper, we propose a bank of batch maximum a posteriori (MAP) estimators as a general estimation framework that provides relinearization of the entire state history, multi-hypothesis tracking, and an efficient hypothesis generation scheme. Each estimator in the bank is initialized using a locally optimal state estimate for the current time step. Every time a new measurement becomes available, we convert the nonlinear cost function corresponding to this relaxed one-step subproblem into polynomial form, allowing to analytically and efficiently compute all stationary points. This local optimization generates highly probable hypotheses for the target trajectory and greatly improves the quality of the overall MAP estimate. Additionally, pruning and marginalization are employed to control the computational cost. Monte Carlo simulations and real-world experiments show that the proposed approach significantly outperforms the EKF, the standard batch MAP estimator, and the particle filter (PF), in terms of accuracy and consistency.

Original languageEnglish (US)
Title of host publication2011 IEEE International Conference on Robotics and Automation, ICRA 2011
Pages4998-5005
Number of pages8
DOIs
StatePublished - Dec 1 2011
Event2011 IEEE International Conference on Robotics and Automation, ICRA 2011 - Shanghai, China
Duration: May 9 2011May 13 2011

Publication series

NameProceedings - IEEE International Conference on Robotics and Automation
ISSN (Print)1050-4729

Other

Other2011 IEEE International Conference on Robotics and Automation, ICRA 2011
CountryChina
CityShanghai
Period5/9/115/13/11

Fingerprint Dive into the research topics of 'Bearing-only target tracking using a bank of MAP estimators'. Together they form a unique fingerprint.

Cite this