A Lightweight Real-Time 3D LiDAR SLAM for Autonomous Vehicles in Large-Scale Urban Environment

For autonomous vehicles, real-time localization and mapping in the unknown environment is very important. In this paper, a fast and lightweight 3D LiDAR simultaneously localization and mapping (SLAM) is presented for the localization of autonomous vehicles in large-scale urban environments. A novel encoding approach based on depth information is proposed to encode unordered point clouds with various resolutions, which avoids missing dimensional information in the projection of point clouds onto a 2D plane. Principal components analysis (PCA) is modified by dynamically selecting neighborhood points according to the encoded depth information to fit the local plane with less time consuming. The threshold and the number of feature points are adaptive according to distance intervals, results in sparse feature points extracted and uniformly distributed in the three-dimensional space. The extracted significant feature points improve the accuracy of the odometer and speed up the alignment of the point cloud. The effectiveness and robustness of the proposed algorithm are verified on the KITTI odometry benchmark and MVSECD. A fast runtime of 21 ms is obtained for the odometer estimation. Compared to several typical state-of-the-art methods on the KITTI odometry benchmark, the proposed approach reduces translation errors by at least 19% and rotation errors by 7.1%.

[1]  George Lăzăroiu,et al.  Computer Vision Algorithms, Remote Sensing Data Fusion Techniques, and Mapping and Navigation Tools in the Industry 4.0-Based Slovak Automotive Sector , 2022, Mathematics.

[2]  Lihua Xie,et al.  F-LOAM : Fast LiDAR Odometry and Mapping , 2021, 2021 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[3]  Xiaofei Pei,et al.  T-LOAM: Truncated Least Squares LiDAR-Only Odometry and Mapping in Real Time , 2021, IEEE Transactions on Geoscience and Remote Sensing.

[4]  Yue Pan,et al.  MULLS: Versatile LiDAR SLAM via Multi-metric Linear Least Square , 2021, 2021 IEEE International Conference on Robotics and Automation (ICRA).

[5]  Xinming Huang,et al.  A Survey on 3D LiDAR Localization for Autonomous Vehicles , 2020, 2020 IEEE Intelligent Vehicles Symposium (IV).

[6]  Wei Wang,et al.  LIO-SAM: Tightly-coupled Lidar Inertial Odometry via Smoothing and Mapping , 2020, 2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[7]  Zheng Fang,et al.  A Robust Laser-Inertial Odometry and Mapping Method for Large-Scale Highway Environments , 2019, 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[8]  Emanuele Menegatti,et al.  A portable three-dimensional LIDAR-based system for long-term and wide-area people behavior measurement , 2019, International Journal of Advanced Robotic Systems.

[9]  Ayoung Kim,et al.  Scan Context: Egocentric Spatial Descriptor for Place Recognition Within 3D Point Cloud Map , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

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

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

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

[13]  Vijay Kumar,et al.  The Multivehicle Stereo Event Camera Dataset: An Event Camera Dataset for 3D Perception , 2018, IEEE Robotics and Automation Letters.

[14]  Shaojie Shen,et al.  VINS-Mono: A Robust and Versatile Monocular Visual-Inertial State Estimator , 2017, IEEE Transactions on Robotics.

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

[16]  Juan D. Tardós,et al.  ORB-SLAM2: An Open-Source SLAM System for Monocular, Stereo, and RGB-D Cameras , 2016, IEEE Transactions on Robotics.

[17]  Konrad Schindler,et al.  FAST SEMANTIC SEGMENTATION OF 3D POINT CLOUDS WITH STRONGLY VARYING DENSITY , 2016 .

[18]  J. M. M. Montiel,et al.  ORB-SLAM: A Versatile and Accurate Monocular SLAM System , 2015, IEEE Transactions on Robotics.

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

[20]  F. Dellaert Factor Graphs and GTSAM: A Hands-on Introduction , 2012 .

[21]  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.

[22]  Michael Himmelsbach,et al.  Fast segmentation of 3D point clouds for ground vehicles , 2010, 2010 IEEE Intelligent Vehicles Symposium.

[23]  Alexander Kirillov,et al.  An Introduction to Lie Groups and Lie Algebras , 2008 .

[24]  Peter Biber,et al.  The normal distributions transform: a new approach to laser scan matching , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

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

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

[27]  The Algorithmic Governance of Autonomous Driving Behaviors: Multi-Sensor Data Fusion, Spatial Computing Technologies, and Movement Tracking Tools , 2022, Contemporary Readings in Law and Social Justice.

[28]  Socially Responsible Technologies in Autonomous Mobility Systems: Self-Driving Car Control Algorithms, Virtual Data Modeling Tools, and Cognitive Wireless Sensor Networks , 2022, Contemporary Readings in Law and Social Justice.

[29]  Aleksandr V. Segal,et al.  Generalized-ICP , 2009, Robotics: Science and Systems.