Probabilistic Self-Localization and Mapping - An Asynchronous Multirate Approach

One of the main contributions of this article is related to the multirate asynchronous filtering approach for the SLAM problem based on PFs. Previous multirate filter contributions are mainly for linear systems. A Kalman filter is applied for linear quadratic regulator (LQG) control, while in a Kalman filter is developed using lifting techniques. In this article, significant improvements for robot pose estimation are obtained when introducing multirate techniques to FastSLAM. In particular, it is shown that multirate fusion aims to provide more accurate results in loop-closing problems in SLAM (localization and map building problems with closed paths). Additionally, in this article a pose estimation algorithm based on least squares (LS) fitting of line features is proposed. Since the complexity of LS fitting is linear to the number of features, this implies a low computational cost than other techniques. Therefore, methods based on PFs such as MCL and FastSLAM that require a large number of particles may benefit from this fact. In particular, this provides an accurate approximation of the posterior PDF for FastSLAM 2.0.

[1]  Masayoshi Tomizuka,et al.  Dual-rate high order hold equivalent controllers , 2000, Proceedings of the 2000 American Control Conference. ACC (IEEE Cat. No.00CH36334).

[2]  Paolo Fiorini,et al.  A Robotic Wheelchair for Crowded Public Environments MAid Combines Narrow- and Wide-Area Navigation Behaviors for Traversing Varying Environments While Retaining User Independence and Preventing Fatigue , 2001 .

[3]  Leopoldo Armesto,et al.  SLAM based on Kalman filter for multi-rate fusion of laser and encoder measurements , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[4]  Sukhan Lee,et al.  Multisensor Fusion and Integration for Intelligent Systems , 2009 .

[5]  K. Poolla,et al.  Robust control of linear time-invariant plants using periodic compensation , 1985 .

[6]  Alan E. Gelfand,et al.  Bayesian statistics without tears: A sampling-resampling perspective , 1992 .

[7]  Henrik I. Christensen,et al.  Simultaneous localization and mapping in domestic environments , 2001, Conference Documentation International Conference on Multisensor Fusion and Integration for Intelligent Systems. MFI 2001 (Cat. No.01TH8590).

[8]  Andrea Bonci,et al.  Methods and Algorithms for Sensor Data Fusion Aimed at Improving the Autonomy of a Mobile Robot , 2004, Advances in Control of Articulated and Mobile Robots.

[9]  José A. Castellanos,et al.  Multisensor fusion for simultaneous localization and map building , 2001, IEEE Trans. Robotics Autom..

[10]  Nando de Freitas,et al.  Rao-Blackwellised Particle Filtering for Dynamic Bayesian Networks , 2000, UAI.

[11]  Henrik I. Christensen,et al.  Pose tracking using laser scanning and minimalistic environmental models , 2001, IEEE Trans. Robotics Autom..

[12]  Masayoshi Tomizuka,et al.  Modeling, analysis and design tools for dual-rate systems , 2002, Proceedings of the 2002 American Control Conference (IEEE Cat. No.CH37301).

[13]  Alain Pruski,et al.  An autonomous vehicle for people with motor disabilities , 2001, IEEE Robotics Autom. Mag..

[14]  Masayoshi Tomizuka,et al.  Analysis of multi-rate discrete equivalent of continuous controller , 1999, Proceedings of the 1999 American Control Conference (Cat. No. 99CH36251).

[15]  Geovany de Araújo Borges,et al.  Optimal mobile robot pose estimation using geometrical maps , 2002, IEEE Trans. Robotics Autom..

[16]  Wolfram Burgard,et al.  Monte Carlo localization for mobile robots , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[17]  T Leo,et al.  A navigation system for increasing the autonomy and the security of powered wheelchairs. , 2000, IEEE transactions on rehabilitation engineering : a publication of the IEEE Engineering in Medicine and Biology Society.

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

[19]  P. Fearnhead,et al.  An improved particle filter for non-linear problems , 1999 .

[20]  Masayoshi Tomizuka,et al.  Multirate optimal state estimation with sensor fusion , 2003, Proceedings of the 2003 American Control Conference, 2003..

[21]  Sebastian Thrun,et al.  FastSLAM: a factored solution to the simultaneous localization and mapping problem , 2002, AAAI/IAAI.

[22]  Stephen M. Rock,et al.  Relative position sensing by fusing monocular vision and inertial rate sensors , 2003 .

[23]  Markus Vincze,et al.  Multi-rate fusion with vision and inertial sensors , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

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

[25]  David G. Stork,et al.  Pattern Classification (2nd ed.) , 1999 .

[26]  Sebastian Thrun,et al.  FastSLAM 2.0: An Improved Particle Filtering Algorithm for Simultaneous Localization and Mapping that Provably Converges , 2003, IJCAI.

[27]  Sebastian Thrun,et al.  Probabilistic robotics , 2002, CACM.

[28]  G. Ippoliti,et al.  Sonar and Video Data Fusion for Robot Localization and Environment Feature Estimation , 2005, Proceedings of the 44th IEEE Conference on Decision and Control.

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

[30]  Jeffrey K. Uhlmann,et al.  Reduced sigma point filters for the propagation of means and covariances through nonlinear transformations , 2002, Proceedings of the 2002 American Control Conference (IEEE Cat. No.CH37301).

[31]  Paolo Fiorini,et al.  A robotics wheelchair for crowded public environment , 2001, IEEE Robotics Autom. Mag..

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

[33]  Hugh F. Durrant-Whyte,et al.  A solution to the simultaneous localization and map building (SLAM) problem , 2001, IEEE Trans. Robotics Autom..

[34]  Geovany de Araújo Borges,et al.  Line Extraction in 2D Range Images for Mobile Robotics , 2004, J. Intell. Robotic Syst..

[35]  Pedro Albertos,et al.  Multirate LQG controller applied to self-location and path-tracking in mobile robots , 2001, Proceedings 2001 IEEE/RSJ International Conference on Intelligent Robots and Systems. Expanding the Societal Role of Robotics in the the Next Millennium (Cat. No.01CH37180).

[36]  Patrizio Colaneri,et al.  Multirate LQG control of continuous-time stochastic systems , 1995, Autom..

[37]  Shigeo Abe DrEng.  Pattern Classification , 2001, Springer London.

[38]  L. Armesto,et al.  Dual-rate high order holds based on primitive functions , 2003, Proceedings of the 2003 American Control Conference, 2003..

[39]  BurgardWolfram,et al.  A Probabilistic Approach to Concurrent Mapping and Localization for Mobile Robots , 1998 .

[40]  Nando de Freitas,et al.  The Unscented Particle Filter , 2000, NIPS.