版权所有:内蒙古大学图书馆 技术提供:维普资讯• 智图
内蒙古自治区呼和浩特市赛罕区大学西街235号 邮编: 010021
作者机构:Beijing Inst Technol Shenzhen Automot Res Inst Shenzhen 518118 Peoples R China Beijing Inst Technol Sch Mech Engn Natl Engn Lab Elect Vehicles Beijing 100081 Peoples R China ShenZhen Boundless Sensor Technol CompanyLtd Shenzhen 518118 Peoples R China
出 版 物:《IEEE ROBOTICS AND AUTOMATION LETTERS》 (IEEE Robot. Autom.)
年 卷 期:2024年第9卷第11期
页 面:10295-10302页
核心收录:
学科分类:0808[工学-电气工程] 08[工学] 0811[工学-控制科学与工程]
基 金:Key-Area Research and Development Program of Guangdong Province [2023B0909040001] Shenzhen Science and Technology Program [KJZD20231023100304010] National Key R&D Program of China [2022YFB2503203]
主 题:Laser radar Odometry Feature extraction Accuracy Simultaneous localization and mapping Vectors Point cloud compression Robustness Pose estimation Optimization methods ICP pose graph optimization SLAM submap
摘 要:In LiDAR-based Simultaneous Localization and Mapping (SLAM) systems, loop closure detection is crucial for enhancing the accuracy of odometry. However, constraints from loop closure detection are only provided when a loop is detected and can only enhance odometry accuracy at specific moments. Therefore, this letter proposes a LiDAR inertial odometry system that periodically provides submap constraints to the pose graph and enhances odometry accuracy through pose graph optimization. The system represents LiDAR keyframes as a collection of submaps containing overlapping information during the process of creating submap constraints. The optimal pose transformations between submaps, determined using the Iterative Closest Point (ICP) algorithm with point-to-line and point-to-plane methods, are recognized as submap constraints. During the backend optimization phase, submap constraints and adjacent LiDAR keyframe constraints are integrated into the pose graph. The pose graph is then optimized using the pose graph optimization method to achieve the optimal LiDAR pose estimation. Additionally, To further enhance pose estimation, point-to-plane correspondence is established by considering the differences in normal vectors of feature points between the scan and the map, a feature extraction method based on ground segmentation is proposed, and an integrated initial positioning module is created by incorporating preintegration and scan-to-scan matching. The results of simulation, public datasets and vehicle experiments show that the accuracy of the proposed algorithm is significantly improved compared to the advanced SLAM algorithm.