基于动态点云与拓扑路网的机器人全局定位方法及系统
摘要:
本发明属于机器人定位技术领域,具体涉及一种基于动态点云与拓扑路网的机器人全局定位方法及系统,包括:构建室内环境的点云地图;提取所构建点云地图的拓扑结构,得到室内环境的拓扑路网和拓扑点位姿;根据所得到的拓扑路网和拓扑点位姿进行机器人定位的粗匹配,确定机器人当前点云的全局位姿;根据当前点云的全局位姿,加载机器人的分块地图;基于实时动态点云进行分块地图的精匹配,得到机器人的全局位姿,完成机器人的全局定位。本发明在室内结构化环境下实现机器人重新上电或位姿发生突变后的重新定位,有效解决重定位问题及机器人回到曾经访问过的位置因环境变化的回环检测及全局定位问题,提高定位的稳定性。
0/0