Particle filters for positioning, navigation, and tracking

A framework for positioning, navigation, and tracking problems using particle filters (sequential Monte Carlo methods) is developed. It consists of a class of motion models and a general nonlinear measurement equation in position. A general algorithm is presented, which is parsimonious with the particle dimension. It is based on marginalization, enabling a Kalman filter to estimate all position derivatives, and the particle filter becomes low dimensional. This is of utmost importance for high-performance real-time applications. Automotive and airborne applications illustrate numerically the advantage over classical Kalman filter-based algorithms. Here, the use of nonlinear models and non-Gaussian noise is the main explanation for the improvement in accuracy. More specifically, we describe how the technique of map matching is used to match an aircraft's elevation profile to a digital elevation map and a car's horizontal driven path to a street map. In both cases, real-time implementations are available, and tests have shown that the accuracy in both cases is comparable with satellite navigation (as GPS) but with higher integrity. Based on simulations, we also argue how the particle filter can be used for positioning based on cellular phone measurements, for integrated navigation in aircraft, and for target tracking in aircraft and cars. Finally, the particle filter enables a promising solution to the combined task of navigation and tracking, with possible application to airborne hunting and collision avoidance systems in cars.

[1]  Kenneth R Britting,et al.  Inertial navigation systems analysis , 1971 .

[2]  M. Hata,et al.  Empirical formula for propagation loss in land mobile radio services , 1980, IEEE Transactions on Vehicular Technology.

[3]  T. Kailath.  Some Topics in Linear Estimation , 1981 .

[4]  Donald Geman,et al.  Stochastic Relaxation, Gibbs Distributions, and the Bayesian Restoration of Images , 1984, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[5]  Brian D. Ripley,et al.  Stochastic Simulation , 2005 .

[6]  Y. Bar-Shalom.  Tracking and data association , 1988 .

[7]  Yaakov Bar-Shalom,et al.  Estimation and Tracking: Principles, Techniques, and Software , 1993 .

[8]  N. Gordon,et al.  Novel approach to nonlinear/non-Gaussian Bayesian state estimation , 1993 .

[9]  Jun S. Liu,et al.  Sequential Imputations and Bayesian Missing Data Problems , 1994 .

[10]  D. Avitzour.  Stochastic simulation Bayesian approach to multitarget tracking , 1995 .

[11]  Roy L. Streit,et al.  A comparison of the JPDAF and PMHT tracking algorithms , 1995, 1995 International Conference on Acoustics, Speech, and Signal Processing.

[12]  Petros G. Voulgaris,et al.  On optimal ℓ∞ to ℓ∞ filtering , 1995, Autom..

[13]  Peter Green,et al.  Markov chain Monte Carlo in Practice , 1996 .

[14]  Jun S. Liu,et al.  Metropolized independent sampling with comparisons to rejection sampling and importance sampling , 1996, Stat. Comput..

[15]  N. Gordon.  A hybrid bootstrap filter for target tracking in clutter , 1995, IEEE Transactions on Aerospace and Electronic Systems.

[16]  Simon J. Godsill,et al.  On sequential simulation-based methods for Bayesian filtering , 1998 .

[17]  Malcolm David Macnaughtan,et al.  Positioning GSM telephones , 1998, IEEE Commun. Mag..

[18]  Neil J. Gordon,et al.  Tracking in the presence of intermittent spurious objects and clutter , 1998, Defense, Security, and Sensing.

[19]  Fredrik Gustafsson,et al.  Terrain navigation using Bayesian statistics , 1999 .

[20]  Mark Koifman,et al.  Inertial navigation system aided by aircraft dynamics , 1999, IEEE Trans. Control. Syst. Technol..

[21]  Fredrik Gustafsson,et al.  Estimation in cellular radio systems , 1999, 1999 IEEE International Conference on Acoustics, Speech, and Signal Processing. Proceedings. ICASSP99 (Cat. No.99CH36258).

[22]  M. Pitt,et al.  Filtering via Simulation: Auxiliary Particle Filters , 1999 .

[23]  Niclas Bergman,et al.  Recursive Bayesian Estimation : Navigation and Tracking Applications , 1999 .

[24]  Arnaud Doucet,et al.  Markov chain Monte Carlo data association for target tracking , 2000, 2000 IEEE International Conference on Acoustics, Speech, and Signal Processing. Proceedings (Cat. No.00CH37100).

[25]  Simon J. Godsill,et al.  On sequential Monte Carlo sampling methods for Bayesian filtering , 2000, Stat. Comput..

[26]  Joohwan Chun,et al.  Position tracking of mobiles in a cellular radio network using the constrained bootstrap filter , 2000, Proceedings of the IEEE 2000 National Aerospace and Electronics Conference. NAECON 2000. Engineering Tomorrow (Cat. No.00CH37093).

[27]  Ali H. Sayed,et al.  Linear Estimation (Information and System Sciences Series) , 2000 .

[28]  N. Bergman,et al.  Auxiliary particle filters for tracking a maneuvering target , 2000, Proceedings of the 39th IEEE Conference on Decision and Control (Cat. No.00CH37187).

[29]  Per-Johan Nordlund.  Recursive State Estimation of Nonlinear Systems with Applications to Integrated Navigation , 2000 .

[30]  Richard C. Lind,et al.  An integrated approach to automotive safety systems , 2000 .

[31]  Fredrik Gustafsson,et al.  Adaptive filtering and change detection , 2000 .

[32]  Neil J. Gordon,et al.  Editors: Sequential Monte Carlo Methods in Practice , 2001 .

[33]  Wolfram Burgard,et al.  Particle Filters for Mobile Robot Localization , 2001, Sequential Monte Carlo Methods in Practice.

[34]  Fredrik Gustafsson,et al.  Range estimation using angle-only target tracking with particle filters , 2001, Proceedings of the 2001 American Control Conference. (Cat. No.01CH37148).

[35]  Fredrik Gustafsson,et al.  Sensor Fusion for Accurate Computation of Yaw Rate and Absolute Velocity , 2001 .

[36]  Nando de Freitas,et al.  Sequential Monte Carlo Methods in Practice , 2001, Statistics for Engineering and Information Science.

[37]  Arnaud Doucet,et al.  Particle filters for state estimation of jump Markov linear systems , 2001, IEEE Trans. Signal Process..

[38]  Fredrik Gustafsson,et al.  Monte Carlo data association for multiple target tracking , 2001 .

[39]  O. Wijk.  Triangulation Based Fusion of Sonar Data with Application in Mobile Robot Mapping and Localization , 2001 .

[40]  Niclas Bergman,et al.  Posterior Cramér-Rao Bounds for Sequential Estimation , 2001, Sequential Monte Carlo Methods in Practice.

[41]  Fredrik Gustafsson,et al.  Sequential Monte Carlo filtering techniques applied to integrated navigation systems , 2001, Proceedings of the 2001 American Control Conference. (Cat. No.01CH37148).

[42]  P. Pérez,et al.  Tracking multiple objects with particle filtering , 2002 .

[43]  A. Doucet,et al.  Particle filtering for partially observed Gaussian state space models , 2002 .

[44]  Timothy J. Robinson,et al.  Sequential Monte Carlo Methods in Practice , 2003 .

[45]  M. Enqvist,et al.  A Bayesian Approach to Map-Aided Vehicle Positioning , .