Inferring and Enforcing Relative Constraints in SLAM

Most algorithms for simultaneous localization and mapping (slam) do not incorporate prior knowledge of structural or geometrical characteristics of the environment. In some cases, such information is readily available and making some assumptions is reasonable. For example, one can often assume that many walls in an indoor environment are rectilinear. In this paper, we develop a slam algorithm that incorporates prior knowledge of relative constraints between landmarks. We describe a “Rao-Blackwellized constraint filter” that infers applicable constraints and efficiently enforces them in a particle filtering framework. We have implemented our approach with rectilinearity constraints. Results from simulated and real-world experiments show the use of constraints leads to consistency improvements and a reduction in the number of particles needed to build maps.

[1]  Ramón Galán,et al.  Consistency improvement for SLAM - EKF for indoor environments , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[2]  Kevin P. Murphy,et al.  Bayesian Map Learning in Dynamic Environments , 1999, NIPS.

[3]  Martial Hebert,et al.  Invariant filtering for simultaneous localization and mapping , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[4]  D. Simon,et al.  Kalman filtering with state equality constraints , 2002 .

[5]  Hugh F. Durrant-Whyte,et al.  New approach to map building using relative position estimates , 1997, Defense, Security, and Sensing.

[6]  Wesley H. Huang,et al.  SLAM with sparse sensing , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

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

[8]  Hugh F. Durrant-Whyte,et al.  Model-based multi-sensor data fusion , 1992, Proceedings 1992 IEEE International Conference on Robotics and Automation.

[9]  Donald L. Simon,et al.  Aircraft Turbofan Engine Health Estimation Using Constrained Kalman Filtering , 2005 .

[10]  Eduardo Mario Nebot,et al.  Consistency of the FastSLAM algorithm , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[11]  Thia Kirubarajan,et al.  Estimation with Applications to Tracking and Navigation: Theory, Algorithms and Software , 2001 .

[12]  Hugh F. Durrant-Whyte,et al.  Uncertain geometry in robotics , 1987, Proceedings. 1987 IEEE International Conference on Robotics and Automation.