一种考虑轮式机器人位姿估计的激光雷达动态障碍物检测方法

摘要

本发明公开了一种考虑轮式机器人位姿估计的激光雷达动态障碍物检测方法，该方法包括：步骤1，通过激光点云数据的几何特性，提取符合预设曲率特征的点云作为特征点，建立同一特征点在两帧相邻时刻点云数据中的匹配关系，并构建代价函数，以轮式机器人位姿为变量构造ICP问题，获得轮式机器人位姿信息；步骤2，检测候选动态障碍物；步骤3，估计动态障碍物状态。本发明不需要结合多传感器，在使用单一传感器的前提下进行动态障碍物检测目的，使系统更加高效，而且安全性更高。