CN107168054A - 多机器人任务分配及路径规划方法 - Google Patents

多机器人任务分配及路径规划方法 Download PDF

Info

Publication number
CN107168054A
CN107168054A CN201710324492.3A CN201710324492A CN107168054A CN 107168054 A CN107168054 A CN 107168054A CN 201710324492 A CN201710324492 A CN 201710324492A CN 107168054 A CN107168054 A CN 107168054A
Authority
CN
China
Prior art keywords
mrow
msub
task
robot
antibody
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201710324492.3A
Other languages
English (en)
Other versions
CN107168054B (zh
Inventor
段勇
王宇
喻祥尤
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shenyang University of Technology
Original Assignee
Shenyang University of Technology
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Shenyang University of Technology filed Critical Shenyang University of Technology
Priority to CN201710324492.3A priority Critical patent/CN107168054B/zh
Publication of CN107168054A publication Critical patent/CN107168054A/zh
Application granted granted Critical
Publication of CN107168054B publication Critical patent/CN107168054B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance

Landscapes

  • Engineering & Computer Science (AREA)
  • Software Systems (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Health & Medical Sciences (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Medicines Containing Antibodies Or Antigens For Use As Internal Diagnostic Agents (AREA)
  • Feedback Control In General (AREA)
  • Manipulator (AREA)

Abstract

多机器人任务分配及路径规划方法，包括主要步骤如下：1：初始化多机器人与任务的信息：设置机器人的初始化状态参数、环境中任务的信息；获取机器人位置、速度以及最大电量和任务的位置等数据信息；2：多机器人任务分配：计算各机器人与任务之间的综合代价数据，综合考虑机器人电量、工作时间以及最大任务数等因素，按综合代价最小的准则将任务进行分配至机器人；3：机器人路径规划方法：依次使用本发明的改进免疫遗传算法对机器人进行路径规划。该方法能将多个任务有效的分配至多个机器人，并且在机器人路径规划过程中，使用改进的免疫遗传算法能有效的减少算法的迭代次数，提高免疫遗传算法的全局最优解的搜索效率，求解到的最优解更短。

Description

多机器人任务分配及路径规划方法
技术领域
本发明属于多机器人技术领域，涉及多机器人的任务分配以及路径规划的方法，特别涉及一种基于改进的免疫遗传算法的多机器人路径规划方法。
背景技术
随着机器人技术的快速进步，机器人已经被广泛的应用在工业、军事、服务业以及危险环境探索等领域；伴随着各领域对机器人的要求不断提高，机器人的工作任务越来越复杂化，由于单个的机器人不管是在数据的获取还是处理数据的能力都难以满足当前的需求。相比较单机器人而言，多机器人具备诸多优点，如多机器人数据采集信息及处理结果共享，机器人合作完成复杂的工作等。但多机器人在环境探索策略的研究同时也比单机器人复杂度高，因此多机器人任务分配及环境探索成为目前移动机器人研究的重点和热门领域。
多机器人任务分配是指将环境中的多个任务按照一定的规则分配给环境中的多个机器人，因为当多个机器人协同合作时，可以充分发挥各机器人所长，更优的完成任务。对于机器人环境探索任务中一个基础的问题是为机器人找出一条探索的最优路径，使得多机器人更好的完成环境探索任务。
机器人路径规划的方法，近年来出现一些智能方法，如免疫遗传算法、改进遗传算法以及神经网络方法等。免疫遗传算法是一种新型的、具有免疫功能的遗传算法，目前广泛应用于机器人环境探索系统中。目的是将一个机器人的探索环境进行规划，通过最后的环境探索路径确定任务点的探索顺序。并且在前人工作的基础上也充分证明了其可行性及其具备的诸多优点，但其依然具有遗传算法的局部最优、搜索空间过大缺点。
发明内容
发明目的：针对现有多机器人路径规划方法存在的问题，本发明提出了一种多机器人任务分配及路径规划方法，其目的是解决目前所存在的问题。
技术方案：
本发明所采用的技术方案如下：
一种多机器人任务分配及路径规划方法，其特征在于所诉方法包括主要步骤如下：
S1：初始化多机器人与任务的信息：设置机器人的初始化状态参数、环境中任务的信息；获取机器人位置、速度以及最大电量和任务的位置等数据信息；
S2：多机器人任务分配：计算各机器人与任务之间的综合代价数据，综合考虑机器人电量、工作时间以及最大任务数等因素，按综合代价最小的准则将任务进行分配至机器人；
S3：机器人路径规划方法：依次使用本发明的改进免疫遗传算法对机器人进行路径规划。
在上述步骤S2中，一种多机器人的任务分配方法，其分配过程充分考虑机器人位置、速度以及电量等多因素。其具体步骤如下：
S21：随机或读取产生机器人及任务数据，机器人数据信息包括编号Rn、初始位置rp0、初始电量b0、剩余电量b1、速度v、当前分配到任务数n等；任务数据包括：任务编号Tn、位置tp、分配否标识isA、分配至机器人编号toRn等。分别构成机器人与任务队列；
S22：计算j号任务分配给i号机器人所需要的综合代价信息，并记录一个包含Rni、Tnj、nbij、ntij、cij及dij的数据表table，并按代价的升序排列；
S23：从table中取代价最小的一条数据record判断该记录中Tn对应的任务isA是否为true。如果是则重复此步骤，否则执行以下步骤；
S24：判断record中Rni对应bi 1是否大于nbij，且ti 1是否大于ntij，以及机器人已分配到任务没有数到达上限，如果条件全部满足则继续，否则跳转步骤S23中取代价次小的一条数据；
S25：更新record中Rni对应机器人的剩余时间ti 1、剩余电量bi 1、分配到任务数n等数据，Tnj对应任务的toRn、isA等数据。跳转步骤S23继续取下一条数据。
多机器人任务分配：计算各机器人与任务之间的综合代价数据，综合考虑机器人电量、工作时间以及最大任务数因素，按综合代价最小的准则将任务进行分配至机器人，其过程具体包括：
(1)任务分配的数学模型制定，具体如下：
T表示任务，R表示机器人；
Ri来表示多机器人系统中的第i个机器人，其中i∈[1,N]，N为机器人系统中的机器人数量；
Ti来表示多机器人系统中的第i个任务，其中i∈[1,M]，M为机器人系统中的任务数量；
i号机器人最大工作时间ti 0，i号机器人剩余工作时间ti 1,i号机器人完成j号任务所需消耗时间记为ntij；
Dist(Ti,Rj)表示利用机器人Rj来完成Ti所需要行走的距离值，记为dij；
Bettery(Ti,Rj)表示利用机器人Rj来完成Ti任务时机器人Rj所需要消耗的电量，记为nbij，由于每个机器的属性不同，每个机器人完成同一个任务其所需要消耗的电量是不相同的，因此本文用常数λij表示第i个机器人完成第j个任务单位距离消耗的电量；
(2)任务分配综合代价值计算方法
本发明设计了一个计算该综合代价值的函数，本发明的综合代价函数定义如公式(1)所示，该公式表示机器人完成任务所需的代价；
Cost(Ti,Rj)表示利用机器人Rj来完成Ti所需要的代价值，记为cij；
公式(1)至(3)中，Dist(Tj,Ri)代表机器人Ri与任务点Tj之间的距离，代表机器人Ri的速度，Bettery(Tj,Ri)代表机器人Ri完成任务Tj过程中这段距离所需要消耗的电量，由于消耗电量不仅与距离有关，而且与其本身的属性有关，所以使用一个常量因子λij代表第i个机器人完成第j个任务单位距离所消耗电量。公式(1)中的代价函数含义是在机器人完成任务所需时间最短、所需电量最小的时候将这个任务分配给这个机器人。
(3)任务分配至机器人需满足的条件：
首先设当前机器人Ri分配到的k个任务清单有(T1,T2,...,Tk)；因此要使得下一个任务分配至该机器人必须满足如下条件：
1)机器人Ri到此任务Tj之间的代价最小，数学表示如公式(4)所示：
min{Cost(Tj,Ri),i∈[1,N]} (4)
2)机器人剩余电量足够满足当前任务的消耗，具体表现为公式(5)：
其中B(Ri)为机器人Ri的初始电量，Dist(Tj,Ri)代表机器人Ri与任务点Tj之间的距离，λij代表第i个机器人完成第j个任务单位距离所消耗电量；
(4)多机器人任务分配步骤及流程，具体如下：
A：随机或读取产生机器人及任务数据，机器人数据信息包括编号Rn、初始位置rp0、初始电量b0、剩余电量b1、速度v、当前分配到任务数n；任务数据包括：任务编号Tn、位置tp、分配否标识isA、分配至机器人编号toRn；分别构成机器人与任务队列；
B：根据上文叙述部分的公式(1)至(3)计算j号任务分配给i号机器人所需要的代价信息，并记录一个包含Rni、Tnj、nbij、ntij、cij及dij的数据表table，并按代价的升序排列；
C：从table中取代价最小的一条数据record判断该记录中Tn对应的任务isA是否为true；如果是则重复此步骤，否则执行以下步骤；
D：判断record中Rni对应bi 1是否大于nbij，且ti 1是否大于ntij，以及机器人已分配到任务没有数到达上限，如果条件全部满足则继续，否则跳转步骤C中取代价次小的一条数据；
E：更新record中Rni对应机器人的剩余时间ti 1、剩余电量bi 1、分配到任务数n数据，Tnj对应任务的toRn、isA数据；跳转步骤C中继续取下一条数据。
在上述步骤S3中，一种改进的免疫遗传算法应用于机器人的路径规划，其特征在于在免疫遗传算法产生初始解时本发明采用最邻近算法和随机法相结合；在计算抗体浓度时，计算相似度的过程中通过计算两条抗体路径边相同数量来判断抗体路径的相似性，从而计算抗体的浓度。
在上述步骤S3中，本发明在对免疫遗传算法的初始抗体群部分做出改进，初始抗体群大小Popsize的20％由最邻近算法产生近似最优解，为保证抗体群的多样性，剩下80％依然由随机法产生。
进一步，如果机器人分配到的任务数N小于N≤Popsize*0.2，则由最邻近算法产生N条路径的初始解，否则由最邻近算法产生出Popsize*0.2条初始路径解，其余部分由随机发产生。
步骤3中为每个机器人所分配到的任务点使用本发明的改进免疫遗传算法进行路径规划，其中单个机器人的路径规划的过程如下：
(A)：算法初始化：将待求解的目标函数和约束条件输入，作为带求解问题的抗原，初始化算法中种群的大小Popsize为100、选择概率PS、最大交叉概率为0.9、最小交叉概率为0.5以及变异概率PM最大和最小分别为0.3与0.1；精英保留抗体数为5；
(B)：生成初始抗体群：本算法中初始抗体群的生成由两部分组成，第一部分由最邻近算法产生，第二部分由随机方法在解空间产生，由最邻近算法产生的初始抗体解的数量为Popsize*0.2；
(C)：亲和度及浓度计算：计算抗原与抗体之间的亲和度抗体与抗体之间的浓度，对亲和度大的抗体和浓度小的抗体予以保留；除去抗体群中亲和度低的抗体；
(D)：记忆抗体群更新：将抗体群中，亲和度最高的个体放入记忆抗体群中，同样也为了保持记忆抗体群的规模不变，也要除去亲和度低或者适应度低的抗体；
(E)：免疫自调节：根据两个抗体的亲和度计算抗体浓度，对高浓度的抗体进行抑制，用以增加种群多样性；
(F)：生成新一代抗体群：对抗体群中的抗体进行选择、交叉和变异操作后，与更新后的记忆抗体群组成新一代抗体群；最优个体对应实际问题的新解；当新解满足算法停止条件时，算法终止，否则转向步骤(C)。
计算抗体浓度过程中，对抗体相似度的计算方法做出改进。设有两条路径P1(T11,T12,T13,···,T1n)与P2(T21,T22,T23,···,T2n)，其适应度分别为f1、f2，路径P1中包含的边有E1i(T1i,T1i+1)，路径P2中包含的边有E2i(T2i,T2i+1)。
(1)适应度部分相似度定义如下：
(2)路径结构部分相似度定义如下：
公式中N为抗体路径的长度，T1i与T2i分别表示为1、2号抗体路径中第i个的任务编号。
(3)则综合相似度定义如下：
similar(P1,P2)＝α*sp(P1,P2)+(1-α)*sf(P1,P2)
式中α为两部分的权重因子，当α＝0时，路径相似度只与路径适应度有关，当α＝1时，路径相似度只与路径结构有关，所以α是调节路径结构和适应度的权重参数。
进一步，在大小为n的抗体种群中，第i条抗体的浓度公式定义如下所示：
上式(12)中ε为一个较小的实数，Pi为第i抗体的路径，Pj为第j抗体的路径，函数isS(Pi,Pj)中g(Pi,Pj)的值为|similar(Pi,Pj)-1|。
在使用改进免疫遗传算法进行机器人路径规划的过程中，在算法中选择、交叉以及变异算子的概率计算方法如下：
(1)选择操作：在抗体群大小为n的种群中，第i个抗体的选择概率为PSi，为满足对浓度高的抗体进行抑制，适应度高的抗体进行促进，本发明选择概率计算方式如下所示：
上式中PSi max是i号抗体初始最大选择概率，PSi min是i号抗体是初始最小选择概率，fi为适应度，ci为i号抗体的浓度，ss(i)为用于计算选择概率的中间计算量。参数λ为浓度对选择概率的影响决定因子，当λ为0时其和基本遗传算法相似。
(2)交叉操作：抗体群中，为了使得免疫算法在解搜索范围内都具有同等的机会，所以抗体之间的交叉概率应为相同的，但是为了保证算法的稳定性交叉概率应该逐步减小。本文兼顾这些因素，对交叉概率的定义如下所示：
PCi＝PCmin，PCi＜PCmin
上式中T为最大迭代代数，t为当前代数，PCmax为抗体初始最大交叉概率，PCmin为抗体初始最小交叉概率；
(3)变异操作：在免疫遗传算法中，为了保持高适应度的抗体不被破坏，因此在抗体适应度越大时，其变异概率越小；抗体的浓度越大其变异概率越大。但为了最后群体的稳定收敛，抗体变异概率应逐渐减小。因此其变异概率如下所示：
上式(18)与(19)中fi表示i号抗体的适应度，fmax为抗体群中最大适应度，PMmax为抗体初始最大变异概率，PMmin为抗体初始最小变异概率，T为最大迭代代数，t为当前代数。
步骤3之后显示多机器人经过路径规划后的结果：
对于一条抗体路径P(T1,T2,T3,...,Tn)，步骤A中的目标函数为路径的距离最小，具体如公式(6)所示，其中d(P)为路径P的距离，Vi表示路径中的第i个任务节点。
对于步骤B中使用的最近阾算法产生初始抗体路径，具体的设有初始子路径son(i)，初始只包含一个任务点i，未插入的任务点包含在集合W中，最邻近算法具体步骤为：
(1)从W中取出距离son中距离最小的点r，将r插入子路径son中，并从W中移除任务点r；
(2)继续从集合W中取出一任务点r到最新插入子路径son中的任务点距离最小的任务点继续插入son中；
(3)重复进行步骤(2)操作，直到W中无任务点；
对于机器人路径规划步骤C中，亲和度的计算公式如式(7)所示；
式(7)中d(best)表示当前抗体种群中最优路径的距离，其中d(P)为路径P的距离，f(P)表示路径P的亲和度，取6次方是为了扩大适应度之间的间隙。
优点效果：该方法能将多个任务有效的分配至多个机器人，并且在机器人路径规划过程中，使用改进的免疫遗传算法能有效的减少算法的迭代次数，提高免疫遗传算法的全局最优解的搜索效率，求解到的最优解更短。
附图说明
图1为本发明多机器人任务分配流程图
图2为本发明多机器人任务分配结果图
图3为本发明使用最邻近算法产生的一条初始解
图4为本发明多机器人路径规划结果图
具体实施方式
下文将结合附图对本发明的具体实施方式进行详细说明。
本发明是一种多机器人任务分配及路径规划方法，在多机器人系统中，先将任务按一定策略分配至每个机器人，然后每个机器人对所分得的任务进行路径规划。具体包括以下步骤：
步骤1：机器人数据信息的获取，如机器人速度、电量、最大工作时间、最多可接受的任务数以及任务点的位置。如附图2所示，图中为随机生成的六个机器人以及200个任务点的数据经过任务分配后的结果图。
步骤2：多机器人任务分配：计算各机器人与任务之间的综合代价数据，综合考虑机器人电量、工作时间以及最大任务数等因素，按综合代价最小的准则将任务进行分配至机器人；其分配流程如附图1所示，其过程具体包括：
(1)任务分配的数学模型制定，具体如下：
T表示任务，R表示机器人；
Ri来表示多机器人系统中的第i个机器人，其中i∈[1,N]，N为机器人系统中的机器人数量；
Ti来表示多机器人系统中的第i个任务，其中i∈[1,M]，M为机器人系统中的任务数量；
i号机器人最大工作时间ti 0，i号机器人剩余工作时间ti 1,i号机器人完成j号任务所需消耗时间记为ntij；
Dist(Ti,Rj)表示利用机器人Rj来完成Ti所需要行走的距离值，记为dij；
Bettery(Ti,Rj)表示利用机器人Rj来完成Ti任务时机器人Rj所需要消耗的电量，记为nbij，由于每个机器的属性不同，每个机器人完成同一个任务其所需要消耗的电量是不相同的，因此本文用常数λij表示第i个机器人完成第j个任务单位距离消耗的电量；
(2)任务分配综合代价值计算方法
本发明综合考虑机器人本身属性的约束条件以及任务与机器人之间的不同距离等因素，主要根据机器人电量、任务点与机器人距离等形成一个评价机器人对该任务的综合代价值，综合代价值越低说明该机器人完成任务所需消耗的电量或者需要克服的困难越少。因此本发明设计了一个计算该综合代价值的函数，本发明的综合代价函数定义如公式(1)所示，该公式表示机器人完成任务所需的代价。
Cost(Ti,Rj)表示利用机器人Rj来完成Ti所需要的代价值，记为cij。
公式(1)至(3)中，Dist(Tj,Ri)代表机器人Ri与任务点Tj之间的距离，代表机器人Ri的速度，Bettery(Tj,Ri)代表机器人Ri完成任务Tj过程中这段距离所需要消耗的电量，由于消耗电量不仅与距离有关，而且与其本身的属性有关，所以使用一个常量因子λij代表第i个机器人完成第j个任务单位距离所消耗电量。公式(1)中的代价函数含义是在机器人完成任务所需时间最短、所需电量最小的时候将这个任务分配给这个机器人。
(3)任务分配至机器人需满足的条件
由于每个机器人的能力不同，造成每个机器人能够完成的任务数量也不尽相同，其他的约束条件如机器人的电量、机器人到任务之间的距离等都对机器人任务分配产生影响，首先设当前机器人Ri分配到的k个任务清单有(T1,T2,...,Tk)；因此要使得下一个任务分配至该机器人必须满足如下条件：
1)机器人Ri到此任务Tj之间的代价最小，数学表示如公式(4)所示：
min{Cost(Tj,Ri),i∈[1,N]} (4)
2)机器人剩余电量足够满足当前任务的消耗，具体表现为公式(5)：
其中B(Ri)为机器人Ri的初始电量，Dist(Tj,Ri)代表机器人Ri与任务点Tj之间的距离，λij代表第i个机器人完成第j个任务单位距离所消耗电量。
(4)多机器人任务分配步骤及流程，具体如下：
A：随机或读取产生机器人及任务数据，机器人数据信息包括编号Rn、初始位置rp0、初始电量b0、剩余电量b1、速度v、当前分配到任务数n等；任务数据包括：任务编号Tn、位置tp、分配否标识isA、分配至机器人编号toRn等。分别构成机器人与任务队列；
B：根据上文叙述部分的公式(1)至(3)计算j号任务分配给i号机器人所需要的代价信息，并记录一个包含Rni、Tnj、nbij、ntij、cij及dij的数据表table，并按代价的升序排列；
C：从table中取代价最小的一条数据record判断该记录中Tn对应的任务isA是否为true。如果是则重复此步骤，否则执行以下步骤；
D：判断record中Rni对应bi 1是否大于nbij，且ti 1是否大于ntij，以及机器人已分配到任务没有数到达上限，如果条件全部满足则继续，否则跳转步骤C中取代价次小的一条数据；
E：更新record中Rni对应机器人的剩余时间ti 1、剩余电量bi 1、分配到任务数n等数据，Tnj对应任务的toRn、isA等数据。跳转步骤C中继续取下一条数据。
步骤3：为每个机器人所分配到的任务点使用本发明的改进免疫遗传算法进行路径规划，其中单个机器人的路径规划的过程如下：
A：算法初始化：将待求解的目标函数和约束条件输入，作为带求解问题的抗原，初始化算法中种群的大小Popsize为100、选择概率PS、最大交叉概率为0.9、最小交叉概率为0.5以及变异概率PM最大和最小分别为0.3与0.1。精英保留抗体数为5。
B：生成初始抗体群：本发明的算法中初始抗体群的生成由两部分组成，第一部分由最邻近算法产生，为了保证初始解的多样性，第二部分由随机方法在解空间产生，由最邻近算法产生的初始抗体解的数量为Popsize*0.2。如图3所示为初始抗体群中最优抗体路径结果。
C：亲和度及浓度计算：计算抗原与抗体之间的亲和度抗体与抗体之间的浓度，对亲和度大的抗体和浓度小的抗体予以保留。为保持抗体群规模不变，要除去抗体群中亲和度低的抗体。
D：记忆抗体群更新：将抗体群中，亲和度最高的个体放入记忆抗体群中，同样也为了保持记忆抗体群的规模不变，也要除去亲和度低或者适应度低的抗体。
E：免疫自调节：根据两个抗体的亲和度计算抗体浓度，对高浓度的抗体进行抑制，用以增加种群多样性。
F：生成新一代抗体群：对抗体群中的抗体进行选择、交叉和变异操作后，与更新后的记忆抗体群组成新一代抗体群。最优个体对应实际问题的新解。当新解满足算法停止条件时，算法终止，否则转向步骤C。
步骤4：显示多机器人经过路径规划后的结果。如图4所示为多机器人经过路径规划后的运行结果图。
进一步，对于一条抗体路径P(T1,T2,T3,...,Tn)，步骤A中的目标函数为路径的距离最小，具体如公式(6)所示，其中d(P)为路径P的距离，Vi表示路径中的第i个任务节点。
进一步，对于步骤B中使用的最近阾算法产生初始抗体路径，具体的设有初始子路径son(i)，初始只包含一个任务点i，未插入的任务点包含在集合W中，最邻近算法具体步骤为：
(1)从W中取出距离son中距离最小的点r，将r插入子路径son中，并从W中移除任务点r；
(2)继续从集合W中取出一任务点r到最新插入子路径son中的任务点距离最小的任务点继续插入son中；
(3)重复进行步骤(2)操作，直到W中无任务点。
进一步，对于机器人路径规划步骤C中，亲和度的计算公式如式(7)所示。
式(7)中d(best)表示当前抗体种群中最优路径的距离，其中d(P)为路径P的距离，f(P)表示路径P的亲和度，取6次方是为了扩大适应度之间的间隙。
本发明在计算抗体浓度时，对抗体相似度的计算做出改变。
在传统的计算抗体相似度部分，多数采用的是计算路径距离，路径距离短的视为最优个体。但有很多路径距离不相近且路径连接顺序几乎相同的个体会因为亲和度大被保留在抗体群中，从而使计算陷入局部最优解。本发明综合考虑路径结构和适应度两方面，相似度计算包括路径结构的相似性和路径适应度的品质相似性。
设有两条路径P1(T11,T12,T13,···,T1n)与P2(T21,T22,T23,···,T2n)，其适应度分别为f1、f2。
适应度部分相似度定义的公式如(8)所示：
式(8)中θ为一个较小的实数，若θ取0.05时两路径满足上式中关系，则说明此两路径品质上相似度为95％。
路径结构部分相似度定义
对于两条抗体路径P1(T11,T12,T13,···,T1n)与P2(T21,T22,T23,···,T2n)，计算两条路径中的边，路径P1中包含的边有E1i(T1i,T1i+1)，路径P2中包含的边有E2i(T2i,T2i+1)。则P1与P2路径结构部分相似度定义公式如(9)至(10)所示：
公式9中N为抗体路径的长度，T1i与T2i分别表示为1、2号抗体路径中第i个的任务编号。
本文综合相似度定义公式为(11)所示：
similar(P1,P2)＝α*sp(P1,P2)+(1-α)*sf(P1,P2) (11)
式(11)中α为两部分的权重因子，当α＝0时，路径相似度只与路径适应度有关，当α＝1时，路径相似度只与路径结构有关，所以α是调节路径结构和适应度的权重参数。
在大小为n的抗体种群中，第i条抗体的浓度公式定义如(12)所示：
上式(12)中ε为一个较小的实数，Pi为第i抗体的路径，Pj为第j抗体的路径，函数isS(Pi,Pj)中g(Pi,Pj)的值为|similar(Pi,Pj)-1|。
进一步，对于机器人路径规划步骤F中，选择操作时的概率确定方法如下：
在抗体群大小为n的种群中，第i个抗体的选择概率为PSi，为满足对浓度高的抗体进行抑制，适应度高的抗体进行促进，本发明选择概率计算方式如公式(14)所示：
上式中PSi max是i号抗体初始最大选择概率，PSi min是i号抗体是初始最小选择概率，fi为适应度，ci为i号抗体的浓度，ss(i)为用于计算选择概率的中间计算量。参数λ为浓度对选择概率的影响决定因子，当λ为0时其和基本遗传算法相似。
进一步，对于机器人路径规划步骤F中，交叉操作时的概率确定方法如下：
抗体群中，为了使得免疫算法在解搜索范围内都具有同等的机会，所以抗体之间的交叉概率应为相同的，但是为了保证算法的稳定性交叉概率应该逐步减小。本文兼顾这些因素，对交叉概率的定义公式如(16)与(17)所示：
PCi＝PCmin，PCi＜PCmin (17)
上式(16)与(17)中T为最大迭代代数，t为当前代数，PCmax为抗体初始最大交叉概率，PCmin为抗体初始最小交叉概率。
进一步，对于机器人路径规划步骤F中，变异操作时的概率确定方法如下：
在免疫遗传算法中，为了保持高适应度的抗体不被破坏，因此在抗体适应度越大时，其变异概率越小；抗体的浓度越大其变异概率越大。但为了最后群体的稳定收敛，抗体变异概率应逐渐减小。因此其变异概率公式PMi如(18)、(19)所示：
上式(18)与(19)中fi表示i号抗体的适应度，fmax为抗体群中最大适应度，PMmax为抗体初始最大变异概率，PMmin为抗体初始最小变异概率，T为最大迭代代数，t为当前代数。

Claims (9)

1.一种多机器人任务分配及路径规划方法，其特征在于：所诉方法包括主要步骤如下：
步骤1：初始化多机器人与任务的信息：设置机器人的初始化状态参数、环境中任务的信息；获取机器人位置、速度以及最大电量和任务的位置数据信息；
步骤2：多机器人任务分配：计算各机器人与任务之间的综合代价数据，综合考虑机器人电量、工作时间以及最大任务数因素，按综合代价最小的准则将任务进行分配至机器人；
步骤3：机器人路径规划方法：对免疫遗传算法的初始解部分采用随机生成与产生特定的初始解相结合，使得算法接近机器人路径的全局最优解；在免疫遗传算法计算路径抗体相似度时，充分考虑路径的环形因素，使用相似边的数量与路径抗体适应度部分的相似性综合评价两条机器人路径的相似度。
2.根据权利要求1所述的多机器人任务分配及路径规划方法，其特征在于：步骤2中的多机器人的任务分配方法，其分配过程充分考虑机器人位置、速度以及电量多因素，其具体步骤如下：
(2-1)：随机或读取产生机器人及任务数据，机器人数据信息包括编号Rn、初始位置rp0、初始电量b0、剩余电量b1、速度v、当前分配到任务数n；任务数据包括：任务编号Tn、位置tp、分配否标识isA、分配至机器人编号toRn，分别构成机器人与任务队列；
(2-2)：计算j号任务分配给i号机器人所需要的综合代价信息，并记录一个包含Rni、Tnj、nbij、ntij、cij及dij的数据表table，并按代价的升序排列；
(2-3)：从table中取代价最小的一条数据record判断该记录中Tn对应的任务isA是否为true；如果是则重复此步骤，否则执行以下步骤；
(2-4)：判断record中Rni对应bi 1是否大于nbij，且ti 1是否大于ntij，以及机器人已分配到任务没有数到达上限，如果条件全部满足则继续，否则跳转步骤S23中取代价次小的一条数据；
(2-5)：更新record中Rni对应机器人的剩余时间ti 1、剩余电量bi 1、分配到任务数n数据，Tnj对应任务的toRn、isA数据；跳转步骤S23继续取下一条数据。
3.根据权利要求2所述的多机器人任务分配及路径规划方法，其特征在于：多机器人任务分配：计算各机器人与任务之间的综合代价数据，综合考虑机器人电量、工作时间以及最大任务数因素，按综合代价最小的准则将任务进行分配至机器人，其过程具体包括：
(1)任务分配的数学模型制定，具体如下：
T表示任务，R表示机器人；
Ri来表示多机器人系统中的第i个机器人，其中i∈[1,N]，N为机器人系统中的机器人数量；
Ti来表示多机器人系统中的第i个任务，其中i∈[1,M]，M为机器人系统中的任务数量；
i号机器人最大工作时间ti 0，i号机器人剩余工作时间ti 1,i号机器人完成j号任务所需消耗时间记为ntij；
Dist(Ti,Rj)表示利用机器人Rj来完成Ti所需要行走的距离值，记为dij；
Bettery(Ti,Rj)表示利用机器人Rj来完成Ti任务时机器人Rj所需要消耗的电量，记为nbij，由于每个机器的属性不同，每个机器人完成同一个任务其所需要消耗的电量是不相同的，因此本文用常数λij表示第i个机器人完成第j个任务单位距离消耗的电量；
(2)任务分配综合代价值计算方法
本发明设计了一个计算该综合代价值的函数，本发明的综合代价函数定义如公式(1)所示，该公式表示机器人完成任务所需的代价；
Cost(Ti,Rj)表示利用机器人Rj来完成Ti所需要的代价值，记为cij；
<mrow> <mi>C</mi> <mi>o</mi> <mi>s</mi> <mi> </mi> <mi>t</mi> <mrow> <mo>(</mo> <msub> <mi>T</mi> <mi>j</mi> </msub> <mo>,</mo> <msub> <mi>R</mi> <mi>i</mi> </msub> <mo>)</mo> </mrow> <mo>=</mo> <mfrac> <mrow> <mi>D</mi> <mi>i</mi> <mi>s</mi> <mi>t</mi> <mrow> <mo>(</mo> <msub> <mi>T</mi> <mi>j</mi> </msub> <mo>,</mo> <msub> <mi>R</mi> <mi>i</mi> </msub> <mo>)</mo> </mrow> </mrow> <msub> <mi>V</mi> <msub> <mi>R</mi> <mi>i</mi> </msub> </msub> </mfrac> <mo>*</mo> <mi>B</mi> <mi>e</mi> <mi>t</mi> <mi>t</mi> <mi>e</mi> <mi>r</mi> <mi>y</mi> <mrow> <mo>(</mo> <msub> <mi>T</mi> <mi>j</mi> </msub> <mo>,</mo> <msub> <mi>R</mi> <mi>i</mi> </msub> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mi>D</mi> <mi>i</mi> <mi>s</mi> <mi>t</mi> <mrow> <mo>(</mo> <msub> <mi>T</mi> <mi>j</mi> </msub> <mo>,</mo> <msub> <mi>R</mi> <mi>i</mi> </msub> <mo>)</mo> </mrow> <mo>=</mo> <msqrt> <mrow> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <msub> <mi>T</mi> <mi>j</mi> </msub> </msub> <mo>-</mo> <msub> <mi>x</mi> <msub> <mi>R</mi> <mi>i</mi> </msub> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <msub> <mi>T</mi> <mi>j</mi> </msub> </msub> <mo>-</mo> <msub> <mi>x</mi> <msub> <mi>R</mi> <mi>i</mi> </msub> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </msqrt> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mi>B</mi> <mi>e</mi> <mi>t</mi> <mi>t</mi> <mi>e</mi> <mi>r</mi> <mi>y</mi> <mrow> <mo>(</mo> <msub> <mi>T</mi> <mi>j</mi> </msub> <mo>,</mo> <msub> <mi>R</mi> <mi>i</mi> </msub> <mo>)</mo> </mrow> <mo>=</mo> <mfrac> <mrow> <mi>D</mi> <mi>i</mi> <mi>s</mi> <mi>t</mi> <mrow> <mo>(</mo> <msub> <mi>T</mi> <mi>j</mi> </msub> <mo>,</mo> <msub> <mi>R</mi> <mi>i</mi> </msub> <mo>)</mo> </mrow> </mrow> <msub> <mi>&amp;lambda;</mi> <mrow> <mi>i</mi> <mi>j</mi> </mrow> </msub> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </mrow>
公式(1)至(3)中，Dist(Tj,Ri)代表机器人Ri与任务点Tj之间的距离，VRi代表机器人Ri的速度，Bettery(Tj,Ri)代表机器人Ri完成任务Tj过程中这段距离所需要消耗的电量，由于消耗电量不仅与距离有关，而且与其本身的属性有关，所以使用一个常量因子λij代表第i个机器人完成第j个任务单位距离所消耗电量；公式(1)中的代价函数含义是在机器人完成任务所需时间最短、所需电量最小的时候将这个任务分配给这个机器人；
(3)任务分配至机器人需满足的条件：
首先设当前机器人Ri分配到的k个任务清单有(T1,T2,...,Tk)；因此要使得下一个任务分配至该机器人必须满足如下条件：
1)机器人Ri到此任务Tj之间的代价最小，数学表示如公式(4)所示：
min{Cost(Tj,Ri),i∈[1,N]} (4)
2)机器人剩余电量足够满足当前任务的消耗，具体表现为公式(5)：
<mrow> <mi>B</mi> <mrow> <mo>(</mo> <msub> <mi>R</mi> <mi>i</mi> </msub> <mo>)</mo> </mrow> <mo>-</mo> <munderover> <mi>&amp;Sigma;</mi> <mrow> <mi>j</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>k</mi> </munderover> <mi>B</mi> <mi>e</mi> <mi>t</mi> <mi>t</mi> <mi>e</mi> <mi>r</mi> <mi>y</mi> <mrow> <mo>(</mo> <mrow> <msub> <mi>R</mi> <mi>i</mi> </msub> <mo>,</mo> <msub> <mi>T</mi> <mi>j</mi> </msub> </mrow> <mo>)</mo> </mrow> <mo>=</mo> <mi>B</mi> <mrow> <mo>(</mo> <msub> <mi>R</mi> <mi>i</mi> </msub> <mo>)</mo> </mrow> <mo>-</mo> <munderover> <mi>&amp;Sigma;</mi> <mrow> <mi>j</mi> <mo>=</mo> <mn>0</mn> </mrow> <mi>k</mi> </munderover> <mfrac> <mrow> <mi>D</mi> <mrow> <mo>(</mo> <mrow> <msub> <mi>T</mi> <mi>j</mi> </msub> <mo>,</mo> <msub> <mi>R</mi> <mi>i</mi> </msub> </mrow> <mo>)</mo> </mrow> </mrow> <msub> <mi>&amp;lambda;</mi> <mrow> <mi>i</mi> <mi>j</mi> </mrow> </msub> </mfrac> <mo>&amp;GreaterEqual;</mo> <mn>0</mn> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>5</mn> <mo>)</mo> </mrow> </mrow>
其中B(Ri)为机器人Ri的初始电量，Dist(Tj,Ri)代表机器人Ri与任务点Tj之间的距离，λij代表第i个机器人完成第j个任务单位距离所消耗电量；
(4)多机器人任务分配步骤及流程，具体如下：
A：随机或读取产生机器人及任务数据，机器人数据信息包括编号Rn、初始位置rp0、初始电量b0、剩余电量b1、速度v、当前分配到任务数n；任务数据包括：任务编号Tn、位置tp、分配否标识isA、分配至机器人编号toRn；分别构成机器人与任务队列；
B：根据上文叙述部分的公式(1)至(3)计算j号任务分配给i号机器人所需要的代价信息，并记录一个包含Rni、Tnj、nbij、ntij、cij及dij的数据表table，并按代价的升序排列；
C：从table中取代价最小的一条数据record判断该记录中Tn对应的任务isA是否为true；如果是则重复此步骤，否则执行以下步骤；
D：判断record中Rni对应bi 1是否大于nbij，且ti 1是否大于ntij，以及机器人已分配到任务没有数到达上限，如果条件全部满足则继续，否则跳转步骤C中取代价次小的一条数据；
E：更新record中Rni对应机器人的剩余时间ti 1、剩余电量bi 1、分配到任务数n数据，Tnj对应任务的toRn、isA数据；跳转步骤C中继续取下一条数据。
4.根据权利要求1所述的多机器人任务分配及路径规划方法，其特征在于：步骤3中，免疫遗传算法产生初始解时本发明采用最邻近算法和随机法相结合；在计算抗体浓度时，计算相似度的过程中通过计算两条抗体路径边相同数量来判断抗体路径的相似性，从而计算抗体的浓度。
5.根据权利要求4所述的多机器人任务分配及路径规划方法，其特征在于：本方使用一种新的免疫遗传初始抗体群生成方法，初始抗体群大小Popsize的20％由最邻近算法产生近似最优解，为保证抗体群的多样性，剩下80％依然由随机法产生；
如果机器人分配到的任务数N小于N≤Popsize*0.2，则由最邻近算法产生N条路径的初始解，否则由最邻近算法产生出Popsize*0.2条初始路径解，其余部分由随机发产生。
6.根据权利要求5所述的多机器人任务分配及路径规划方法，其特征在于：步骤3中为每个机器人所分配到的任务点使用本发明的改进免疫遗传算法进行路径规划，其中单个机器人的路径规划的过程如下：
(A)：算法初始化：将待求解的目标函数和约束条件输入，作为带求解问题的抗原，初始化算法中种群的大小Popsize为100、选择概率PS、最大交叉概率为0.9、最小交叉概率为0.5以及变异概率PM最大和最小分别为0.3与0.1；精英保留抗体数为5；
(B)：生成初始抗体群：本算法中初始抗体群的生成由两部分组成，第一部分由最邻近算法产生，第二部分由随机方法在解空间产生，由最邻近算法产生的初始抗体解的数量为Popsize*0.2；
(C)：亲和度及浓度计算：计算抗原与抗体之间的亲和度抗体与抗体之间的浓度，对亲和度大的抗体和浓度小的抗体予以保留；除去抗体群中亲和度低的抗体；
(D)：记忆抗体群更新：将抗体群中，亲和度最高的个体放入记忆抗体群中，同样也为了保持记忆抗体群的规模不变，也要除去亲和度低或者适应度低的抗体；
(E)：免疫自调节：根据两个抗体的亲和度计算抗体浓度，对高浓度的抗体进行抑制，用以增加种群多样性；
(F)：生成新一代抗体群：对抗体群中的抗体进行选择、交叉和变异操作后，与更新后的记忆抗体群组成新一代抗体群；最优个体对应实际问题的新解；当新解满足算法停止条件时，算法终止，否则转向步骤(C)。
7.根据权利要求4所述的多机器人任务分配及路径规划方法，其特征在于：计算抗体浓度过程中，采用一种抗体相似度计算方法来度量路径规划中的路径相似性，设有两条路径P1(T11,T12,T13,···,T1n)与P2(T21,T22,T23,···,T2n)，其适应度分别为f1、f2；
适应度部分相似度定义的公式如(8)所示：
<mrow> <mi>s</mi> <mi>f</mi> <mrow> <mo>(</mo> <msub> <mi>P</mi> <mn>1</mn> </msub> <mo>,</mo> <msub> <mi>P</mi> <mn>2</mn> </msub> <mo>)</mo> </mrow> <mo>=</mo> <mo>|</mo> <mfrac> <msub> <mi>f</mi> <mn>1</mn> </msub> <msub> <mi>f</mi> <mn>2</mn> </msub> </mfrac> <mo>-</mo> <mn>1</mn> <mo>|</mo> <mo>&lt;</mo> <mi>&amp;theta;</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>8</mn> <mo>)</mo> </mrow> </mrow>
式(8)中θ为一个较小的实数，若θ取0.05时两路径满足上式中关系，则说明此两路径品质上相似度为95％；
路径结构部分相似度定义
对于两条抗体路径P1(T11,T12,T13,···,T1n)与P2(T21,T22,T23,···,T2n)，计算两条路径中的边，路径P1中包含的边有E1i(T1i,T1i+1)，路径P2中包含的边有E2i(T2i,T2i+1)；则P1与P2路径结构部分相似度定义公式如(9)至(10)所示：
<mrow> <mi>s</mi> <mi>p</mi> <mrow> <mo>(</mo> <msub> <mi>P</mi> <mn>1</mn> </msub> <mo>,</mo> <msub> <mi>P</mi> <mn>2</mn> </msub> <mo>)</mo> </mrow> <mo>=</mo> <mrow> <mo>(</mo> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>0</mn> </mrow> <mi>N</mi> </munderover> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>j</mi> <mo>=</mo> <mn>0</mn> </mrow> <mi>N</mi> </munderover> <msub> <mi>E</mi> <mrow> <mn>1</mn> <mi>i</mi> </mrow> </msub> <mo>&amp;CirclePlus;</mo> <msub> <mi>E</mi> <mrow> <mn>2</mn> <mi>i</mi> </mrow> </msub> <mo>)</mo> </mrow> <mo>/</mo> <mi>N</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>9</mn> <mo>)</mo> </mrow> </mrow> 3
公式9中N为抗体路径的长度，T1i与T2i分别表示为1、2号抗体路径中第i个的任务编号；
本文综合相似度定义公式为(11)所示：
similar(P1,P2)＝α*sp(P1,P2)+(1-α)*sf(P1,P2) (11)
式(11)中α为两部分的权重因子，当α＝0时，路径相似度只与路径适应度有关，当α＝1时，路径相似度只与路径结构有关，所以α是调节路径结构和适应度的权重参数；
在大小为n的抗体种群中，第i条抗体的浓度公式定义如(12)所示：
<mrow> <msub> <mi>c</mi> <mi>i</mi> </msub> <mo>=</mo> <mfrac> <mrow> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>j</mi> <mo>=</mo> <mn>1</mn> <mo>,</mo> <mi>j</mi> <mo>&amp;NotEqual;</mo> <mi>i</mi> </mrow> <mi>n</mi> </munderover> <mi>i</mi> <mi>s</mi> <mi>S</mi> <mrow> <mo>(</mo> <msub> <mi>P</mi> <mi>i</mi> </msub> <mo>,</mo> <msub> <mi>P</mi> <mi>j</mi> </msub> <mo>)</mo> </mrow> </mrow> <mi>n</mi> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>12</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mi>i</mi> <mi>s</mi> <mi>S</mi> <mrow> <mo>(</mo> <msub> <mi>P</mi> <mi>i</mi> </msub> <mo>,</mo> <msub> <mi>P</mi> <mi>j</mi> </msub> <mo>)</mo> </mrow> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mrow> <mi>g</mi> <mrow> <mo>(</mo> <msub> <mi>P</mi> <mi>i</mi> </msub> <mo>,</mo> <msub> <mi>P</mi> <mi>j</mi> </msub> <mo>)</mo> </mrow> <mo>&amp;le;</mo> <mi>&amp;epsiv;</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mi>g</mi> <mrow> <mo>(</mo> <msub> <mi>P</mi> <mi>i</mi> </msub> <mo>,</mo> <msub> <mi>P</mi> <mi>j</mi> </msub> <mo>)</mo> </mrow> <mo>&gt;</mo> <mi>&amp;epsiv;</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>13</mn> <mo>)</mo> </mrow> </mrow>
上式(12)中ε为一个较小的实数，Pi为第i抗体的路径，Pj为第j抗体的路径，函数isS(Pi,Pj)中g(Pi,Pj)的值为|similar(Pi,Pj)-1|。
8.根据权利要求6所述的多机器人任务分配及路径规划方法，其特征在于：(F)步骤中在算法中选选择操作时的概率确定方法如下：
在抗体群大小为n的种群中，第i个抗体的选择概率为PSi，本方法选择概率计算方式如公式(14)所示：
<mrow> <mi>s</mi> <mi>s</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfrac> <msub> <mi>f</mi> <mi>i</mi> </msub> <mrow> <munderover> <mo>&amp;Sigma;</mo> <mi>j</mi> <mi>n</mi> </munderover> <msub> <mi>f</mi> <mi>j</mi> </msub> </mrow> </mfrac> <mo>-</mo> <msub> <mi>&amp;lambda;c</mi> <mi>i</mi> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>15</mn> <mo>)</mo> </mrow> </mrow>
上式中PSi max是i号抗体初始最大选择概率，PSi min是i号抗体是初始最小选择概率，fi为适应度，ci为i号抗体的浓度，ss(i)为用于计算选择概率的中间计算量；参数λ为浓度对选择概率的影响决定因子，当λ为0时其和基本遗传算法相似；
交叉操作时的概率确定方法如下：
本方法对交叉概率的定义公式如(16)与(17)所示：
<mrow> <msub> <mi>PC</mi> <mi>i</mi> </msub> <mo>=</mo> <mfrac> <mi>T</mi> <mrow> <mi>T</mi> <mo>+</mo> <mi>t</mi> </mrow> </mfrac> <mo>*</mo> <msub> <mi>PC</mi> <mrow> <mi>m</mi> <mi>a</mi> <mi>x</mi> </mrow> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>16</mn> <mo>)</mo> </mrow> </mrow>
PCi＝PCmin，PCi＜PCmin (17)
上式(16)与(17)中T为最大迭代代数，t为当前代数，PCmax为抗体初始最大交叉概率，PCmin为抗体初始最小交叉概率；
变异操作时的概率确定方法如下：
变异概率公式PMi如(18)、(19)所示：
<mrow> <msub> <mi>PM</mi> <mi>i</mi> </msub> <mo>=</mo> <mfrac> <mi>T</mi> <mrow> <mi>T</mi> <mo>+</mo> <mi>t</mi> </mrow> </mfrac> <mo>*</mo> <msub> <mi>PM</mi> <mrow> <mi>m</mi> <mi>a</mi> <mi>x</mi> </mrow> </msub> <mo>*</mo> <mfrac> <msub> <mi>f</mi> <mrow> <mi>m</mi> <mi>a</mi> <mi>x</mi> </mrow> </msub> <mrow> <msub> <mi>f</mi> <mi>i</mi> </msub> <mo>+</mo> <msub> <mi>f</mi> <mrow> <mi>m</mi> <mi>a</mi> <mi>x</mi> </mrow> </msub> </mrow> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>18</mn> <mo>)</mo> </mrow> </mrow>
上式(18)与(19)中fi表示i号抗体的适应度，fmax为抗体群中最大适应度，PMmax为抗体初始最大变异概率，PMmin为抗体初始最小变异概率，T为最大迭代代数，t为当前代数。
9.根据权利要求6所述的多机器人任务分配及路径规划方法，其特征在于：步骤3之后显示多机器人经过路径规划后的结果：
对于一条抗体路径P(T1,T2,T3,...,Tn)，步骤A中的目标函数为路径的距离最小，具体如公式(6)所示，其中d(P)为路径P的距离，Vi表示路径中的第i个任务节点；
<mrow> <mi>d</mi> <mrow> <mo>(</mo> <mi>P</mi> <mo>)</mo> </mrow> <mo>=</mo> <munderover> <mi>&amp;Sigma;</mi> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>n</mi> </munderover> <mi>d</mi> <mrow> <mo>(</mo> <msub> <mi>V</mi> <mi>i</mi> </msub> <mo>,</mo> <msub> <mi>V</mi> <mrow> <mi>i</mi> <mo>+</mo> <mn>1</mn> </mrow> </msub> <mo>)</mo> </mrow> <mo>+</mo> <mi>d</mi> <mrow> <mo>(</mo> <msub> <mi>V</mi> <mi>n</mi> </msub> <mo>,</mo> <msub> <mi>V</mi> <mn>1</mn> </msub> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>6</mn> <mo>)</mo> </mrow> </mrow>
对于步骤B中使用的最近阾算法产生初始抗体路径，具体的设有初始子路径son(i)，初始只包含一个任务点i，未插入的任务点包含在集合W中，最邻近算法具体步骤为：
(1)从W中取出距离son中距离最小的点r，将r插入子路径son中，并从W中移除任务点r；
(2)继续从集合W中取出一任务点r到最新插入子路径son中的任务点距离最小的任务点继续插入son中；
(3)重复进行步骤(2)操作，直到W中无任务点；
对于机器人路径规划步骤C中，亲和度的计算公式如式(7)所示；
<mrow> <mi>f</mi> <mrow> <mo>(</mo> <mi>P</mi> <mo>)</mo> </mrow> <mo>=</mo> <msup> <mrow> <mo>&amp;lsqb;</mo> <mfrac> <mrow> <mi>d</mi> <mrow> <mo>(</mo> <mi>b</mi> <mi>e</mi> <mi>s</mi> <mi>t</mi> <mo>)</mo> </mrow> </mrow> <mrow> <mn>1</mn> <mo>+</mo> <mi>d</mi> <mrow> <mo>(</mo> <mi>P</mi> <mo>)</mo> </mrow> </mrow> </mfrac> <mo>&amp;rsqb;</mo> </mrow> <mn>6</mn> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>7</mn> <mo>)</mo> </mrow> </mrow>
式(7)中d(best)表示当前抗体种群中最优路径的距离，其中d(P)为路径P的距离，f(P)表示路径P的亲和度，取6次方是为了扩大适应度之间的间隙。
CN201710324492.3A 2017-05-10 2017-05-10 多机器人任务分配及路径规划方法 Expired - Fee Related CN107168054B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710324492.3A CN107168054B (zh) 2017-05-10 2017-05-10 多机器人任务分配及路径规划方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710324492.3A CN107168054B (zh) 2017-05-10 2017-05-10 多机器人任务分配及路径规划方法

Publications (2)

Publication Number Publication Date
CN107168054A true CN107168054A (zh) 2017-09-15
CN107168054B CN107168054B (zh) 2020-11-10

Family

ID=59812584

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710324492.3A Expired - Fee Related CN107168054B (zh) 2017-05-10 2017-05-10 多机器人任务分配及路径规划方法

Country Status (1)

Country Link
CN (1) CN107168054B (zh)

Cited By (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107831685A (zh) * 2017-10-13 2018-03-23 南方科技大学 一种群体机器人的控制方法和系统
CN108416488A (zh) * 2017-12-21 2018-08-17 中南大学 一种面向动态任务的多智能机器人任务分配方法
CN108594813A (zh) * 2018-04-18 2018-09-28 苏州大学张家港工业技术研究院 一种大尺度室内环境下多清洁机器人任务分配方法
CN108764579A (zh) * 2018-06-01 2018-11-06 成都交大光芒科技股份有限公司 一种基于拥塞控制的仓储多机器人任务调度方法
CN108830483A (zh) * 2018-06-15 2018-11-16 桂林电子科技大学 多智能体系统任务规划方法
CN109746918A (zh) * 2019-02-14 2019-05-14 中山大学 一种联合优化的云机器人系统延时的优化方法
CN109917817A (zh) * 2019-05-06 2019-06-21 中国海洋大学 多水下机器人协同路径规划方法
CN110046818A (zh) * 2019-04-15 2019-07-23 广州高新兴机器人有限公司 一种多机器人任务分配方法
WO2019141225A1 (zh) * 2018-01-19 2019-07-25 库卡机器人(广东)有限公司 多移动机器人的冲突管理方法及系统
CN110309993A (zh) * 2018-03-27 2019-10-08 杭州海康机器人技术有限公司 一种自动导引运输车agv任务分配方法及装置
CN110362107A (zh) * 2019-06-17 2019-10-22 杭州电子科技大学 基于免疫优化算法的多无人机任务分配问题的求解方法
CN110712206A (zh) * 2019-10-16 2020-01-21 北京洛必德科技有限公司 智能机器人的多任务分配方法、装置、设备及存储介质
CN110737263A (zh) * 2019-11-21 2020-01-31 中科探海(苏州)海洋科技有限责任公司 一种基于人工免疫的多机器人队形控制方法
CN111805542A (zh) * 2020-07-09 2020-10-23 上海有个机器人有限公司 仓储舱机械臂移动控制方法及装置
CN112053050A (zh) * 2020-08-27 2020-12-08 北京云迹科技有限公司 适用于机器人与人之间协作效率的评估方法、装置及系统
CN112270752A (zh) * 2020-10-29 2021-01-26 久瓴(上海)智能科技有限公司 农林作业路径生成方法、装置、计算机设备和存储介质
CN113246129A (zh) * 2021-05-21 2021-08-13 佛山科学技术学院 一种叉车机器人控制系统及方法
CN113256125A (zh) * 2021-05-28 2021-08-13 西安交通大学 异构机器人集群任务分配方法、系统、设备及存储介质
CN113627648A (zh) * 2021-07-08 2021-11-09 中汽创智科技有限公司 一种任务分配方法、装置、设备及存储介质
CN113640680A (zh) * 2021-08-04 2021-11-12 国网浙江省电力有限公司嘉兴供电公司 一种基于电池电量的机器人指令分配方法
CN113934228A (zh) * 2021-10-18 2022-01-14 天津大学 基于协商共识的集群四旋翼无人机任务规划方法
CN114019960A (zh) * 2021-10-19 2022-02-08 北京云迹科技有限公司 一种多机器人送物的调度方法及装置
CN116922402A (zh) * 2023-09-19 2023-10-24 杭州芯控智能科技有限公司 基于遗传算法的多机械臂多任务分配方法、系统和介质

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2001078951A1 (en) * 2000-04-13 2001-10-25 Zhimin Lin Semi-optimal path finding in a wholly unknown environment
US20090070281A1 (en) * 2007-06-01 2009-03-12 Solomon Research Llc System for hybridized efficient genetic algorithms to solve bi-objective optimization problems with application to network computing
CN101738314A (zh) * 2009-12-14 2010-06-16 江苏省现代企业信息化应用支撑软件工程技术研发中心 一种基于抗体浓度的齿轮故障诊断方法
CN103077425A (zh) * 2012-11-23 2013-05-01 中国科学院沈阳自动化研究所 一种用于auv实时路径规划的免疫遗传算法
CN104407616A (zh) * 2014-12-03 2015-03-11 沈阳工业大学 基于免疫网络算法的移动机器人动态路径规划方法
CN105302062A (zh) * 2015-10-15 2016-02-03 东南大学 一种基于任务解耦的多机器人协作焊接路径的生成方法
CN105652838A (zh) * 2016-01-29 2016-06-08 哈尔滨工大服务机器人有限公司 一种基于时间窗的多机器人路径规划方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2001078951A1 (en) * 2000-04-13 2001-10-25 Zhimin Lin Semi-optimal path finding in a wholly unknown environment
US20090070281A1 (en) * 2007-06-01 2009-03-12 Solomon Research Llc System for hybridized efficient genetic algorithms to solve bi-objective optimization problems with application to network computing
CN101738314A (zh) * 2009-12-14 2010-06-16 江苏省现代企业信息化应用支撑软件工程技术研发中心 一种基于抗体浓度的齿轮故障诊断方法
CN103077425A (zh) * 2012-11-23 2013-05-01 中国科学院沈阳自动化研究所 一种用于auv实时路径规划的免疫遗传算法
CN104407616A (zh) * 2014-12-03 2015-03-11 沈阳工业大学 基于免疫网络算法的移动机器人动态路径规划方法
CN105302062A (zh) * 2015-10-15 2016-02-03 东南大学 一种基于任务解耦的多机器人协作焊接路径的生成方法
CN105652838A (zh) * 2016-01-29 2016-06-08 哈尔滨工大服务机器人有限公司 一种基于时间窗的多机器人路径规划方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
P.K.DAS等: "A hybrid improved PSO-DV algorithm for multi-robot path planning in a clutter environment", 《NEUROCOMPUTING》 *
叶兆莉: "基于免疫理论的多移动机器人任务分配及路径规划", 《中国优秀硕士学位论文全文数据库信息科技辑》 *
崔宝侠，等: "机器人在未知环境条件下的动态避障", 《沈阳工业大学学报》 *

Cited By (34)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107831685A (zh) * 2017-10-13 2018-03-23 南方科技大学 一种群体机器人的控制方法和系统
CN107831685B (zh) * 2017-10-13 2023-03-14 南方科技大学 一种群体机器人的控制方法和系统
CN108416488A (zh) * 2017-12-21 2018-08-17 中南大学 一种面向动态任务的多智能机器人任务分配方法
WO2019141225A1 (zh) * 2018-01-19 2019-07-25 库卡机器人(广东)有限公司 多移动机器人的冲突管理方法及系统
CN110309993B (zh) * 2018-03-27 2022-04-05 杭州海康机器人技术有限公司 一种自动导引运输车agv任务分配方法及装置
CN110309993A (zh) * 2018-03-27 2019-10-08 杭州海康机器人技术有限公司 一种自动导引运输车agv任务分配方法及装置
CN108594813A (zh) * 2018-04-18 2018-09-28 苏州大学张家港工业技术研究院 一种大尺度室内环境下多清洁机器人任务分配方法
CN108594813B (zh) * 2018-04-18 2021-04-09 苏州大学张家港工业技术研究院 一种大尺度室内环境下多清洁机器人任务分配方法
CN108764579A (zh) * 2018-06-01 2018-11-06 成都交大光芒科技股份有限公司 一种基于拥塞控制的仓储多机器人任务调度方法
CN108764579B (zh) * 2018-06-01 2021-09-07 成都交大光芒科技股份有限公司 一种基于拥塞控制的仓储多机器人任务调度方法
CN108830483B (zh) * 2018-06-15 2021-11-23 桂林电子科技大学 多智能体系统任务规划方法
CN108830483A (zh) * 2018-06-15 2018-11-16 桂林电子科技大学 多智能体系统任务规划方法
CN109746918A (zh) * 2019-02-14 2019-05-14 中山大学 一种联合优化的云机器人系统延时的优化方法
CN110046818A (zh) * 2019-04-15 2019-07-23 广州高新兴机器人有限公司 一种多机器人任务分配方法
CN109917817A (zh) * 2019-05-06 2019-06-21 中国海洋大学 多水下机器人协同路径规划方法
CN110362107A (zh) * 2019-06-17 2019-10-22 杭州电子科技大学 基于免疫优化算法的多无人机任务分配问题的求解方法
CN110712206B (zh) * 2019-10-16 2020-12-22 北京洛必德科技有限公司 智能机器人的多任务分配方法、装置、设备及存储介质
CN110712206A (zh) * 2019-10-16 2020-01-21 北京洛必德科技有限公司 智能机器人的多任务分配方法、装置、设备及存储介质
CN110737263A (zh) * 2019-11-21 2020-01-31 中科探海(苏州)海洋科技有限责任公司 一种基于人工免疫的多机器人队形控制方法
CN111805542A (zh) * 2020-07-09 2020-10-23 上海有个机器人有限公司 仓储舱机械臂移动控制方法及装置
CN112053050A (zh) * 2020-08-27 2020-12-08 北京云迹科技有限公司 适用于机器人与人之间协作效率的评估方法、装置及系统
CN112270752A (zh) * 2020-10-29 2021-01-26 久瓴(上海)智能科技有限公司 农林作业路径生成方法、装置、计算机设备和存储介质
CN113246129B (zh) * 2021-05-21 2022-04-26 佛山科学技术学院 一种叉车机器人控制系统及方法
CN113246129A (zh) * 2021-05-21 2021-08-13 佛山科学技术学院 一种叉车机器人控制系统及方法
CN113256125A (zh) * 2021-05-28 2021-08-13 西安交通大学 异构机器人集群任务分配方法、系统、设备及存储介质
CN113256125B (zh) * 2021-05-28 2023-06-30 西安交通大学 异构机器人集群任务分配方法、系统、设备及存储介质
CN113627648A (zh) * 2021-07-08 2021-11-09 中汽创智科技有限公司 一种任务分配方法、装置、设备及存储介质
CN113627648B (zh) * 2021-07-08 2024-10-15 中汽创智科技有限公司 一种任务分配方法、装置、设备及存储介质
CN113640680A (zh) * 2021-08-04 2021-11-12 国网浙江省电力有限公司嘉兴供电公司 一种基于电池电量的机器人指令分配方法
CN113934228A (zh) * 2021-10-18 2022-01-14 天津大学 基于协商共识的集群四旋翼无人机任务规划方法
CN113934228B (zh) * 2021-10-18 2023-12-19 天津大学 基于协商共识的集群四旋翼无人机任务规划方法
CN114019960A (zh) * 2021-10-19 2022-02-08 北京云迹科技有限公司 一种多机器人送物的调度方法及装置
CN114019960B (zh) * 2021-10-19 2024-06-07 北京云迹科技股份有限公司 一种多机器人送物的调度方法及装置
CN116922402A (zh) * 2023-09-19 2023-10-24 杭州芯控智能科技有限公司 基于遗传算法的多机械臂多任务分配方法、系统和介质

Also Published As

Publication number Publication date
CN107168054B (zh) 2020-11-10

Similar Documents

Publication Publication Date Title
CN107168054A (zh) 多机器人任务分配及路径规划方法
Modares et al. A self‐organizing neural network approach for multiple traveling salesman and vehicle routing problems
Jin et al. An efficient self-organizing map designed by genetic algorithms for the traveling salesman problem
Hassanat et al. On enhancing genetic algorithms using new crossovers
Liang et al. Applying genetic algorithm and ant colony optimization algorithm into marine investigation path planning model
Li et al. An improved genetic algorithm of optimum path planning for mobile robots
Ni et al. A multiagent Q-learning-based optimal allocation approach for urban water resource management system
Ghaderi et al. An efficient hybrid particle swarm optimization algorithm for solving the uncapacitated continuous location-allocation problem
Shu et al. A modified hybrid rice optimization algorithm for solving 0-1 knapsack problem
Larki et al. Solving the multiple traveling salesman problem by a novel meta-heuristic algorithm
Brajevic Artificial bee colony algorithm for the capacitated vehicle routing problem
Mashwani Comprehensive survey of the hybrid evolutionary algorithms
CN103473465B (zh) 基于多目标人工免疫系统的土地资源空间布局优化方法
CN107040879A (zh) 一种基于遗传模糊树的无线传感网节点联合移动算法
Liang et al. An ant colony approach to the orienteering problem
Hakimi-Asiabar et al. Multi-objective genetic local search algorithm using Kohonen’s neural map
Qiao et al. A hybridized parallel bats algorithm for combinatorial problem of traveling salesman
Lin et al. Designing mamdani type fuzzy rule using a collaborative FCM scheme
Marinakis et al. Combinatorial neighborhood topology particle swarm optimization algorithm for the vehicle routing problem
Duan et al. EDA based probabilistic Memetic Algorithm for distributed blocking permutation flowshop scheduling with sequence dependent setup time
Xu et al. Ant Colony Optimization for Multiple Travelling Salesmen Problem with Pivot Cities
Luo et al. A new memetic algorithm to solve the stochastic tsp
Liang et al. An adaptive ant colony system for public bicycle scheduling problem
Guo et al. Swap-based Deep Reinforcement Learning for Facility Location Problems in Networks
Benali et al. Dynamic multiobjective optimization of large‐scale industrial production systems: an emerging strategy

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20201110

Termination date: 20210510