[发明专利]基于子地图特征匹配的多机器人SLAM算法

摘要

本发明公开了一种基于子地图特征匹配的多机器人SLAM算法，包括：步骤1、采用多个机器人采集环境信息，并据此创建子地图序列；步骤2、对单个机器人创建的子地图进行匹配，构建单机器人SLAM算法的前端；步骤3、基于最大公共子图的栅格地图融合算法对不同机器人创建的子地图序列进行匹配，将所有匹配结果进行保存；步骤4、根据步骤3的结果，计算多个机器人之间的相对位姿；步骤5、根据步骤3和步骤4的计算结果，构建多机器人闭环约束；步骤6、根据步骤2和步骤5的结果，构建多机器人SLAM算法的前端；步骤7、多机器人SLAM后端优化；步骤8、全局栅格地图创建。本发明能够解决对大尺度环境或者对工作效率要求较高的环境进行建模的问题。

主权项

1.一种基于子地图特征匹配的多机器人SLAM算法，其特征在于，包括如下步骤：步骤1、采用多个机器人在环境中运动，采集环境信息，并根据信息创建子地图序列；步骤2、根据基于特征匹配的方法，对单个机器人创建的子地图进行匹配，构建单机器人SLAM算法的前端；步骤3、根据基于特征匹配的方法，对不同机器人创建的子地图序列进行匹配，将所有匹配结果进行保存；步骤4、根据步骤3的结果，计算多个机器人之间的相对位姿；步骤5、根据步骤3和步骤4的计算结果，构建多机器人闭环约束；步骤6、根据步骤2和步骤5的结果，构建多机器人SLAM算法的前端；步骤7、多机器人SLAM后端优化；步骤8、全局栅格地图创建。