技术特征：
1.基于多机器人协作的自主探索建图系统，其特征在于：该系统分为两部分：顶层服务器模块和底层机器人模块；顶层服务器模块包括五个部分：地图融合模块、未知边界点检测模块、边界点聚类滤波模块、探索目标点获取模块以及机器人任务分配模块；地图融合模块使用基于局部特征提取的方法进行栅格地图融合，将机器人构建的多张局部地图融合成全局地图；未知边界点检测模块根据接收到的全局地图使用快速扩展随机树算法进行边界点检索，同时改进边界点检索方式，若系统内机器人在设定时间内没有接收到目标点，则以系统内被阻塞的机器人所在的栅格为中心，遍历其周围的栅格，直到遍历到未知栅格为止，将该未知栅格在全局地图对应的坐标点作为新的未知边界点；边界点聚类滤波模块采用均值漂移聚类算法对未知边界点进行聚类滤波，只保留聚类中心点并将其发送给目标点获取模块，以过滤掉不符合要求的边界点；探索目标点获取模块通过深度优先搜索算法对边界点进一步处理，找到基于该边界点的一段连续的边界，最后求出边界的质心，作为移动机器人运动的目标点；机器人任务分配模块采用模拟市场竞标的策略对上文获取的目标点进行分配，将机器人看作竞拍者，探索目标点看作商品，通过计算机器人与目标点之间收益来决定目标点的分配结果；底层机器人模块包括两个部分：路径规划模块和局部地图构建模块；路径规划模块接收到顶层服务器分配的目标点后使用基于ros的move_base库控制移动小车导航；局部地图构建模块根据车载激光雷达上传的数据使用slam算法进行地图构建，并发送到顶层服务器的地图融合模块中去。2.根据权利要求1所述的基于多机器人协作的自主探索建图系统的探索建图方法，其特征在于：步骤一：将整个系统部署在待建图区域中，顶层服务器与各个底层机器人连接到同一个网络下，完成多机通信和数据传输；步骤二：未知边界点检测模块接收到初始全局地图，从起始点出发采用随机采样增加子节点的形式生成随机扩展树；若构成一段树枝的两个端点都在已知区域内，则说明随机树还需要继续向下生长寻找新的节点；若构成一段树枝的两个端点分别落在已知区域和未知区域时，说明树枝穿过了探索地图的边界，然后按照预设步长寻找树枝上的边界点；同时在边界点探索后期，如果整个系统内所有机器人都在预设时间内没有接收到目标点，则以系统内机器人所在的栅格为中心，遍历其周围的栅格，直到遍历到未知栅格为止，将该未知栅格在全局地图对应的坐标点作为新的未知边界点；步骤三：为了过滤掉不符合要求的边界点，同时减轻后续模块的计算压力，边界点滤波模块接收到边界点之后，使用均值漂移聚类算法进行聚类滤波，删除已经被探索到的处于已知区域内的边界点，只保留聚类中心点发送给目标点获取模块；对于给定待建图区域内的n个未知边界点集x，空间中任意点x的均值漂移向量基本形式可以表示为式(1)，其中i＝1,...,n：其中m
h
就是漂移向量，s
k
表示的是一个半径为h的高维球区域，满足以下关系的y点的集合，k表示在n个样本点x
i
中，有k个点落入s
k
区域中：
s
h
(x)＝{y:(y-x
i
)
t
(y-x
i
)＜h2}
ꢀꢀꢀꢀ
(2)而漂移的过程，就是通过计算得漂移向量，然后更新球心y位置，使得球心一直处于力的平衡位置，具体实验时不断迭代上述过程，直到找到区域内密度最大的区域为一次聚类结束，此时的圆心便是一个聚类的中心点；步骤四：探索目标点获取模块在接收到聚类滤波得到的边界点之后，根据深度优先搜索算法对边界点周围的栅格进一步遍历，搜索出一条连续的边界，再求出连续边界栅格的质心，最后找到距离质心最近的未知栅格，将其作为探索目标点，机器人对该点进行探索就可以一次性完成对整个边界的探索；步骤五：任务分配模块采用模拟市场竞标的策略对目标点进行分配；将机器人看作市场内的竞拍者，探索目标点看作商品，通过计算机器人与目标点之间收益来决定目标点的分配结果；机器人竞拍总收益受两个参数影响，代价函数cost和信息增益函数ig；第m个机器人到第n个目标点的总收益公式revenue如下所示，其中λ为预设的为了保持信息增益与代价函数量级对等的权重因数；revenue(m,n)＝(λ
×
ig(n))-cost(m,n)
ꢀꢀꢀꢀ
(3)此场景中的代价函数为机器人到目标点的距离代价，用欧式距离表示；而机器人到达目标点所能探索的未知区域面积即为该点的信息增益，如式(4)所示，site(m)和site(n)分别为空间中两点的位置坐标，s(i,j)为坐标点(i,j)所在的栅格的面积，gridoccupy(i,j)表示坐标为(i,j)的未知区域uknown的栅格占用概率；inforadius为信息增益半径，信息增益函数一般约束在以目标点为圆心，激光雷达覆盖距离为半径的圆内；同时在以上分配算法基础上引入打折函数，对于已经分配好的目标点，其他机器人计算该点附近目标点的信息增益时将两目标点重叠部分的面积减去；引入打折函数后的目标点最终信息增益finalgain计算公式如下：步骤六：系统中的机器人将各自构建的局部地图发送给地图融合模块进行两两地图融合；两个待融合局部地图记为a和b，通过刚体变换使得两个待融合局部地图准确拼接，地图融合模块通过构建如式(6)的优化问题求解局部地图之间的旋转矩阵r和平移向量t完成拼接融合：式(6)中α为权重因数,|
·
|表示集合中的元素个数，ξ
min
表示两局部地图进行融合允许的最小重叠百分比，f
a
和f
b
分别表示由sift算法从a和b中提取的特征点集；
为确保获得的拼接参数最优，采用迭代最近点算法来计算刚体变换，最终完成两个局部地图的融合；然后将融合的地图与下一个局部地图进行下一次融合，不断执行步骤六，直到系统内所有满足融合重叠条件的局部地图完成融合。
技术总结
本发明涉及一种基于多机器人协作的自主探索建图系统及探索建图方法。本发明可以分为顶层服务器模块和底层机器人模块，其中顶层服务器模块由地图融合模块、未知边界点检测模块、边界点聚类滤波模块、探索目标点获取模块以及机器人任务分配模块五部分组成；底层机器人模块分为路径规划模块和局部地图构建模块。本方法实现了对未知环境的多机器人协作探索任务，能够自主完成栅格地图构建。本发明具有地图构建准确，探索效率高等优点，可以在很大程度上解放地图构建过程中的人力资源，具有较强的市场潜力和应用价值。强的市场潜力和应用价值。
技术研发人员：杨宇翔 方景生 黄佳杰 高明裕 何志伟 黄继业
受保护的技术使用者：杭州电子科技大学
技术研发日：2022.04.13
技术公布日：2022/8/5