基于层次化SLAM的未知环境级联地图创建方法

针对大规模环境下障碍物、环境传感器、移动机器人自身位姿均未知的情况,提出层次化机器人同时定位与空间级联地图创建(SLAM)方法.首先建立子地图与拓扑节点两层结构环境模型,然后利用环境传感器感知信息辅助子地图局部坐标框架的在线创建和更新,同时在拓扑结构创建过程中,利用coupling summation公式推算节点间相对坐标关系.在机器人轨迹闭合检测的基础上,引入加权扫描匹配法和松弛法对拓扑结构进行优化,确保地图的全局一致性.实验验证了该方法的可行性与有效性.