3D SLAM for planetary worksite mapping

In this paper, we present a robust framework suitable for conducting three-dimensional Simultaneous Localization and Mapping (3D SLAM) in a planetary worksite environment. By utilizing a laser rangefinder mounted on a rover platform, we have demonstrated an approach that is able to create globally consistent maps of natural, unstructured 3D terrain. The framework presented in this paper utilizes a sparse-feature-based approach, and conducts data association using a hybrid combination of feature constellations and dense data. To maintain global consistency, the measurements are resolved using a batch alignment algorithm, which is reinforced with batch outlier rejection to improve its robustness. Finally, a map is created from the alignment estimates and the dense data. Validation is provided using data gathered at two different planetary analogue facilities.

[1]  Ian D. Reid,et al.  Vast-scale Outdoor Navigation Using Adaptive Relative Bundle Adjustment , 2010, Int. J. Robotics Res..

[2]  P. Furgale,et al.  Pose estimation using linearized rotations and quaternion algebra , 2011 .

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

[4]  C. Liebe.  Star trackers for attitude determination , 1995 .

[5]  Erick Dupuis,et al.  Rover Localization through 3D Terrain Registration in Natural Environments , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[6]  B. Taati.  GENERATION AND OPTIMIZATION OF LOCAL SHAPE DESCRIPTORS FOR POINT MATCHING IN 3-D SURFACES , 2009 .

[7]  NüchterAndreas,et al.  6D SLAM3D mapping outdoor environments , 2007 .

[8]  Joonki Paik,et al.  Point fingerprint: A new 3-D object representation scheme , 2003, IEEE Trans. Syst. Man Cybern. Part B.

[9]  Kurt Konolige,et al.  Large-Scale Visual Odometry for Rough Terrain , 2007, ISRR.

[10]  William Whittaker,et al.  SUN-SYNCHRONOUS LUNAR POLAR ROVER AS A FIRST STEP TO RETURN TO THE MOON , 2005 .

[11]  Tim D. Barfoot,et al.  A self-calibrating 3D ground-truth localization system using retroreflective landmarks , 2011, 2011 IEEE International Conference on Robotics and Automation.

[12]  Robert C. Bolles,et al.  Random sample consensus: a paradigm for model fitting with applications to image analysis and automated cartography , 1981, CACM.

[13]  Kurt Konolige,et al.  FrameSLAM: From Bundle Adjustment to Real-Time Visual Mapping , 2008, IEEE Transactions on Robotics.

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

[15]  Yi-Ping Hung,et al.  RANSAC-Based DARCES: A New Approach to Fast Automatic Registration of Partially Overlapping Range Images , 1999, IEEE Trans. Pattern Anal. Mach. Intell..

[16]  Tomasz Malisiewicz,et al.  Registration of multiple range scans as a location recognition problem: hypothesis generation, refinement and verification , 2005, Fifth International Conference on 3-D Digital Imaging and Modeling (3DIM'05).

[17]  Tim D. Barfoot,et al.  Batch heterogeneous outlier rejection for feature-poor SLAM , 2011, 2011 IEEE International Conference on Robotics and Automation.

[18]  Joachim Hertzberg,et al.  Benchmarking urban six‐degree‐of‐freedom simultaneous localization and mapping , 2008, J. Field Robotics.

[19]  Thiagalingam Kirubarajan,et al.  Estimation with Applications to Tracking and Navigation , 2001 .

[20]  Joachim Hertzberg,et al.  Globally consistent 3D mapping with scan matching , 2008, Robotics Auton. Syst..

[21]  Wayne Zimmerman,et al.  Analysis of Concepts for Large-Scale Robotic Lunar Precursor Missions , 2007, 2007 IEEE International Conference on System of Systems Engineering.

[22]  Andrew E. Johnson,et al.  Spin-Images: A Representation for 3-D Surface Matching , 1997 .

[23]  P. Mahalanobis.  On the generalized distance in statistics , 1936 .

[24]  Paul Timothy Furgale,et al.  Towards appearance-based methods for lidar sensors , 2011, 2011 IEEE International Conference on Robotics and Automation.

[25]  Paul Timothy Furgale,et al.  Long-range rover localization by matching LIDAR scans to orbital elevation maps , 2010, J. Field Robotics.

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

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