基于动态点去除的激光雷达SLAM算法

LiDAR SLAM algotithm based on dynamic point removal

  • 摘要: 同时定位与建图(Simultaneous localization and mapping, SLAM)能够在未知环境中构建地图并为机器人提供定位信息,是移动机器人领域重要研究方向之一. 当前,大多数SLAM算法在静态环境中有较好的表现,但是在车辆和行人等运动物体较多的环境中,广泛存在的动态点使激光点云前后帧的配准精度不高,降低了动态场景下定位和建图的准确性. 针对激光点云中存在动态点的问题,本文对SLAM的前端特征提取及后端回环检测模块分别进行改进,以去除动态点,提升SLAM在动态环境下的性能. 针对SLAM前端,提出了一种分步的地面分割方法,依据点云高度信息完成地面点粗提取以矫正点云,再使用随机采样一致性方法对矫正后的点云进行精细的地面分割,最后根据高度阈值采用种子生长聚类方法提取非地面动态点,并进行特征提取与配准;针对SLAM后端,使用点云描述子替代传统方法中基于空间位置关系的回环检测方法,以减小累计误差、提高回环检测灵敏度. 实验结果显示,本方法在M2DGR street_08序列数据集上较现有方法均方根误差最大降低29.8%,在KITTI04序列数据集上均方根误差最大降幅达42.7%,说明本方法能有效增强动态环境下SLAM系统的全局一致性与定位精度.

     

    Abstract: Simultaneous localization and mapping (SLAM) is a critical technology for robot autonomous navigation that enables robots to navigate unknown environments by constructing maps while locating their positions. However, most existing SLAM algorithms only perform well in static environments because dynamic objects, such as vehicles and people, introduce dynamic points into the LiDAR points cloud that degrade the accuracy of points cloud registration and lead to cumulative errors in localization and mapping. To address these issues concerning SLAM in dynamic environments, this study proposes a novel LiDAR SLAM algorithm that integrates dynamic points removal and enhance loop closure detection. The proposed algorithm overcomes the critical challenge associated with SLAM in dynamic environments, that is, precise separation of ground and dynamic points, through a three-step ground segmentation process that minimizes the false removal of static objects near the ground. The innovative features of the proposed algorithm include the segmentation of ground structures, the clustering of dynamic objects at the front-end, and the incorporation of optimization factor graphs into loop closure detection at the back-end. At the front-end, a three-step ground point segmentation method is used to reduce point cloud registration errors caused by dynamic points. Firstly, a coarse ground extraction is performed using height-based filtering and voxel grid analysis to correct point cloud distortion due to sensor installation, miscalibration, or motion chattering. Secondly, a refined ground plane fitting is achieved using the random sample consensus (RANSAC) algorithm, which iteratively optimizes the ground model by evaluating inlier points. Thirdly, non-ground points are processed using the growth clustering method in the height threshold seed selection region to identify and remove dynamic objects, such as vehicles and people. The above steps mean that dynamic points can be removed during the feature points extraction period and points cloud registration. These improvements significantly increase the robustness of LiDAR odometry in dynamic environments. At the back-end, a scan-context-based geometric descriptor is employed to enhance the environments representation accuracy by encoding multi-layer height differentials in polar coordinates. The subsequent projection of a keyframe points cloud into a 2D (Two-dimensional) polar grid achieves rotation-invariant feature encoding with height variation quantization. Furthermore, a simulative lateral translation is introduced to improve descriptor sensitivity under lane-changing environments, which means that the detection loop closure candidates can be identified by calculating the cosine similarities between descriptors. This overcomes the accumulated drift in traditional spatial-relationship-based methods and enables efficient and accurate detection, even in repetitive or evolving environments. Experimental validation using the M2DGR street_08 sequence and KITTI 04 sequence demonstrated the superiority of the proposed method. Compared to other state-of-the-art approaches, such as LeGO-LOAM, LIO-SAM, and Removert, this method achieved maximum root mean square error (RMSE) reductions of 29.8% compared to the M2DGR street_08 sequence and maximum RMSE reductions of 42.7% compared to the KITTI 04 sequence. These results confirmed that the proposed method effectively enhanced the global consistency and localization precision of LiDAR SLAM in dynamic environments.

     

/

返回文章
返回