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

Lidar SLAM Algotithm Based on Dynamic Point Removal

  • 摘要: 同时定位与建图(Simultaneous Localization and Mapping,SLAM)是移动机器人领域重要研究方向之一。SLAM能够在未知环境中构建地图并为机器人提供定位信息。当前大多数SLAM算法在静态环境中有较好的表现。但是,在车辆和行人等运动物体较多的环境中,激光点云中存在动态点,而动态点的出现会影响前后帧点云的配准精度。针对该问题,本文利用激光点云的几何信息,对SLAM的前端特征提取及后端回环检测模块进行改进,通过去除点云中的动态点,提升移动机器人在动态环境下定位与建图的准确性。首先,为提高前端特征提取精度,提出了一种分步的地面分割方法,依据点云高度信息完成地面点粗提取以矫正点云;其次,使用随机采样一致性方法对矫正后的点云进行精细的地面分割;再次,根据高度阈值采用种子生长聚类方法提取非地面点动态点并进行特征提取与配准;最后,针对后端回环检测模块,使用点云描述子替代传统方法中基于空间位置关系的回环检测方法,以减小累计误差,提高回环检测灵敏度。通过可视化仿真及精度评估,验证了所提出方法的有效性。

     

    Abstract: Simultaneous Localization and Mapping (SLAM) is one of the most attractive research directions in the field of mobile robots. SLAM is able to construct maps and provide localization information for the robots in unknown environments. Most existing SLAM algorithms perform well in static environments. However, regarding the environment with moving objects such as vehicles and pedestrians, there exist dynamic points in the laser point cloud, leading to the problem that the registration accuracy of point clouds can be adversely affected among different reference frames. To address this issue, this paper improves the front-end feature extraction and back-end loop detection modules of SLAM via using the geometry information of laser point cloud. By removing the dynamic points, the precision of mobile robot positioning and mapping is enhanced in dynamic environment. First, in order to improve the accuracy of front-end feature extraction, a stepwise ground segmentation method is proposed, which performs ground point extraction based on point cloud height information. Next, the Random Sample Consensus method is applied to elaborate ground segmentation on the corrected point cloud. Subsequently, a seed-growing clustering method is utilized to extract non-ground dynamic points based on height thresholds, followed by feature extraction and registration. Finally, for the back-end loop detection module, the traditional spatial relationship-based loop detection method is replaced with point cloud descriptors, so as to reduce the cumulative error and improve the sensitivity of loop detection. The effectiveness of the proposed method is validated through visualization simulation and accuracy assessment.

     

/

返回文章
返回