基于动态点实时滤除与回环优化的SLAM方法

SLAM Method Based on Dynamic Point Real-Time Filtering and Loop Closure Optimization

  • 摘要: 针对同步定位与实时建图(SLAM)领域中动态干扰引起地图失真及定位漂移工况下回环失效的问题,提出一种融合动态点实时滤除与回环优化的SLAM方法. 基于现有多传感器融合SLAM框架,设计点云预处理并优化回环检测. 采用栅格特征分析实现地面分割,并结合栅格占有率统计滤除动态点,抑制运动干扰以优化SLAM建图结果. 以二进制三角形描述符匹配检索替代半径搜索法,通过几何特征匹配实现回环初判并生成粗匹配位姿;将该位姿作为迭代最近点算法初始值,更鲁棒地加速点云配准以优化SLAM定位结果. 实验表明,该方法在动态场景中能快速实时消除地图动态干扰,降低回环耗时,提升SLAM系统定位鲁棒性与建图可靠性.

     

    Abstract: To address map distortion caused by dynamic interference and loop closure failure under significant localization drift in simultaneous localization and mapping (SLAM), this study proposed a SLAM method integrating real-time dynamic point filtering and loop closure optimization. Based on the existing multi-sensor fusion SLAM framework, this study designed point cloud preprocessing and optimized loop detection. First, ground segmentation was implemented via grid feature analysis, and dynamic points were filtered using grid occupancy statistics to suppress motion interference and optimize SLAM mapping results. Subsequently, radius search was replaced by binary triangle combined descriptor (BTCD) matching for loop closure initialization. Geometric feature matching generated coarse pose estimation, which served as the initial value for the iterative closest point (ICP) algorithm, accelerating point cloud registration and improving robustness to optimize SLAM localization results. Experiments show that the proposed method can quickly eliminate dynamic interference of the map in dynamic scenes, reduce loop closure time, and improve robustness of SLAM system localization and the reliability of mapping.

     

/

返回文章
返回
Baidu
map