This content is not included in
your SAE MOBILUS subscription, or you are not logged in.
Feature-Based Loop Closure Detection and Optimization for LiDAR Mapping
Technical Paper
2020-01-5225
ISSN: 0148-7191, e-ISSN: 2688-3627
This content contains downloadable datasets
Annotation ability available
Sector:
Language:
English
Abstract
High definition (HD) maps provide fundamental data support for intelligent connected vehicles (ICV). Light detection and ranging (LiDAR) has become an essential technique for HD map construction, environmental perception, localization, and other ICV tasks due to its advantage of high scanning accuracy and dense point cloud generation. LiDAR-based simultaneous localization and mapping (SLAM) technology is one prevailing method in HD map construction. However, in a SLAM algorithm, the pose estimation error is prone to accumulate and result in the map’s drift and structural error after long-distance travel. In order to avoid such problems, it is necessary to associate closed-loop data and correct the poses. This paper proposes a feature descriptor to detect loop closure, use a two-phase registration method to match closed-loop data, and optimize the map based on factor graph optimization. First, we calculate the feature direction based on the local distribution of planar feature points and construct the point cloud submap’s descriptor. Loop closure can be detected by calculating the similarity between feature descriptors. We filter the feature direction and set the weight to augment the vertical obstacles’ description in the structured environment. Second, we use the coarse transformation calculated from loop closure detection as the initial value to calculate a finer transformation between the closed-loop submaps by the normal distribution transform (NDT) method. Third, by adding a closed-loop constraint, the map’s error is reduced by factor graph optimization. Finally, based on the KITTI Odometry dataset and our data collected in an industrial park, the proposed method is validated and analyzed.
Authors
Topic
Citation
Jiang, K., Zhang, X., Qin, B., Yang, M. et al., "Feature-Based Loop Closure Detection and Optimization for LiDAR Mapping," SAE Technical Paper 2020-01-5225, 2020, https://doi.org/10.4271/2020-01-5225.Data Sets - Support Documents
Title | Description | Download |
---|---|---|
Unnamed Dataset 1 | ||
Unnamed Dataset 2 | ||
Unnamed Dataset 3 | ||
Unnamed Dataset 4 |
Also In
References
- Liu , R. , Wang , J. , Zhang , B. et al. High Definition Map for Automated Driving: Overview and Analysis Journal of Navigation 73 2 324 341 2020
- Mendes , E. , Koch , P. , and Lacroix , S. ICP-Based Pose-Graph SLAM IEEE International Symposium on Safety 2016
- Bosse , M. , and Zlot , R. Map Matching and Data Association for Large-Scale Two-dimensional Laser Scan-Based SLAM The International Journal of Robotics Research 27 6 667 691 2008
- Bosse , M. and Zlot , R. Place Recognition Using Keypoint Voting in Large 3D Lidar Datasets IEEE International Conference on Robotics & Automation 2013
- Rusu , B. , Marton , Z.C. , Blodow , N. et al. Learning Informative Point Classes for the Acquisition of Object Model Maps International Conference on Control 2008
- Rusu , B. , Blodow , N. , and Beetz , M. Fast Point Feature Histograms (FPFH) for 3D Registration IEEE International Conference on Robotics & Automation 2009
- Lin , J. and Zhang , F. 2019
- Lin , J. and Zhang , F. 2019
- Dubé , R. , Dugas , D. , Stumm , E. et al. SegMatch: Segment Based Place Recognition in 3D Point Clouds 2017 IEEE International Conference on Robotics and Automation (ICRA) 2017
- Dubé , R. , Cramariuc , A. , Dugas , D. et al. SegMap: Segment-Based Mapping and Localization Using Data-Driven Descriptors The International Journal of Robotics Research 39 2/3 339 355 2020
- Olson , B. Real-Time Correlative Scan Matching IEEE International Conference on Robotics & Automation 2009
- Hess , W. , Kohler , D. , Rapp , H. et al. Real-Time Loop Closure in 2D LiDAR SLAM 2016 IEEE International Conference on Robotics and Automation (ICRA) 2016
- Zhang , J. , and Singh , S. LOAM: LiDAR Odometry and Mapping in Real-time Robotics Science and Systems 2014
- HKUST Aerial Robotics Group 2018 https://github.com/HKUST-Aerial-Robotics/A-LOAM
- Besl , J. , and Mckay , D. A Method for Registration of 3-D Shapes IEEE Transactions on Pattern Analysis and Machine Intelligence 14 2 239 256 1992
- Biber , P. and Strasser , W. The Normal Distributions Transform: A New Approach to Laser Scan Matching Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) Las Vegas, NV 2003 3 2743 2748 10.1109/IROS.2003.1249285
- Rusu , B. and Cousins , S. 3D is Here: Point Cloud Library (PCL) International Conference on Robotics and Automation 2011 1 4
- Kaess , M. , Ranganathan , A. , Dellaert , F. et al. iSAM: Incremental Smoothing and Mapping IEEE Transactions on Robotics 24 6 1365 1378 2008
- Kaess , M. , Johannsson , H. , Roberts , R. et al. iSAM2: Incremental Smoothing and Mapping Using the Bayes Tree The International Journal of Robotics Research 31 2 216 235 2012
- Geiger , A. , Lenz , P. , Urtasun , R. et al. Are We Ready for Autonomous Driving? The KITTI Vision Benchmark Suite Computer Vision and Pattern Recognition 3354 3361 2012
- Grupp , M. 2017 https://github.com/MichaelGrupp/evo
- Umeyama , S. Least-Squares Estimation of Transformation Parameters between Two Point Patterns IEEE Transactions on Pattern Analysis and Machine Intelligence 13 4 376 380 1991