高级检索

基于双地图协同的动态障碍物点云检测与剔除算法

Dynamic Obstacle Point Cloud Detection and Removal Algorithm Based on Dual-map Collaboration

  • 摘要: 针对室内复杂场景中移动障碍物、镂空物体及设备倾斜等动态干扰因素导致激光即时定位与地图构建(SLAM)点云特征不确定性、配准失效及地图畸变等问题,本文提出一种基于双地图协同的动态障碍物点云检测与剔除算法。首先,构建多分辨率栅格地图以优化相关性扫描匹配(CSM)算法的配准效率与精度;在此基础上,建立静态基准地图与动态检测地图协同的双地图体系,通过双向约束机制实现对动态点云及虚假点云的精准判断与高效滤除。仿真与真实环境实验结果表明:该算法使CSM配准算法匹配度稳定在0.85以上,有效规避配准失效与地图畸变;动态障碍物识别率达98.75%,绝对平移误差(ATE)平均优化3.675%。相较于传统栅格概率更新策略,本文算法从配准稳定性、动态环境感知能力及全局定位精度3个层面显著提升了激光SLAM系统的综合性能,能够构建无畸变、高可靠的静态栅格地图,为室内动态场景下的自主定位与建图提供了有效解决方案。

     

    Abstract: To address the issues of point cloud feature uncertainty, registration failure, and map distortion in laser-based Simultaneous localization and mapping (SLAM) caused by dynamic disturbances such as moving obstacles, hollow-structured objects, and equipment tilt in complex indoor scenes, a dynamic obstacle point cloud detection and removal algorithm based on dual-map collaboration was proposed. First, a multi-resolution grid map was constructed to optimize the registration efficiency and accuracy of the correlative scan matching (CSM) algorithm. On this basis, a dual-map system consisting of a static reference map and a local dynamic obstacle map was established, enabling accurate identification and efficient removal of dynamic and spurious point clouds through a bidirectional constraint mechanism. The experimental results from both simulation and real-world environments show that the proposed algorithm stabilizes the CSM registration score above 0.85, effectively avoiding registration failure and map distortion. The dynamic obstacle recognition rate reaches 98.75%, and the absolute translation error (ATE) is optimized by 3.68% on average. Compared with conventional grid-probability updating strategies, the proposed algorithm significantly improves the overall performance of laser SLAM systems in terms of registration stability, dynamic environmental perception, and global localization accuracy. A distortion-free and highly reliable static grid map can be constructed, providing an effective solution for autonomous localization and mapping in indoor dynamic scenes.

     

/

返回文章
返回