在机器人同时定位与地图构建(simultaneous localization and mapping,SLAM)过程中,图优化方法如捆绑约束(Bundle Adjustment,BA)通过对位姿误差的分布进行迭代优化同步提升机器人位姿和地图的准确性,但优化的过程需要较大的计算量.与度量地图相比,拓扑地图因其简洁的环境表示更加适用于大范围环境的自主导航.论文针对拓扑地图在线创建过程中的闭环检测问题提出一种新的图优化方法,该方法只采用里程计航迹推算信息,引入机械臂逆向运动学模型减小位姿跟踪和地图创建误差,并使用模拟退火算法实现变步长快速迭代.实验结果表明该方法具有如下优点:采用间断性运作模式,只是在拓扑节点位置进行图优化操作,适用于计算能力较弱的机器人建图应用;只利用节点间的相互位置关系完成闭环检测,如在此基础上增加场景匹配信息将极大提高地图创建的准确性.
Topological Map Creation Based on New Graph Optimization Method
国家科技期刊平台
NSTL
万方数据
维普
