一种基于人工势场的多智能体集结点的智能规划方法

摘要

本公开的基于人工势场的多智能体集结点的智能规划方法，通过导入多智能体信息、障碍物信息、多智能体的目标集结点信息；根据计算的多智能体距离目标集结点的最大距离确定多智能体的初始虚拟集结点；根据初始虚拟集结点计算多智能体间的距离及多智能体与障碍物间的距离，当多智能体间的距离和智能体与障碍物间的距离小于预设距离时，根据人工势场模型计算智能体间的排斥力和智能体与障碍物间的排斥力，并确定智能体的移动方向和移动距离，得到移动后的智能体虚拟集结点；当智能体虚拟集结点不再发生变化时的虚拟集结点为智能体的目标集结点。以解决多智能体(陆用多机器人)在复杂障碍环境下的各智能体(各机器人)集结点的冲突问题。

说明书

技术领域

本发明属于路径规划技术领域，具体涉及一种基于人工势场的多智能体集结点的智能规划方法。

背景技术

近年来，关于多智能体(例如陆用多机器人)集群协调与规划问题成为科研人员关注的焦点之一。目前也已经能够让多智能体系统实现多样复杂的任务，诸如集结、编队、围捕等。然而，科研人员通过交互界面调度多智能体完成集结任务时，会习惯性地命令多智能体向同一个理论集结点集结。然而，在实际工程应用中，多智能体因为无法视为质点，若其理论集结点相同或距离过近，则在理论集结点处将会出现大量的智能体碰撞问题。解决该问题的比较直接办法是科研人员对每个智能体逐一指派其理论集结点且理论集结点的距离不能过近，但这一方法仅限于智能体数量较少的情况下，一旦智能体数量较多，则会给科研人员带来较重的操作负担且实际中使用这种方法产生的集结效果也不理想。

人工势场法由于其简洁性和快速性，在机器人的路径规划中得到了广泛的应用。使用人工势场法规划得到的流畅的路径线条，能够更好地实现对机器人的平滑控制。使用人工势场法完成智能体的轨迹规划基本思想是通过设计目标点对其的吸引力以及环境中障碍物对其的排斥力，从而形成特定的势场环境。智能体在这种人为设计的势场环境中，迭代计算受力和执行移动动作，实现从初始点到目标点的移动。但人工势场法在路径规划实践中，其不足在于存在最优解，容易产生死锁现象。且使用人工势场法规划多智能体集结点的研究也不多。

发明内容

本发明克服了现有技术的不足之一提供了一种基于人工势场的多智能体集结点的智能规划方法，以解决多智能体(陆用多机器人)在复杂障碍环境下的各智能体(各机器人)集结点的冲突问题。

根据本公开的一方面，本发明提供一种基于人工势场的多智能体集结点的智能规划方法，所述方法包括：

导入多智能体信息、障碍物信息、多智能体的目标集结点信息；

计算多智能体距离目标集结点的距离，并根据多智能体距离目标集结点的最大距离计算多智能体的初始虚拟集结点位置坐标；

根据所述多智能体的初始虚拟集结点位置坐标计算多智能体之间的距离以及多智能体与障碍物之间的距离，当多智能体之间的距离或智能体与障碍物之间的距离小于预设距离时，根据人工势场模型计算所述智能体之间的排斥力和所述智能体与障碍物之间的排斥力；

根据所述智能体之间的排斥力和所述智能体与障碍物之间的排斥力，确定所述智能体的移动方向和计算所述智能体的移动距离，得到所述智能体移动后的虚拟集结点；

当所述智能体的虚拟集结点的位置坐标不再发生变化时，所述虚拟集结点位置为所述智能体的目标集结点。

在一种可能的实现方式中，所述多智能体信息包括智能体的总数N，智能体的位置坐标

所述障碍物信息包括障碍物位置坐标

多智能体的目标集结点信息包括集结点总数M，目标集结点位置坐标p

在一种可能的实现方式中，计算多智能体距离目标集结点的距离，并根据多智能体距离目标集结点的最大距离计算多智能体的初始虚拟集结点位置坐标，包括：

多智能体距离目标集结点的距离D

在一种可能的实现方式中，根据人工势场模型计算所述智能体之间的排斥力和所述智能体与障碍物之间的排斥力，包括：

其中，D

在一种可能的实现方式中，根据所述智能体与与其他智能体的排斥力和所述智能体与障碍物的排斥力，计算所述智能体的移动方向和移动距离，包括：

对所述智能体之间的排斥力A

将依次计算所述智能体与其它智能体之间的排斥力，以及与所有障碍物的排斥力进行矢量合成所述智能体的初始虚拟智能点的排斥力的合力为：

根据所述智能体的初始虚拟智能点在x，y方向收到的排斥力的合力，计算所述智能体的移动距离为：

所述智能体在此次移动后的虚拟集结点位置坐标为：

在一种可能的实现方式中，所述预设距离为所述智能体半径的两倍。

本公开的基于人工势场的多智能体集结点的智能规划方法，通过导入多智能体信息、障碍物信息、多智能体的目标集结点信息；计算多智能体距离目标集结点的距离，并根据多智能体距离目标集结点的最大距离计算多智能体的初始虚拟集结点位置坐标；根据所述多智能体的初始虚拟集结点位置坐标计算多智能体之间的距离以及多智能体与障碍物之间的距离，当多智能体之间的距离或智能体与障碍物之间的距离小于预设距离时，根据人工势场模型计算所述智能体之间的排斥力和所述智能体与障碍物之间的排斥力；根据所述智能体之间的排斥力和所述智能体与障碍物之间的排斥力，确定所述智能体的移动方向和计算所述智能体的移动距离，得到所述智能体移动后的虚拟集结点；当所述智能体的虚拟集结点的位置坐标不再发生变化时，所述虚拟集结点位置为所述智能体的目标集结点。以解决多智能体(陆用多机器人)在复杂障碍环境下的各智能体(各机器人)集结点的冲突问题。

附图说明

附图用来提供对本申请的技术方案或现有技术的进一步理解，并且构成说明书的一部分。其中，表达本申请实施例的附图与本申请的实施例一起用于解释本申请的技术方案，但并不构成对本申请技术方案的限制。

图1示出了根据本公开一实施例的基于人工势场的多智能体集结点的智能规划方法的流程示意图；

图2示出了根据本公开一实施例的基于人工势场的多智能体初始虚拟集结点的示例图；

图3示出了根据本公开一实施例的基于人工势场的多智能体目标集结点的示例图；

图4示出了根据本公开另一实施例的基于人工势场的多智能体集结点的智能规划场景图；

图5示出了根据本公开另一实施例的基于人工势场的多智能体集结点的智能规划结果示意图。

具体实施方式

以下将结合附图及实施例来详细说明本发明的实施方式，借此对本发明如何应用技术手段来解决技术问题，并达到相应技术效果的实现过程能充分理解并据以实施。本申请实施例以及实施例中的各个特征，在不相冲突前提下可以相互结合，所形成的技术方案均在本发明的保护范围之内。

另外，附图的流程图示出的步骤可以在诸如一组计算机可执行指令的计算机中执行。并且，虽然在流程图中示出了逻辑顺序，但是在某些情况下，可以以不同于此处的顺序执行所示出或描述的步骤。

本公开的基于人工势场的多智能体集结点的智能规划方法，根据人为指派得到的多智能体的理论集结点规划出各智能体的实际集结点。首先根据由人为指派的多智能体理论集结点，使用快捷的比例收缩方法，为各智能体规划出初始虚拟集结点；借鉴人工势场法的基本思想，设计合理的人工势场模型，计算各智能体与其他智能体及障碍物之间的排斥力，从而使各智能体沿着互不接触并远离障碍物的方向移动；当各智能体所受排斥力均为零，各智能体所在位置即为对应的实际集结点。

图1示出了本公开一实施例的基于人工势场的多智能体集结点的智能规划方法的流程示意图。该方法可以用于陆用多机器人在复杂障碍环境下基于人工势场的集结点规划系统，该方法可以包括：

步骤S1：导入多智能体信息、障碍物信息、多智能体的目标集结点信息。

其中，多智能体信息可以包括智能体的总数N，智能体的位置坐标

障碍物信息可以包括障碍物位置坐标

多智能体的目标集结点信息包括目标集结点总数M，目标集结点位置坐标

图2示出了根据本公开一实施例的基于人工势场的多智能体初始虚拟集结点的示例图。

如图2所示，智能体的总数N＝5，即智能体1、智能体2、智能体3、智能体4、智能体5。每个智能体的半径R＝0.5。目标集结点为2个，即目标集结点1和目标集结点2。则智能体、目标集结点、障碍物的位置坐标信息如表1所示，地图的栅格半径r＝0.5。

表1

每个目标集结点的位置信息与多智能体的对应关系如表2所示，表2中，“√”表示智能体与目标集结点之间存在任务关系；“-”表示智能体与目标集结点不存在任务关系。

表2

步骤S2：计算多智能体距离目标集结点的距离，并根据多智能体距离目标集结点的最大距离计算多智能体的初始虚拟集结点位置坐标。

假设智能体i的初始虚拟集结点为

根据点与点之间的距离公式计算每个智能体距离目标集结点的距离D

根据多智能体距离目标集结点的最大距离为D

计算得到5个智能体的初始虚拟集结点坐标信息如表3所示：

表3多智能体的初始虚拟集结点坐标信息

步骤S3：根据所述多智能体的初始虚拟集结点位置坐标计算多智能体之间的距离以及多智能体与障碍物之间的距离，当多智能体之间的距离或智能体与障碍物之间的距离小于预设距离时，根据人工势场模型计算所述智能体之间的排斥力和所述智能体与障碍物之间的排斥力。

将每个智能体放置在初始虚拟集结点位置处，根据距离公式计算每个智能体与所有障碍物，每个智能体与其它智能体之间的距离。

以编号为i的智能体为例，智能体i与智能体n之间的距离为D

智能体i与障碍物k之间的距离D

借鉴人工势场算法的思想，设计合理的人工势场模型，当智能体与其他智能体或障碍间距离较近时，例如可以为当多智能体之间的距离或智能体与障碍物之间的距离小于智能体半径的两倍时将会受到一个排斥力，根据人工势场模型计算智能体之间的排斥力和智能体与障碍物之间的排斥力。计算方法如下：

步骤S4：根据所述智能体之间的排斥力和所述智能体与障碍物之间的排斥力，确定所述智能体的移动方向和计算所述智能体的移动距离，得到所述智能体移动后的虚拟集结点。

对所述智能体之间的排斥力A

依次计算智能体与其它智能体之间的排斥力，以及与所有障碍物的排斥力，将依次计算智能体与其它智能体之间的排斥力，以及与所有障碍物的排斥力进行矢量合成所述智能体的初始虚拟智能点的排斥力的合力为：

根据该排斥力合力公式，计算的5个智能体在初始虚拟集结点的排斥力合力如表4所示：

表4多智能体的初始虚拟集结点排斥力合力

根据上面势场力模型计算各智能体所受排斥力合力情况，结合智能体最大移动步距，确定智能体下一步移动方向及移动步距。智能体移动方向与所述智能体的初始虚拟智能点在x，y方向收到的排斥力的合力方向相同，智能体移动步距与智能体所受排斥力合力大小成正比。

根据智能体的初始虚拟智能点在x，y方向收到的排斥力的合力，计算所述智能体的移动距离为：

智能体在此次移动后的虚拟集结点位置坐标为：

步骤S5：当所述智能体的虚拟集结点的位置坐标不再发生变化时，所述虚拟集结点位置为所述智能体的目标集结点。

图3示出了根据本公开一实施例的基于人工势场的多智能体目标集结点的示例图。

不断重复上述步骤，使得智能体进行反复的移动，当智能体的虚拟集结点的位置坐标不再发生变化时，虚拟集结点的位置将是该智能体的实际集结点，则上述5个智能体的结果见表5，

表5

5个智能体的目标集结点如图3所示，可知，通过本公开的方法可以将各个智能体的目标集结点位置进行合理的规划，保证每个智能体与其它智能体和障碍物不发生碰撞冲突。

图4示出了根据本公开另一实施例的基于人工势场的多智能体集结点的智能规划场景图。图5示出了根据本公开另一实施例的基于人工势场的多智能体集结点的智能规划结果示意图。

如图4所示，在一个包含有四个智能履带机器人的多机器人系统中，所有智能履带车需要向左侧的高台完成集结任务。该测试环境中障碍物极其复杂且理论集结点位于障碍物之间的狭长的通道中。使用本公开的基于人工势场的多智能体集结点的智能规划方法，得到的各智能履带机器人的实际集结点的运算结果如图5所示。由图5可知，本公开的智能规划方法能够合理的分配给每个智能履带车的实际集结位置，保证每个智能履带车与其他智能履带车以及周围障碍物不发生碰撞，能够为智能履带车的集结任务提供算法保障，顺利完成集结任务。

本公开的基于人工势场的多智能体集结点的智能规划方法，通过导入多智能体信息、障碍物信息、多智能体的目标集结点信息；计算多智能体距离目标集结点的距离，并根据多智能体距离目标集结点的最大距离计算多智能体的初始虚拟集结点位置坐标；根据所述多智能体的初始虚拟集结点位置坐标计算多智能体之间的距离以及多智能体与障碍物之间的距离，当多智能体之间的距离或智能体与障碍物之间的距离小于预设距离时，根据人工势场模型计算所述智能体之间的排斥力和所述智能体与障碍物之间的排斥力；根据所述智能体之间的排斥力和所述智能体与障碍物之间的排斥力，确定所述智能体的移动方向和计算所述智能体的移动距离，得到所述智能体移动后的虚拟集结点；当所述智能体的虚拟集结点的位置坐标不再发生变化时，所述虚拟集结点位置为所述智能体的目标集结点。以解决多智能体(陆用多机器人)在复杂障碍环境下的各智能体(各机器人)集结点的冲突问题。

虽然本发明所揭露的实施方式如上，但所述的内容只是为了便于理解本发明而采用的实施方式，并非用以限定本发明。任何本发明所属技术领域内的技术人员，在不脱离本发明所揭露的精神和范围的前提下，可以在实施的形式上及细节上作任何的修改与变化，但本发明的专利保护范围，仍须以所附的权利要求书所界定的范围为准。