一种基于多子群粒子群算法的侦察机器人任务分配方法

1.本发明属于机器人任务分配领域，涉及一种基于多子群粒子群算法的侦察机器人 任务分配方法。


背景技术：

2.随着机器人技术的快速发展，越来越多的侦察机器人被应用到城市作战任务中。 侦察机器人是一种可以深入敌方内部，为己方提供态势感知信息的作战武器，具有隐 蔽性、低成本、高效率等优点。针对单机器人探测能力受限的问题，需要综合考虑建 筑内复杂的内部环境、机器人的探测能力以及目标可能出现的区域等条件，将多个机 器人分布在建筑物内的不同位置，实现对目标区域的协同感知。
3.传统的机器人任务分配问题通常只考虑了机器人与目标任务之间的距离和完成任 务带来的收益，没有综合考虑障碍物等复杂环境以及机器人的安全性等因素，在真实 的战场环境中容易导致机器人被发现甚至作战任务的失败。此外，求解该问题的方法 还存在易陷入局部最优等问题。


技术实现要素：

4.要解决的技术问题
5.为了避免现有技术的不足之处，本发明提出一种基于多子群粒子群算法的侦察机 器人任务分配方法，要解决的技术问题是如何提供一种基于多子群粒子群算法的侦察 机器人任务分配方法，以解决传统任务分配问题中考虑因素单一以及求解方法存在易 陷入局部最优的问题，使得侦察机器人在复杂的作战环境中保证自身安全性的同时高 质量的完成态势感知任务。
6.技术方案
7.一种基于多子群粒子群算法的侦察机器人任务分配方法，其特征在于步骤如下：
8.步骤1、初始化粒子群最大迭代次数、粒子个数、粒子位置和粒子速度：
9.初始化粒子位置时，每个粒子的位置以一个向量表示，向量中的一个元素表示一 个侦察机器人所选侦察点的编号和探测器在世界坐标系下的朝向角，一个向量即粒子 表示所有侦察机器人所选侦察点的编号和探测器在世界坐标系下的朝向角；
10.其中，向量中元素的整数部分表示所选侦察点的编号，小数部分代表机器人探测 器在世界坐标系下的朝向角，若规定小数部分表示为x
dec
∈[0,1)，朝向角表示为 θ＝[-π，π)，则二者的转换关系如下：
[0011]
θ＝(2x
dec-1)
·
π
[0012]
粒子位置和速度的初始化通过随机方式即rand获取；
[0013]
步骤2、将粒子分成不同的子群：根据粒子选择的机器人侦察点将粒子分群，若 任意两个粒子选择的机器人侦察点相同，只是侦察点上机器人的航向角不同，则它们 归为一个子群；
[0014]
步骤3、计算粒子适应度：包括计算a)机器人的覆盖范围，b)侦察点的隐蔽程度， c)重点区域的多重覆盖率，计算公式为：
[0015]
f＝λ1f1 λ2f2 λ3f3[0016]
其中，f1、f2、f3分别对应a)、b)、c),λ1、λ2、λ3是对应的权重系数；
[0017]
所述：
[0018]
式中：表示每个机器人的可见栅格集合，s1∩s2∩
…
∩sn表示所有机器人的可见栅格集合，s
task
表示任务区域的栅格集合；j
i,hide
∈[0,1]表示机器 人所选侦察点的隐蔽程度，其中0表示隐蔽性最差，1表示隐蔽性最好；nc表示重点 区域个数，n
cri
表示单个重点区域的覆盖重数，表示单个重点区域的最大覆盖重 数；
[0019]
比较各粒子的适应度值的大小，得到粒子群个体最优解x
max,i
,f
maxi
,、子群最优解 x
max1
,f
max1
和全局最优解x
max
,f
max
；
[0020]
步骤4、粒子速度更新，位置更新：
[0021]
粒子的更新公式为：
[0022][0023]
式中，i＝1,2,
…
m表示粒子编号，t表示迭代次数，r1,r2∈[0,1]是呈均匀分布的随机 数；
[0024]
步骤5：迭代计算，重复步骤2～步骤4，直至计算达到指定迭代次数退出，其最 优粒子位置即为最终结果：
[0025][0026][0027]
式中，ω
max
,ω
min
分别时ω的最大值和最小值，f
ave1
为粒子所属子群的适应度均值， f
ave
为所有粒子的适应度均值，α为控制系数。
[0028]
所述探测器选择双目相机。
[0029]
有益效果
[0030]
本发明提出的一种基于多子群粒子群算法的侦察机器人任务分配方法，首先初始 化粒子群最大迭代次数、粒子个数、粒子位置和粒子速度；将粒子分成不同的子群； 计算粒
则所有机器人的可见栅格集合为s1∩s2∩
…
∩sn，假设任 务区域的栅格集合用s
task
表示，则机器人覆盖范围对应的指标函数可表示为
[0048]
f1＝s1∩s2∩
…
∩sn/s
task
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(2)
[0049]
评价侦察点的隐蔽程度时，假设在机器人任务分配之前根据情报信息已经得到并 评估出侦察点的隐蔽程度j
i,hide
∈[0,1]，其中0表示隐蔽性最差，1表示隐蔽性最好，则 与侦察点隐蔽程度对应的指标函数可表示为
[0050][0051]
评价重点区域的多重覆盖率时，假设有nc个重点区域，重点区域的覆盖重数为n
cri
， 每个重点区域的最大覆盖重数为则与重点区域多重覆盖率对应指标函数表示为：
[0052][0053]
侦察机器人任务分配时主要考虑的约束条件是
[0054]
(1)一个侦察点最多只能容纳一个机器人。
[0055]
(2)每个机器人只能分配一个侦察点。
[0056]
本发明采用多子群粒子群算法进行优化求解。粒子群优化算法是模拟鸟群寻找食 物的一种方法，其原理是通过更新惯性系数、社会系数和认知系数，通过适应度函数 评估局部最优和全局最优等操作，实现集群最优搜索，具有原理简单、易于实现和搜 索速度快等优点。但是作为一种随机搜索算法，传统的粒子群算法存在易陷入局部极 值的缺陷，针对这一缺陷，本发明提出一种多子群粒子群算法，通过将粒子分群和参 数自适应调节等手段提升粒子群算法的性能。其流程如下：
[0057]
(1)初始化粒子群最大迭代次数、粒子个数、粒子位置和粒子速度；
[0058]
在初始化粒子位置时，首先需要对粒子进行编码，在侦察机器人任务分配问题中， 由于隐蔽性的要求，机器人只能部署在沙发、桌子、椅子等物体下面，以防止被敌方 发现，因此部署位置的可行域是离散的，但是双目相机朝向角的可行域是连续的，因 此本发明基于粒子群算法巧妙地设计了粒子的编码形式，具体如下：
[0059]
每个粒子用一个向量表示，向量中的一个元素表示一个侦察机器人所选侦察点的 编号和探测器(双目相机)在世界坐标系下的朝向角，一个向量表示所有侦察机器人 所选侦察点的编号和探测器(双目相机)在世界坐标系下的朝向角。其中，向量中元 素的整数部分表示所选侦察点的编号，小数部分代表机器人探测器(双目相机)在世 界坐标系下的朝向角，规定小数部分表示为x
dec
∈[0,1)，朝向角表示为θ＝[-π，π)，二 者的转换关系如下：
[0060]
θ＝(2x
dec-1)
·
π
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(5)
[0061]
粒子的位置和速度通过随机方式(rand)获取。
[0062]
(2)将粒子分成不同的子群；
[0063]
当所有机器人的侦察位置点确定后，双目相机的朝向角则成了影响目标函数的唯 一因素。为了提升粒子群算法的收敛速度，根据粒子选择的机器人侦察点将粒子分群， 若任意两个粒子选择的机器人侦察点相同，只是侦察点上机器人双目相机的航向角不 同，则
它们归为一个子群，对应到粒子中，若任意两个粒子所有元素的整数部分相同， 则把它们归为一个子群，例如：若有如下3个粒子：
[0064][0065]
则x1,x2可归为同一个子群，x3属于另一个子群。
[0066]
(3)计算粒子适应度；
[0067]
粒子的适应度计算方法如式(2)-(3)所示。通过比较各粒子的适应度值的大小，得到粒 子群个体最优解x
max,i
,f
max,i
、子群最优解x
max1
,f
max1
和全局最优解x
max
,f
max
。
[0068]
(4)粒子速度更新，位置更新；
[0069]
粒子的更新公式为
[0070][0071]
式中，i＝1,2,
…
m表示粒子编号，t表示迭代次数，r1,r2∈[0,1]是呈均匀分布的随机 数；传统粒子群算法的速度更新公式中，除了全局最优解向其他粒子发布信息外，再 无其他的信息共享，以至于粒子多样性降低，易过早地陷入局部极值点(参考文献： 魏法,杨明磊,何小静,周鼎森,陈伯孝.基于改进粒子群算法的平面阵同时多波束赋形方 法[j/ol].系统工程与电子技 术:1-10.http://kns.cnki.net/kcms/detail/11.2422.tn.20210903.1650.002.html.)。本发明通 过一种自适应调整加速系数的方法，使得在进化初期和后期认知部分和社会部分对粒 子速度更新有不同影响，能避免粒子群算法易陷入局部极值点的缺点，提高算法后期 的收敛速度和精度。参数自适应调节方法如下：
[0072][0073][0074]
式中，ω
max
＝0.95,ω
min
＝0.4，f
ave1
为粒子所属子群的适应度均值，f
ave
为所有粒子 的适应度均值，α＝10为控制系数。
[0075]
(5)迭代计算，重复步骤(2)-(4)，直至计算达到指定迭代次数退出，其最优 粒子位置即为最终结果。
[0076]
以上所述仅是本发明的优选实施方式，应当指出，对于本技术领域的普通技术人 员来说，在不脱离本发明技术原理的前提下，还可以做出若干改进和变形，这些改进 和变形也应视为本发明的保护范围。