基于ICP的移动机器人同时定位与地图构建的研究

针对大规模环境下移动机器人使用传统ICP算法进行同时定位与建图存在的地图点匹配计算量随时间逐渐增大导致实时性降低的问题,提出一种按照移动机器人里程阈值分割地图并分步进行ICP计算的SLAM算法,该方法通过限制ICP的计算量而使系统达到实时性要求。采用MRPT仿真软件对同一环境的数据集分别进行地图构建,仿真对比结果表明,利用改进的ICP算法能有效地解决实时性降低的问题,提高构建的地图质量,该方法比传统的ICP算法有较强的稳定性和鲁棒性。