Guaranteed simultaneous localization and mapping algorithm using interval analysis

To increase the autonomy of robots, it is necessary to have a precise and guaranteed localization. We propose a SLAM algorithm based on interval analysis and constraints propagation. The problem is casted into a constraint satisfaction which is solved in a guaranteed way via Interval Analysis. We define a new bounded landmark parameterization and an initialization method for monocular camera. Finally, we introduce the post-localization process which improves the localization accuracy using the future observations. Both simulations and experiments show guaranteed and consistent results of CP-SLAM.

[1]  Luc Jaulin,et al.  A set approach to the simultaneous localization and map building - application to underwater robots , 2007, ICINCO-RA.

[2]  Andrea Garulli,et al.  Set membership localization and mapping for autonomous navigation , 2001 .

[3]  Eric Brassart,et al.  Incremental Construction of the Robot's Environmental Map Using Interval Analysis , 2003, COCOS.

[4]  Luc Jaulin.  A Nonlinear Set Membership Approach for the Localization and Map Building of Underwater Robots , 2009, IEEE Transactions on Robotics.

[5]  Andrea Garulli,et al.  A Set Theoretic Approach to Dynamic Robot Localization and Mapping , 2004, Auton. Robots.

[6]  Luc Jaulin,et al.  Applied Interval Analysis , 2001, Springer London.

[7]  Ramon E. Moore.  Methods and applications of interval analysis , 1979, SIAM studies in applied mathematics.

[8]  Javier Civera,et al.  Unified Inverse Depth Parametrization for Monocular SLAM , 2006, Robotics: Science and Systems.

[9]  Luc Jaulin.  Localization of an Underwater Robot Using Interval Constraint Propagation , 2006, CP.

[10]  David L. Waltz,et al.  Understanding Line drawings of Scenes with Shadows , 1975 .

[11]  Amadou Gning,et al.  Constraints propagation techniques on intervals for a guaranteed localization using redundant data , 2006, Autom..

[12]  Patrick Rives,et al.  Bearing-only SLAM: comparison between probabilistic and deterministic methods , 2008 .

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

[14]  Josep M. Porta,et al.  CuikSLAM: A Kinematics-based Approach to SLAM , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[15]  Eric Walter,et al.  Experimental vehicle localization by bounded-error state estimation using interval analysis , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[16]  Alain Lambert,et al.  Experimental comparison of Bounded-Error State Estimation and Constraints Propagation , 2011, 2011 IEEE International Conference on Robotics and Automation.

[17]  Alan K. Mackworth.  Consistency in Networks of Relations , 1977, Artif. Intell..

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