[发明专利]一种机器人队形成形的目标点分配方法

摘要

本发明公开了一种机器人队形成形的目标点分配方法，步骤1)根据每个机器人和目标点的位置坐标，计算每个机器人到所有目标点的路径长度集合；步骤2)根据排列组合随机抽取方法在机器人的路径长度集合中选取元素组成多个队形矩阵；步骤3)计算每个队形矩阵的范数并排序，最小的范数对应的队形矩阵为队形成形最短路径的矩阵；步骤4)判断队形成形最短路径的矩阵是否为最终目标点分配矩阵，选出最终目标点分配矩阵，机器人队形成形的目标点分配完成。本发明在有障碍物的环境中，能够实现在避障的同时实现时间和路径消耗最少的高效率队形形成即队形初始化，以达到最优的路径规划。

主权项

1.一种机器人队形成形的目标点分配方法，其特征在于，具体包括以下步骤：步骤1)建立平面坐标系，根据每个机器人和目标点的位置坐标，计算每个机器人的路径长度集合，每个机器人的路径长度集合由每个机器人到所有目标点的路径长度组成；步骤2)根据排列组合随机抽取方法在机器人的路径长度集合中选取元素组成多个队形矩阵，每个队形矩阵由各机器人的路径集合中随机选取一个元素组成，且随机抽取的元素对应位置不重合；步骤3)计算每个队形矩阵的范数，将所有队形矩阵的范数按照由小到大的顺序依次排列，最小的范数对应的队形矩阵为队形成形最短路径的矩阵；步骤4)根据队形成形最短路径的矩阵列出各机器人队形成形过程中实时坐标的方程组，将所有实时坐标的方程组按照排列组合顺序抽取2个实时坐标的方程组组成新方程组，并通过求解实时时刻判断新方程组对应的两个机器人是否会发生碰撞，若所有新方程组均不存在实时时刻使新方程组成立，则所有机器人之间不会发生碰撞，该队形成形最短路径的矩阵为最终目标点分配矩阵，机器人队形成形的目标点分配完成；若存在实时时刻使方程组成立，则该新方程组有解，舍去该队形成形最短路径的矩阵，按照范数的排列顺序选取下一范数对应的队形矩阵作为新的队形成形最短路径的矩阵，并列出相应方程组判断新的队形成形最短路径的矩阵是否为最终目标点分配矩阵，按照此方式类推，直到选出最终目标点分配矩阵，机器人队形成形的目标点分配完成。