一种基于多机器人协作的移动机器人室内地图构建方法

摘要

本发明公开了一种基于多机器人协作的移动机器人室内地图构建方法，包括以下步骤：S1：采集多机器人的里程信息、UWB节点之间的距离信息和激光扫描数据；S2：通过非线性优化算法得到多机器人的相对位姿，在此基础上融合里程计信息，得到优化后的多机器人轨迹数据；S3：构建激光闭环约束和构建位姿图，对多机器人的轨迹进一步优化，结合激光扫描数据构建地图。本发明中机器人通过编码器计算自身的里程信息；基于采集的多组UWB距离信息，通过非线性优化算法得到多机器人的相对位姿；融合里程计与UWB位姿估计数据提高定位精度；构建激光闭环约束，通过图优化算法对轨迹进一步约束，实现多机器人间更精确的位姿估算。