Globally consistent 3D mapping with scan matching

A globally consistent solution to the simultaneous localization and mapping (SLAM) problem in 2D with three degrees of freedom (DoF) poses was presented by Lu and Milios [F. Lu, E. Milios, Globally consistent range scan alignment for environment mapping, Autonomous Robots 4 (April) (1997) 333-349]. To create maps suitable for natural environments it is however necessary to consider the 6DoF pose case, namely the three Cartesian coordinates and the roll, pitch and yaw angles. This article describes the extension of the proposed algorithm to deal with these additional DoFs and the resulting non-linearities. Simplifications using Taylor expansion and Cholesky decomposition yield a fast application that handles the massive amount of 3D data and the computational requirements due to the 6DoF. Our experiments demonstrate the functionality of estimating the exact poses and their covariances in all 6DoF, leading to a globally consistent map. The correspondences between scans are found automatically by use of a simple distance heuristic.

[1]  Sebastian Thrun,et al.  Probabilistic Terrain Analysis For High-Speed Desert Driving , 2006, Robotics: Science and Systems.

[2]  A. Nuchter,et al.  6D SLAM with approximate data association , 2005, ICAR '05. Proceedings., 12th International Conference on Advanced Robotics, 2005..

[3]  Berthold K. P. Horn,et al.  Closed-form solution of absolute orientation using unit quaternions , 1987 .

[4]  Gérard G. Medioni,et al.  Object modelling by registration of multiple range images , 1992, Image Vis. Comput..

[5]  Peter Kohlhepp,et al.  Schritthaltende 3D-Kartierung und Lokalisierung für mobile Inspektionsroboter , 2003, AMS.

[6]  Wolfram Burgard,et al.  Improving Simultaneous Mapping and Localization in 3D Using Global Constraints , 2005, AAAI.

[7]  Paul Newman,et al.  Using laser range data for 3D SLAM in outdoor environments , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[8]  Joachim Hertzberg,et al.  Ground truth evaluation of large urban 6D SLAM , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[9]  Wolfram Burgard,et al.  A real-time algorithm for mobile robot mapping with applications to multi-robot and 3D mapping , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[10]  Henrik I. Christensen,et al.  Outdoor exploration and SLAM using a compressed filter , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[11]  Hugh F. Durrant-Whyte,et al.  Simultaneous Localization and Mapping with Sparse Extended Information Filters , 2004, Int. J. Robotics Res..

[12]  T. Michael Knasel,et al.  Robotics and autonomous systems , 1988, Robotics Auton. Syst..

[13]  Peter K. Allen,et al.  Localization methods for a mobile robot in urban environments , 2004, IEEE Transactions on Robotics.

[14]  Joachim Hertzberg,et al.  A 3D laser range finder for autonomous mobile robots , 2001 .

[15]  Ioannis Stamos,et al.  AVENUE: Automated site modeling in urban environments , 2001, Proceedings Third International Conference on 3-D Digital Imaging and Modeling.

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

[17]  Eduardo Mario Nebot,et al.  Integrated Sensing Framework for 3D Mapping in Outdoor Navigation , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[18]  Bart C. Nabbe,et al.  Progress in 3-D Mapping and Localization , 2001 .

[19]  Wolfram Burgard,et al.  A Probabilistic Approach to Concurrent Mapping and Localization for Mobile Robots , 1998, Auton. Robots.

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

[21]  John B. Moore,et al.  Global registration of multiple 3D point sets via optimization-on-a-manifold , 2005, SGP '05.

[22]  Francis Schmitt,et al.  Fast global registration of 3D sampled surfaces using a multi-z-buffer technique , 1999, Image Vis. Comput..

[23]  Roland Siegwart,et al.  EKF-based 3D SLAM for structured environment reconstruction , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[24]  Robert Bergevin,et al.  Towards a General Multi-View Registration Technique , 1996, IEEE Trans. Pattern Anal. Mach. Intell..

[25]  Udo Frese,et al.  Simultaneous Localization and Mapping - A Discussion , 2001 .

[26]  Evangelos E. Milios,et al.  Globally Consistent Range Scan Alignment for Environment Mapping , 1997, Auton. Robots.

[27]  Erik Wolfart,et al.  Automated 3D reconstruction of interiors with multiple scan views , 1998, Electronic Imaging.

[28]  Henrik I. Christensen,et al.  2D mapping of cluttered indoor environments by means of 3D perception , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[29]  Wolfram Burgard,et al.  Multi-Level Surface Maps for Outdoor Terrain Mapping and Loop Closing , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[30]  Kari Pulli,et al.  Multiview registration for large data sets , 1999, Second International Conference on 3-D Digital Imaging and Modeling (Cat. No.PR00062).

[31]  Ryosuke Shibasaki,et al.  Reconstructing a textured CAD model of an urban environment using vehicle-borne laser range scanners and line cameras , 2003, Machine Vision and Applications.

[32]  Francis Schmitt,et al.  A Solution for the Registration of Multiple 3D Point Sets Using Unit Quaternions , 1998, ECCV.

[33]  Tom Duckett,et al.  A comparison of 3D registration algorithms for autonomous underground mining vehicles , 2005 .

[34]  Udo Frese.  Efficient 6-DOF SLAM with Treemap as a Generic Backend , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[35]  Sebastian Thrun,et al.  Robotic mapping: a survey , 2003 .

[36]  Joachim Hertzberg,et al.  6D SLAM—3D mapping outdoor environments , 2007, J. Field Robotics.

[37]  Paul J. Besl,et al.  A Method for Registration of 3-D Shapes , 1992, IEEE Trans. Pattern Anal. Mach. Intell..

[38]  Edwin Olson,et al.  Fast iterative alignment of pose graphs with poor initial estimates , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[39]  Christian Früh,et al.  3D model generation for cities using aerial photographs and ground level laser scans , 2001, Proceedings of the 2001 IEEE Computer Society Conference on Computer Vision and Pattern Recognition. CVPR 2001.