A Novel 3D LiDAR SLAM Based on Directed Geometry Point and Sparse Frame

Simultaneous localization and mapping is an indispensable yet challenging direction for mobile robots. Attracted by 3D LiDAR with accurate depth information and robustness to illumination variations, many 3D LiDAR SLAM methods based on scan-to-map matching have been developed. However, there is a critical issue of existing approaches, where a large and dense map is generally required to achieve satisfactory localization accuracy, leading to low efficiency of scan-to-map matching. To solve this problem, in this letter, we propose a novel 3D LiDAR SLAM based on directed geometry point (DGP) and sparse frame. The former is used to provide a sparse distribution of points in the spatial dimension and the latter gives rise to a sparse distribution of frames in the temporal sequence. The sparsity of points and frames impove the efficiency of 3D LiDAR SLAM, and the strict data association based on directed geometric points also brings in good accuracy of pose estimation. To compensate the accuracy loss of the localization and mapping caused by frame sparsity, point propagation is proposed to improve the quality of directed geometric points in the map and the accuracy of scan-to-map matching. Also, loop detection and pose graph optimization are conducted for global consistency. The experimental results demonstrate the effectiveness of the proposed method in terms of accuracy and efficiency.

[1]  Brendan Englot,et al.  LeGO-LOAM: Lightweight and Ground-Optimized Lidar Odometry and Mapping on Variable Terrain , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

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

[3]  Ji Zhang,et al.  LOAM: Lidar Odometry and Mapping in Real-time , 2014, Robotics: Science and Systems.

[4]  Timothy D. Barfoot,et al.  State Estimation for Robotics , 2017 .

[5]  Giorgio Grisetti,et al.  NICP: Dense normal based point cloud registration , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[6]  Andreas Geiger,et al.  Are we ready for autonomous driving? The KITTI vision benchmark suite , 2012, 2012 IEEE Conference on Computer Vision and Pattern Recognition.

[7]  Javier Civera,et al.  DynaSLAM: Tracking, Mapping, and Inpainting in Dynamic Scenes , 2018, IEEE Robotics and Automation Letters.

[8]  Xiaqing Ding,et al.  Multi-Session Map Construction in Outdoor Dynamic Environment , 2018, 2018 IEEE International Conference on Real-time Computing and Robotics (RCAR).

[9]  Guangming Xiong,et al.  CPFG-SLAM:a Robust Simultaneous Localization and Mapping based on LIDAR in Off-Road Environment , 2018, 2018 IEEE Intelligent Vehicles Symposium (IV).

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

[11]  Jean-Emmanuel Deschaud,et al.  IMLS-SLAM: Scan-to-Model Matching Based on 3D Data , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

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

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

[14]  Hannes Sommer,et al.  Incremental-Segment-Based Localization in 3-D Point Clouds , 2018, IEEE Robotics and Automation Letters.

[15]  Wolfram Burgard,et al.  Long-Term Urban Vehicle Localization Using Pole Landmarks Extracted from 3-D Lidar Scans , 2019, 2019 European Conference on Mobile Robots (ECMR).

[16]  Augusto Luis Ballardini,et al.  An Indoor Localization System for Telehomecare Applications , 2016, IEEE Transactions on Systems, Man, and Cybernetics: Systems.

[17]  Kurt Konolige,et al.  Navigation in hybrid metric-topological maps , 2011, 2011 IEEE International Conference on Robotics and Automation.

[18]  Roland Siegwart,et al.  3D SLAM using planar segments , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[19]  Frank Dellaert,et al.  iSAM2: Incremental smoothing and mapping using the Bayes tree , 2012, Int. J. Robotics Res..

[20]  Cyrill Stachniss,et al.  SuMa++: Efficient LiDAR-based Semantic SLAM , 2019, 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[21]  Radu Bogdan Rusu,et al.  3D is here: Point Cloud Library (PCL) , 2011, 2011 IEEE International Conference on Robotics and Automation.

[22]  Laurent Itti,et al.  Efficient Velodyne SLAM with point and plane features , 2018, Autonomous Robots.

[23]  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).

[24]  Davide Scaramuzza,et al.  A Tutorial on Quantitative Trajectory Evaluation for Visual(-Inertial) Odometry , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[25]  Friedrich Fraundorfer,et al.  Camera Pose Estimation Based on PnL With a Known Vertical Direction , 2019, IEEE Robotics and Automation Letters.

[26]  Nikolaos Papanikolopoulos,et al.  Fast segmentation of 3D point clouds: A paradigm on LiDAR data for autonomous vehicle applications , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[27]  Tom Duckett,et al.  Scan registration for autonomous mining vehicles using 3D‐NDT , 2007, J. Field Robotics.

[28]  Frank Dellaert,et al.  On-Manifold Preintegration for Real-Time Visual--Inertial Odometry , 2015, IEEE Transactions on Robotics.

[29]  Cyrill Stachniss,et al.  Efficient Surfel-Based SLAM using 3D Laser Range Data in Urban Environments , 2018, Robotics: Science and Systems.