Scalable and Elastic LiDAR Reconstruction in Complex Environments Through Spatial Analysis

This paper presents novel strategies for spawning and fusing submaps within an elastic dense 3D reconstruction system. The proposed system uses spatial understanding of the scanned environment to control memory usage growth by fusing overlapping submaps in different ways. This allows the number of submaps and memory consumption to scale with the size of the environment rather than the duration of exploration. By analysing spatial overlap, our system segments distinct spaces, such as rooms and stairwells on the fly during exploration. Additionally, we present a new mathematical formulation of relative uncertainty between poses to improve the global consistency of the reconstruction. Performance is demonstrated using a multi-floor multi-room indoor experiment, a large-scale outdoor experiment and simulated datasets. Relative to our baseline, the presented approach demonstrates improved scalability and accuracy.

[1]  Roland Siegwart,et al.  Voxblox: Incremental 3D Euclidean Signed Distance Fields for on-board MAV planning , 2016, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[2]  J A Oteo,et al.  The Baker-Campbell-Hausdorff formula and the convergence of the Magnus expansion , 1989 .

[3]  Roland Siegwart,et al.  Comparing ICP variants on real-world data sets , 2013, Auton. Robots.

[4]  Milad Ramezani,et al.  Online LiDAR-SLAM for Legged Robots with Robust Registration and Deep-Learned Loop Closure , 2020, 2020 IEEE International Conference on Robotics and Automation (ICRA).

[5]  Renato Pajarola,et al.  Piecewise‐planar Reconstruction of Multi‐room Interiors with Arbitrary Wall Arrangements , 2016, Comput. Graph. Forum.

[6]  Ryan M. Eustice,et al.  Characterizing the Uncertainty of Jointly Distributed Poses in the Lie Algebra , 2019, IEEE Transactions on Robotics.

[7]  Geoffrey A. Hollinger,et al.  Active planning for underwater inspection and the benefit of adaptivity , 2012, Int. J. Robotics Res..

[8]  Reinhard Klein,et al.  Automatic reconstruction of fully volumetric 3D building models from oriented point clouds , 2019, ISPRS Journal of Photogrammetry and Remote Sensing.

[9]  Michael Kaess,et al.  Online and Consistent Occupancy Grid Mapping for Planning in Unknown Environments , 2019, 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[10]  Franz S. Hover,et al.  Advanced perception, navigation and planning for autonomous in-water ship hull inspection , 2012, Int. J. Robotics Res..

[11]  Sisi Zlatanova,et al.  Indoor 3D reconstruction from point clouds for optimal routing in complex buildings to support disaster management , 2020 .

[12]  Simona Nobili,et al.  Predicting Alignment Risk to Prevent Localization Failure , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[13]  William E. Lorensen,et al.  Marching cubes: A high resolution 3D surface construction algorithm , 1987, SIGGRAPH.

[14]  Amanda Bouman,et al.  Autonomous Spot: Long-Range Autonomous Exploration of Extreme Environments with Legged Locomotion , 2020, 2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[15]  Eric Heiden,et al.  LAMP: Large-Scale Autonomous Mapping and Positioning for Exploration of Perceptually-Degraded Subterranean Environments , 2020, 2020 IEEE International Conference on Robotics and Automation (ICRA).

[16]  Renato Pajarola,et al.  Automatic room detection and reconstruction in cluttered indoor environments with complex room layouts , 2014, Comput. Graph..

[17]  Wolfram Burgard,et al.  OctoMap: an efficient probabilistic 3D mapping framework based on octrees , 2013, Autonomous Robots.

[18]  Eduardo Mario Nebot,et al.  DenseSLAM: Simultaneous Localization and Dense Mapping , 2006, Int. J. Robotics Res..

[19]  Peter Fankhauser,et al.  Advances in real‐world applications for legged robots , 2018, J. Field Robotics.

[20]  Roland Siegwart,et al.  Voxgraph: Globally Consistent, Volumetric Mapping Using Signed Distance Function Submaps , 2020, IEEE Robotics and Automation Letters.

[21]  Milad Ramezani,et al.  The Newer College Dataset: Handheld LiDAR, Inertial and Vision with Ground Truth , 2020, ArXiv.

[22]  Avideh Zakhor,et al.  Floor plan generation and room labeling of indoor environments from laser range data , 2015, 2014 International Conference on Computer Graphics Theory and Applications (GRAPP).

[23]  Stefan Leutenegger,et al.  Elastic and Efficient LiDAR Reconstruction for Large-Scale Exploration Tasks , 2020, ArXiv.

[24]  Silvio Savarese,et al.  3D Semantic Parsing of Large-Scale Indoor Spaces , 2016, 2016 IEEE Conference on Computer Vision and Pattern Recognition (CVPR).

[25]  Michael Kaess,et al.  Virtual Occupancy Grid Map for Submap-based Pose Graph SLAM and Planning in 3D Environments , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[26]  Roland Siegwart,et al.  Receding horizon path planning for 3D exploration and surface inspection , 2018, Auton. Robots.

[27]  Michael Bosse,et al.  An Atlas framework for scalable mapping , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).