CN112783207A - 一种基于多目标粒子群优化的无人机航迹规划方法 - Google Patents
一种基于多目标粒子群优化的无人机航迹规划方法 Download PDFInfo
- Publication number
- CN112783207A CN112783207A CN202011627216.2A CN202011627216A CN112783207A CN 112783207 A CN112783207 A CN 112783207A CN 202011627216 A CN202011627216 A CN 202011627216A CN 112783207 A CN112783207 A CN 112783207A
- Authority
- CN
- China
- Prior art keywords
- particle
- external storage
- index
- particle swarm
- pbest
- 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
Links
- 239000002245 particle Substances 0.000 title claims abstract description 354
- 238000013439 planning Methods 0.000 title claims abstract description 34
- 238000000034 method Methods 0.000 title claims abstract description 18
- 238000005457 optimization Methods 0.000 title claims abstract description 17
- 238000000354 decomposition reaction Methods 0.000 claims abstract description 7
- 238000003860 storage Methods 0.000 claims description 84
- 230000006870 function Effects 0.000 claims description 38
- 239000013598 vector Substances 0.000 claims description 18
- 239000000126 substance Substances 0.000 claims description 8
- 238000004364 calculation method Methods 0.000 claims description 4
- 238000010276 construction Methods 0.000 claims description 2
- 238000005516 engineering process Methods 0.000 abstract description 12
- 238000004891 communication Methods 0.000 abstract description 11
- 238000012545 processing Methods 0.000 abstract description 10
- 230000015572 biosynthetic process Effects 0.000 abstract description 3
- 238000001514 detection method Methods 0.000 abstract description 3
- 238000007726 management method Methods 0.000 abstract description 3
- 239000011159 matrix material Substances 0.000 description 9
- 230000008569 process Effects 0.000 description 4
- 238000011161 development Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 230000002776 aggregation Effects 0.000 description 2
- 238000004220 aggregation Methods 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012384 transportation and delivery Methods 0.000 description 2
- 208000025721 COVID-19 Diseases 0.000 description 1
- 241000283715 Damaliscus lunatus Species 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000009826 distribution Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000003780 insertion Methods 0.000 description 1
- 230000037431 insertion Effects 0.000 description 1
- XOFYZVNMUHMLCC-ZPOLXVRWSA-N prednisone Chemical compound O=C1C=C[C@]2(C)[C@H]3C(=O)C[C@](C)([C@@](CC4)(O)C(=O)CO)[C@@H]4[C@@H]3CCC2=C1 XOFYZVNMUHMLCC-ZPOLXVRWSA-N 0.000 description 1
- 238000005507 spraying Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
- G05D1/104—Simultaneous control of position or course in three dimensions specially adapted for aircraft involving a plurality of aircrafts, e.g. formation flying
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Management, Administration, Business Operations System, And Electronic Commerce (AREA)
Abstract
本发明属于无人机航迹规划技术领域,具体涉及一种基于多目标粒子群优化的无人机航迹规划方法。本发明将通过5G通讯技术与GPS定位技术获取到的无人机和用户位置等信息,同时传回到数据处理服务器,使用两阶段基于分解的多目标粒子群优化算法进行可行航迹规划,输出一组可行方案,再由数据服务器端向当前区域的无人机发出指令,使无人机按顺序执行出行计划。本发明可以与编队策略、避障策略、目标检测、三维路径规划等技术方向进行有机结合,以提高航迹规划方案的可行性,增加无人机航迹规划规划的功能性,增加无人机管理与决策的效率,同时满足不同应用的总体目标函数与约束条件。
Description
技术领域
本发明属于无人机航迹规划技术领域,具体涉及一种基于多目标粒子群优化的无人机航迹规划方法。
背景技术
由于5G通信技术的发展,使通信速度加快、时延更低、获得的信息可靠性更高、覆盖范围更广,提供了从无线网到核心网络解决方案,配合GSP定位可获得无人机和用户更加准确的位置,因此可以通过5G通信技术和GPS定位技术,使5G网联的无人机终端、用户端和地面控制终端均通过5G网络进行数据传输和控制指令传输,在数据处理和控制指令发出的问题上,将使用当前区域的数据处理服务器来进行计算。
目前国内在无人机的航迹规划方面已有了一些进展,在民用方面使用无人机进行快递配送、救灾物资投放、喷洒田地也成为了新的目标,其所应用的技术具有巨大的市场潜力。无人机的使用可以减少人力,为人类提供更便利的生活且使人类远离危险地带。目前无人机可以负重3kg、飞行长达150公里,能应用于小型民用包裹的交付。
在无人机航迹规划问题上,可以为每架无人机在载荷、航距、通信、算力等资源限制下,分配最佳的航行路线,以确保无人机群可完成任务,且达到航程最短、消耗时间最短、调用无人机数量最少等效果。因此可以将该问题转化为多目标优化问题,在当前区域的数据处理服务器上进行求解。此外民用快递无人机可使用类似直升机的旋翼无人机,其具有垂直起飞和着陆的功能,方便爬楼和释放包裹。另外,无人机在固定高度匀速飞行时基本不会遇到障碍,并可到达目标点后再相应进行升降高度,因此在计算航程时也可不考虑高度并且也减少了飞机斜向飞行造成碰撞的几率,同时还将三维问题转化为二维问题,因此可将该问题转化为VRPTW问题进行处理。
发明内容
本发明的目的在于提供一种基于多目标粒子群优化的无人机航迹规划方法。
本发明的目的通过如下技术方案来实现:包括以下步骤:
步骤1:获取无人机的信息数据和用户的信息数据;
步骤2:设置种群数量pop_size,初始化迭代次数k=0;
步骤3:根据应用约束条件和目标函数,混合使用贪心算法和随机算法为pop_size个粒子生成可行航迹,作为初始粒子群pop,同时保存各粒子的位置和速度;对种群中每一个粒子生成均匀权重向量pi为粒子的索引,ni∈{1,2,3,4,5};
将无人机的航迹规划问题表示为一个完整有向带权图G=(C,E)中的优化问题;顶点集C={0,…,|V|-1,|V|,……,n+|V|-1};n为该区域总用户数;V为该区域无人机集合;|V|为该区域无人机总数;r为无人机cr的索引,r=0,…,|V|-1;边集E={<ci,cj>|ci,cj∈C,i≠j},每条边<ci,cj>表示用户ci与用户cj之间的链接;i代表每条边的起点,i=r,|V|,…,n+|V|-2;j代表每条边的终点,j=|V|,…,n+|V|-1;
约束条件为:
(1)边与顶点的约束:恰好有一条路径进入和离开与用户相关联的每个顶点;
(2)用户集与无人机群的约束:每名用户只能使用一架无人机且所有航迹从无人机的位置开始;
(3)无人机总容量约束:每架无人机的负载不得超过其承载能力;
其中,qj表示用户j的需求;Qr为无人机的最大承载量;
(4)无人机工作最长时间约束:
其中,dij表示用户ci到用户cj之间的欧几里得距离,vr为无人机cr的速度;为无人机cr等待用户cj的时间, 为用户cj最早可以被无人机cr服务的时间;表示无人机cr到用户cj的时间;表示无人机cr服务用户cj的时间;Tr为无人机cr最晚完成任务时间;
(5)每个客人完成时间的约束:
其中,completej表示最晚结束服务用户cj的时间;
(6)每个客人的时间窗约束:
目标函数为:
步骤4:设置第二阶段基于分解的多目标粒子群算法的邻居个数T、学习率C1和C2、线性速度更新权重上限w0和下限w1、停止迭代次数sg、额外粒子群更新条件rg、最大迭代次数max_gen、外部储存集EP的最大容量EP_num;为初始粒子群pop中的每个粒子设置一个flag值,初始时flag=0;初始化外部储存集EP更新次数EP_tracker=0;
步骤5:根据初始粒子群pop中各粒子的各目标函数值,更新每个目标函数的上限maxni和下限minni;
步骤7:复制初始粒子群pop作为局部最优粒子群pbest,构建外部储存集EP;
所述的外部储存集EP的构建方法为:
如果局部最优粒子群pbest中存在索引为pi的粒子占优外部储存集EP中所有的粒子,则复制该粒子并加入到外部储存集EP中,且该粒子在外部储存集EP中的索引仍为pi;若外部储存集EP中已存在索引为pi的粒子,则用局部最优粒子群pbest中索引为pi的粒子替换外部储存集EP中索引为pi的粒子;
如果局部最优粒子群pbest中索引为pi的粒子加入外部储存集EP后,外部储存集EP中的粒子数大于外部储存集EP的最大容量EP_num,则将局部最优粒子群pbest中索引为pi的粒子的切比雪夫值与外部储存集EP中各粒子的切比雪夫值做差,移除外部储存集EP中对应差值最大的粒子;
步骤8:若局部最优粒子群pbest中存在rg次没有进行更新的粒子,则根据该粒子在局部最优粒子群pbest中的索引,更新初始粒子群pop中与该粒子索引相同的粒子的速度和位置,并执行步骤9;否则,直接执行步骤11;
初始粒子群pop中索引为pi的粒子的PSO速度更新公式为:
其中,w是随迭代次数线性变化的惯性权重系数,w=w0-(w0-w1)*k/max_gen;σ1为在[0,1]上的邻域随机数;σ2为在[0,1]上的外部储存集随机数;为在局部最优粒子群pbest中索引为pi的粒子的邻居粒子的位置;为在外部储存集EP中索引为pi的粒子的位置;δ为维度,δ∈[0,n+|V|-1];为索引为pi的粒子在更新k次时在各维空间上的速度;
初始粒子群pop中索引为pi的粒子的位置更新公式为:
步骤9:根据更新后的初始粒子群pop,更新每个目标函数的上限maxni和下限minni,更新初始粒子群pop的参考向量zk;
步骤10:将局部最优粒子群pbest中索引为pi的粒子与初始粒子群pop中相同索引的粒子的全部邻居粒子Brandbi进行切比雪夫值比较;当局部最优粒子群pbest中索引为pi的粒子与初始粒子群pop中相同索引的粒子的邻居粒子的切比雪夫差值大于0.001时,将邻居粒子的信息更新给局部最优粒子群pbest中索引为pi的粒子;重复执行步骤10,直至遍历局部最优粒子群pbest中所有粒子;
步骤12:更新进行局部搜索策略后初始粒子群pop中每个粒子的速度和位置:
初始粒子群pop中索引为pi的粒子的CLPSO速度更新公式为:
其中,为在局部最优粒子群pbest中索引为pi的粒子的随机rn个邻居粒子的位置;rn为随机邻域解的个数;ri表示第几个随机邻域解,ri∈[0,rn-1];randri为随机的邻域解在局部最优粒子群pbest中的索引;
初始粒子群pop中索引为pi的粒子的位置更新公式为:
步骤13:根据更新后的初始粒子群pop,更新每个目标函数的上限maxni和下限minni,更新初始粒子群pop的参考向量zk;
步骤14:更新局部最优粒子群pbest和外部储存集EP;如果局部最优粒子群pbest中所有粒子都没有进行更新,则令EP_tracker=EP_tracker+1;
所述的局部最优粒子群pbest和外部储存集EP的更新方法为:
步骤14.1:从初始粒子群pop中索引为pi的粒子的邻域中随机选择rn个不重复的邻居粒子将局部最优粒子群pbest中索引为pi的粒子与邻居粒子进行切比雪夫值比较;若局部最优粒子群pbest中索引为pi的粒子与邻居粒子的切比雪夫差值大于0.001时,将邻居粒子的信息更新给局部最优粒子群pbest中索引为pi的粒子;
步骤14.2:重复执行步骤14.1,直至遍历局部最优粒子群pbest中所有粒子;
步骤14.3:更新外部储存集EP;
如果局部最优粒子群pbest中存在索引为pi的粒子占优外部储存集EP中所有的粒子时,则将该粒子加入外部储存集EP中;若外部储存集EP中已存在索引为pi的粒子,则用局部最优粒子群pbest中索引为pi的粒子替换外部储存集EP中索引为pi的粒子;
如果局部最优粒子群pbest中索引为pi的粒子加入外部储存集EP后,外部储存集EP中的粒子数大于外部储存集EP的最大容量EP_num,则将局部最优粒子群pbest中索引为pi的粒子的切比雪夫值与外部储存集EP中各粒子的切比雪夫值做差,移除外部储存集EP中对应差值最大的粒子;
步骤15:令k=k+1,若EP_tracker==sg或者k==max_gen,则停止迭代并输出外部储存集EP作为最终的可选方案集;否则,返回步骤8。
本发明的有益效果在于:
本发明可以与编队策略、避障策略、目标检测、三维路径规划等技术方向进行有机结合,以提高航迹规划方案的可行性,增加无人机航迹规划规划的功能性,增加无人机管理与决策的效率,同时满足不同应用的总体目标函数与约束条件。
附图说明
图1是本发明中在5G场景下的全局无人机航线规划系统的工作流程图。
图2是本发明中航迹规划结果的示意图。
图3是本发明中粒子解代表的输出的指令示意图。
图4是本发明中粒子位置或速度的表示图。
图5是本发明中当前数据处理服务器的算法整体流程图。
图6是本发明中第一阶段算法流程图。
图7是本发明中第二阶段算法流程图。
具体实施方式
下面结合附图对本发明做进一步描述。
随着世界经济的飞速发展,人们对生活中无人机航迹规划的有效性及多样性要求越来越高,尤其在COVID-19的影响下,无人机航迹规划中的方案单一的问题更加突出,一旦得出的方案不能进行,则需要重新进行定制方案,导致大量浪费时间。同时在5G通讯技术快速发展的情况下,5G通讯技术与GPS定位将对无人机航迹规划提供了更高的可靠性与可行性。本发明将使用5G通讯技术与GPS定位获取无人机和用户位置等信息,同时传回到数据处理服务器,使用两阶段基于分解的多目标粒子群优化算法进行可行航迹规划,输出一组可行方案,再由数据服务器端向当前区域的无人机发出指令,使无人机按顺序执行出行计划。本发明从实际发展需要出发,提出一种基于多目标粒子群优化的无人机航迹规划方法,以达到在各个领域的无人机应用上都能达到航程最短、消耗时间最短、调用无人机数量最少等效果,从而节省人力物力与时间。
步骤1:各区域数据处理服务器将保存从5G模块和GPS模块获得的无人机的信息数据、用户的信息数据。
步骤2:根据MOEA/D框架设置各目标函数上的采集样本数H=3和目标函数个数N=5来生成均匀权重向量λ,邻域大小为T=5。并设置均匀权重向量λ=(λ1,λ2,…,λN),其具有限制条件均匀权重的生成方式将根据式 来生成,共将生成个不同的均匀权重向量,同时设置种群数量pop_size为pi∈[0,pop_size-1]。邻域粒子的生成方式使用两个均匀向量的欧氏距离来选择,计算出每个权重向量最近的T个权重向量,并将索引pi作为邻域粒子的索引。
步骤3:该问题可归约为VRPTW问题,可以形式化表示为一个完整有向带权图G=(C,E)中的优化问题,其中顶点集C={0,…,|V|-1,|V|,……,n+|V|-1},n为该区域总用户数,V为该区域无人机集合,|V|为该区域无人机总数,边集E={<ci,cj>|ci,cj∈C,i≠j},每条边分别表示两个顶点之间的链接,并且有一个距离属性,由邻接矩阵的邻接元素表示,邻接矩阵为26*26的矩阵,每条边<ci,cj>由从变量ci到变量cj之间的欧几里得距离dij表示,其中dij=dji。对于每个用户结点cj∈C的获取的变量包括:需求qj、服务时间sj、用户cj最早可以被服务的时间ej、用户cj最晚需要被服务的时间lj、最晚结束服务用户cj的时间completej,所有变量都是非负数,j∈[|V|,n+|V|-1]。
对于该区域的每架无人机节点cr的变量细节与用户细节不同,其中,对于 则无人机r被调用,否则无人机r未被调用,qr=Qr,sr=0,变量细节包括无人机cr最早被派遣的时间er、无人机cr最晚完成任务时间lr,lr=Tr,r为该区域无人机的编号{r∈[0,|V|-1]|r为自然数}。
六个约束条件为:
(1)边与顶点的约束:恰好有一条路径进入和离开与用户相关联的每个顶点:
(2)用户集与无人机群的约束:每名用户只能使用一架无人机且所有航迹从无人机的位置开始:
(3)无人机总容量约束:表示每架无人机的负载不得超过其承载能力:
(4)无人机工作最长时间约束:
(5)每个客人完成时间的约束:
(6)每个客人的时间窗约束:
第pi个粒子在更新k次时的位置可以由表示,形式可由图4中粒子位置的邻接矩阵的值来获得,其中i对应一维索引,j对应二维索引,r对应<cr,cj>=1时的r值,即i代表每条边的起点,j代表每条边的终点,r代表调用的无人机编号,的值可根据该邻接矩阵获得,则也可根据索引i、j、r得到xi、xj、yi、yj、qj、completej、Qr、Tr、vr,每个n+|V|维的当前状态-到达状态对组件将用表示,其中δ∈[0,n+|V|-1],n+|V|为邻接矩阵的维数,即使用无人机和用户的总数n+|V|作为索引。因此,粒子的位置可以扩展的表示成每个维表示一个状态集,每个状态集有两个当前状态-到达状态对,每个当前状态-到达状态对由从无人机基地和用户集中选取两个点组成,其中δ为当前维度,δ有两个相邻的前后节点ci,cj,其中i≠j。该δ维上的边集由表示,其中当δ∈[0,|V|-1]时,代表δ为无人机出发点,则当时,代表δ为无人机任务的最后一个用户。粒子pi在更新k次时在m维空间上的速度定义为:δ维的状态对概率集由表示,在多目标优化问题中对应着在整个搜索空间中的决策向量为1的概率。
五个目标函数为:
(1)无人机等用户总时间为每架无人机r等待其服务所有用户的最长总时间:
(2)用户等无人机总时间为每架无人机i其服务所有用户等待该无人机的最长总时间:
(3)调用无人机总数:
(4)路线总时间:
(5)路线总距离:
在第一阶段可行航迹生成过程中,将计算出每个粒子的五个目标函数值、位置和速度,以作为第二阶段基于分解的多目标粒子群算法的初始化粒子;在第二阶段时五个目标函数值将在算法运行过程中向最小化方向迭代,以生成更优可行航迹。
步骤4:根据应用的约束条件、目标函数,在第一阶段如图6混合使用贪心算法和随机算法为pop_size个粒子生成可行航迹,作为初始粒子群pop,同时保存各粒子的位置和速度。其中一个粒子使用贪心算法生成,每次随机选择一架无人机后,选择用户时优先选择最近的可满足约束用户,直到没有可选用户则随机选择最近可满足约束用户,直至所有用户被服务;在[0,1]内随机取rand值,如果rand<0.3则使用随机贪心混合算法生成,随机选择一架无人机后,随机选择一个可满足约束用户,再优先选择最近的可满足约束用户,直到没有可选用户则随机选择一个可满足约束用户,再优先选择最近的可满足约束用户,直至所有用户被服务;剩余粒子使用随机算法生成,每次随机选择一架无人机后,随机选择可满足约束用户,直到没有可选用户则随机选择一个可满足约束用户,直至所有用户被服务。
步骤5:设置第二阶段基于分解的多目标粒子群算法的邻居个数T、学习率c、线性速度更新权重上下限w0和w1,停止迭代次数sg,额外粒子群更新条件rg,最大迭代次数max_gen,由于设置的停止策略比较特殊,因此max_gen需要设置为比实际收敛所需代数大的数,整体迭代次数k=0,外部储存集EP更新次数EP_tracker=0,使用步骤4产生的粒子群作为初始化粒子群pop,同时为pop中的每个粒子设置一个flag值,初始flag=0。
使用种群pop中粒子的各目标函数值来更新每个目标函数的上下限和ni为目标函数的索引。相应地,用将每个粒子的目标函数值规范化为标量适应度函数,记为其中ni=[1,N],并将每个标量目标函数上的最小值作为参考分量则参考向量为
使用粒子群pop复制一个粒子群作为局部最优粒子群pbest,并将种群pbest中的每个粒子以基于Pareto占优的方式来加入外部储存集EP。基于Pareto占优即对于多目标优化问题的任意两个解x1,x2∈S,且x1≠x2,如果使得fi(x1)不劣于fi(x2),且使得fj(x1)优于fj(x2),那么,称x1占优x2,记为即当pbest中的粒子pi占优外部储存集中所有的粒子时,则将粒子pi加入外部储存集中。如果粒子pi加入外部储存集后,外部储存集中的粒子数将大于设定的最大外部储存集大小EP_num,则将粒子pi的切比雪夫值与外部储存集中粒子的切比雪夫值做差,用粒子pi替换掉外部储存集中切比雪夫差值最大的粒子。否则不对外部储存集进行改变。
步骤6:使用flag值判断是否有pbest中的粒子rg次没有进行更新,如果max0≤pi≤pop_size(flag(pi))≥rg,则启用额外粒子群更新策略,并对所有flag(pi)≥rg的粒子pi进行额外粒子群更新策略并将该点的flag值置0,否则转到步骤9。
使用PSO速度更新公式
执行基于元素的算法运算结合pop中的粒子pi自身速度和pbest中粒子pi全部邻域粒子的位置和全部外部储存集解来更新粒子pi的速度,具体计算更新方式见具体实施方式的算子1-算子4,其中每个粒子的位置和速度在矩阵中由邻接矩阵进行表示,如图4。w是随迭代次数线性变化的惯性权重系数,w=w0-(w0-w1)*k/max_gen,其中,w0设为0.9,w1设为0.4,k为当前迭代次数,max_gen为最大迭代次数。T为邻域中邻居个数,EP_num为外部存储集中解的个数,ei为外部储存集解索引,c2为向邻域学习的学习率,σ2为在[0,1]上的外部储存集随机数。为在pbest中粒子pi的邻居粒子位置,为第k次迭代时外部储存集的粒子位置,最后将计算出的值赋值给pop中的
步骤8:使用步骤7中进行更新的pop中的每个粒子pi对五个目标的上下界和参考向量zk进行更新。将pbest中的每个粒子pi与pop中的pi粒子的邻域中的全部邻居粒子,以MOEA/D的方式更新。即依次将pbest中的粒子pi与pop中的pi粒子的邻域中的全部邻居粒子Brandbi进行切比雪夫值比较,使用切比雪夫聚合函数公式 求得切比雪夫值,当pbest中的pi粒子与pop邻域中的邻居粒子Brandbi的切比雪夫差值大于0.001时,则将pop中的邻居粒子的信息更新给pbest中的pi粒子。
步骤9:对pop中的每一个粒子pi,进行局部搜索策略,不断选择用户最少的路线,试图将其中的用户插入其他路线中,依旧可满足约束条件,同时将删除的边的位置和速度置0,连接的边的位置和速度置1,也即更改对应索引上的值,并在插入结束时得到pop中的每个粒子的五个目标函数值。
步骤10:对步骤9中pop的每个粒子pi进行速度更新,使用CLPSO速度更新公式执行基于元素的算法运算结合pop中的粒子pi自身速度和pbest中粒子pi随机的两个邻域粒子的位置来更新粒子pi的速度,rn为随机邻域解的个数,ri表示第几个随机邻域解,ri∈[0,T-1],randri为随机的邻域解索引,randri∈[0,pop_size-1],c1为向邻域学习的学习率,σ1为在[0,1]上的邻域随机数。为在pbest中粒子pi的随机两个邻居粒子此时rn=2,最后将计算出的值赋值给pop中的
步骤12:使用步骤11中pop的每个粒子对五个目标的上下界和参考向量zk进行更新。将pbest中的每个粒子pi与pop中的pi粒子的邻域中随机选择两个邻居粒子,以MOEA/D的方式更新。即依次将pbest中的粒子pi与pop中的pi粒子的邻域中随机选择两个不重复的邻居粒子进行切比雪夫值比较,使用切比雪夫聚合函数公式 求得切比雪夫值,当pbest中的pi粒子与pop邻域随机邻居粒子的切比雪夫差值大于0.001时,则将pop中的邻居粒子的信息更新给pbest中的pi粒子。再基于Pareto占优方式来更新外部储存集EP即当pbest中的粒子pi占优外部储存集中所有的粒子时,则将粒子pi加入外部储存集中。如果粒子pi加入外部储存集后,外部储存集中的粒子数将大于设定的最大外部储存集大小EP_num,则将粒子pi的切比雪夫值与外部储存集中粒子的切比雪夫值做差,用粒子pi替换掉外部储存集中切比雪夫差值最大的粒子。否则不对外部储存集进行改变。最后,如果pbest中的所有粒子都没有进行更新,则将EP_tracker计数加1。。
步骤13:令k=k+1,若EP_tracker==sg或者k==max_gen,则停止迭代并输出外部储存集EP作为最终的可选方案集;否则,返回步骤6。
步骤14:将输出的外部储存集作为最终的可选方案集,由工作人员选定方案,或者默认选择第一套调用无人机数量最少的解决方案,再将指令信息通过5G模块传回到无人机,为无人机提供一条可行航迹。
实施例1:
本发明可以与编队策略、避障策略、目标检测、三维路径规划等技术方向进行有机结合,以提高航迹规划方案的可行性,增加无人机航迹规划规划的功能性,增加无人机管理与决策的效率,同时满足不同应用的总体目标函数与约束条件
如图1所示,本发明提供一种在5G场景下的全局无人机航迹规划系统,包括如下模块:
无人机数据获取模块。将使用5G通信技术及GPS定位来获取无人机的位置信息、最大可负载、最长可工作时间、无人机速度。
用户数据获取模块。将使用5G通信技术及GPS定位来获取用户的位置信息、等待服务时间窗、服务所需时间、任务需求负重等信息。
当前区域数据处理服务器航迹规划模块。首先根据MOEA/D框架设置各目标函数上的采集样本数H=3和目标函数个数N=5来生成均匀权重向量λ,邻域大小为T=5,停止迭代次数sg=100,额外粒子群更新条件rg=3,最大迭代次数max_gen=1000。当用户发布任务数量达到设定值n时,将根据不同应用,处理用户信息与无人机信息,通过航迹规划模块制定可行出行路线。所述的航迹规划基于两阶段基于分解的多目标粒子群优化算法,将当前区域包含的用户完全分配给各个无人机,对各个无人机的出行方案进行规划,生成保证无人机能完成全部任务的多种可行方案。所述的基于两阶段基于分解的多目标粒子群优化算法的航迹规划具体粒子速度和位置更新如下(假设有两架无人机,五个用户,无人机和用户的分布如图2所示,此时n设置为5,即五个用户[2,3,4,5,6]发布了任务,两架无人机[0,1]调用了两架无人机服务了五名用户),则首先需要将两架无人机与五个用户定义为一个邻接矩阵,同时设定无人机之间路段概率为0,即粒子的位置和速度的邻接矩阵相应位置固定设为0,再更新粒子的位置和速度。S-PSO是基于集合和概率定义的,因此将其用于VRPTW问题中需要对速度更新公式中的运算符进行重新定义。
算子3:c1×σ1×(位置-位置)算子由c×σ×Mδ={<ci,cj>/p′(ci,cj)|<ci,cj>∈Mδ}定义。该公式将使用给定的crisp集合Mδ转化为具有概率的当前状态-到达状态对<ci,cj>集合,利用c×σ用来得到更新后的速度值。
为了更加清晰的进行表示,论文将用定义算子的应用实例的中间速度更新公式进行说明。假设:
rand0和rand1为随机两个邻居的索引
w=0.7,c1=2,σ1=3可以得到:
额外粒子群更新的速度更新公式与CLPSO不同,会向邻域粒子和外部储存集中的粒子同时学习,更新粒子速度的可能性更大。
当粒子位置的当前状态-到达状态对成立时,将设置为1,代表可以作为出行路段。位置更新的规则根据进行完成,这里的‘+’号将根据S-PSO的特点重新进行构造。粒子pi在步骤k+1的位置将由步骤k的位置、步骤k+1速度和当前节点到剩余未选用户路段的crisp集合将在满足约束条件的情况下,经过构造得到。其中,速度先将通过进行更新,从而转化为一个crisp集合。其中rand为[0,1]的随机数,当且仅当前状态-到达状态对<ci,cj>对应的概率值p(ci,cj)≥rand时,当前状态-到达状态对<ci,cj>/(ci,cj)将保存在速度集中,也就是说当p(ci,cj)较大时,在经过转换后保存在crisp集合中的概率更大。在实际计算中,当同一当前状态-到达状态对<ci,cj>被多次选中后,即会增加进入crisp集合的概率。的构造性方式如下,其中可到达状态即为在当前状态满足约束的条件下可到达的节点:
步骤2:为了构造无人机出行路径,该方法将随机在无人机集合V中选择一架无人机cr,并将当前状态设置为ci,再寻找可满足约束的用户作为可到达状态cj。
步骤3:将步骤2中的cj设置为当前状态ci,再寻找可满足约束的用户作为可到达状态cj,直到所有用户都不满足约束则停止迭代。如果可选用户不为空,则随机在剩余可选V中选择下一架无人机vr继续构造无人机出行路径。
其中,可到达状态的选择方式将根据以下三个crisp集合依次选择:
即,首先从SU中选择可到达状态,如果有,则从SU中选择到达状态cj。否则从SX中选择可到达状态,如果有,则从SX中选择到达状态cj。否则,将从SA中选择到达状态cj。选择到达状态cj后,将当前状态-到达状态对<ci,cj>添加到中,可得直到SU、SX、SA中都没有可到达状态,则结束当前无人机的任务,在此过程中由迭代过程中的节点索引i、j连接得到无人机cr的出行索引序列[r,……]。
每一步经过迭代可得航迹形如图2所示,粒子的位置和速度的形式如图4所示,粒子代表的最终迭代停止时输出外部储存集中的粒子,粒子代表的可行方案结果R为多种可行方案序列[[[0,5,4,3],[1,2,6]],[[0,4,5,3],[1,6,2]],[[0,4,5,2,3,6]],[[0,5,2,6],[1,3,4]]]。
当前区域数据处理服务器指令发出模块。使用默认目标函数值最小的可行方案或者人工选择可行方案Rj如图3为[[0,4,5,3],[1,6,2]],对无人机发出指令。即对编号为0和1的两架无人机发出指令,一架的出行路线为[0,4,5,3],另一架为[1,6,2]。
无人机指令接受模块。无人机将实时通过5G通信技术接受指令,工作人员将所需货物正确的放入无人机中,按出行方案顺序服务用户。
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (1)
1.一种基于多目标粒子群优化的无人机航迹规划方法,其特征在于,包括以下步骤:
步骤1:获取无人机的信息数据和用户的信息数据;
步骤2:设置种群数量pop_size,初始化迭代次数k=0;
步骤3:根据应用约束条件和目标函数,混合使用贪心算法和随机算法为pop_size个粒子生成可行航迹,作为初始粒子群pop,同时保存各粒子的位置和速度;对种群中每一个粒子生成均匀权重向量pi为粒子的索引,
将无人机的航迹规划问题表示为一个完整有向带权图G=(C,E)中的优化问题;顶点集C={0,…,|V|-1,|V|,……,n+|V|-1};n为该区域总用户数;V为该区域无人机集合;|V|为该区域无人机总数;r为无人机cr的索引,r=0,...,|V|-1;边集E={<ci,cj>|ci,cj∈C,i≠j},每条边<ci,cj>表示用户ci与用户cj之间的链接;i代表每条边的起点,i=r,|V|,...,n+|V|-2;j代表每条边的终点,j=|V|,...,n+|V|-1;
约束条件为:
(1)边与顶点的约束:恰好有一条路径进入和离开与用户相关联的每个顶点;
(2)用户集与无人机群的约束:每名用户只能使用一架无人机且所有航迹从无人机的位置开始;
(3)无人机总容量约束:每架无人机的负载不得超过其承载能力;
其中,qj表示用户j的需求;Qr为无人机的最大承载量;
(4)无人机工作最长时间约束:
其中,dij表示用户ci到用户cj之间的欧几里得距离,vr为无人机cr的速度;为无人机cr等待用户cj的时间, 为用户cj最早可以被无人机cr服务的时间;表示无人机cr到用户cj的时间;表示无人机cr服务用户cj的时间;Tr为无人机cr最晚完成任务时间;
(5)每个客人完成时间的约束:
其中,completej表示最晚结束服务用户cj的时间;
(6)每个客人的时间窗约束:
目标函数为:
步骤4:设置第二阶段基于分解的多目标粒子群算法的邻居个数T、学习率C1和C2、线性速度更新权重上限w0和下限w1、停止迭代次数sg、额外粒子群更新条件rg、最大迭代次数max_gen、外部储存集EP的最大容量EP_num;为初始粒子群pop中的每个粒子设置一个flag值,初始时flag=0;初始化外部储存集EP更新次数EP_tracker=0;
步骤5:根据初始粒子群pop中各粒子的各目标函数值,更新每个目标函数的上限maxni和下限minni;
步骤7:复制初始粒子群pop作为局部最优粒子群pbest,构建外部储存集EP;
所述的外部储存集EP的构建方法为:
如果局部最优粒子群pbest中存在索引为pi的粒子占优外部储存集EP中所有的粒子,则复制该粒子并加入到外部储存集EP中,且该粒子在外部储存集EP中的索引仍为pi;若外部储存集EP中已存在索引为pi的粒子,则用局部最优粒子群pbest中索引为pi的粒子替换外部储存集EP中索引为pi的粒子;
如果局部最优粒子群pbest中索引为pi的粒子加入外部储存集EP后,外部储存集EP中的粒子数大于外部储存集EP的最大容量EP_num,则将局部最优粒子群pbest中索引为pi的粒子的切比雪夫值与外部储存集EP中各粒子的切比雪夫值做差,移除外部储存集EP中对应差值最大的粒子;
步骤8:若局部最优粒子群pbest中存在rg次没有进行更新的粒子,则根据该粒子在局部最优粒子群pbest中的索引,更新初始粒子群pop中与该粒子索引相同的粒子的速度和位置,并执行步骤9;否则,直接执行步骤11;
初始粒子群pop中索引为pi的粒子的PSO速度更新公式为:
其中,w是随迭代次数线性变化的惯性权重系数,w=w0-(w0-w1)*k/max_gen;σ1为在[0,1]上的邻域随机数;σ2为在[0,1]上的外部储存集随机数;为在局部最优粒子群pbest中索引为pi的粒子的邻居粒子的位置;勾在外部储存集EP中索引为pi的粒子的位置;δ为维度,δ∈[0,n+|V|-1];为索引为pi的粒子在更新k次时在各维空间上的速度;
初始粒子群pop中索引为pi的粒子的位置更新公式为:
步骤9:根据更新后的初始粒子群pop,更新每个目标函数的上限maxni和下限minni,更新初始粒子群pop的参考向量zk;
步骤10:将局部最优粒子群pbest中索引为pi的粒子与初始粒子群pop中相同索引的粒子的全部邻居粒子Brandbi进行切比雪夫值比较;当局部最优粒子群pbest中索引为pi的粒子与初始粒子群pop中相同索引的粒子的邻居粒子的切比雪夫差值大于0.001时,将邻居粒子的信息更新给局部最优粒子群pbest中索引为pi的粒子;重复执行步骤10,直至遍历局部最优粒子群pbest中所有粒子;
步骤12:更新进行局部搜索策略后初始粒子群pop中每个粒子的速度和位置:
初始粒子群pop中索引为pi的粒子的CLPSO速度更新公式为:
其中,为在局部最优粒子群pbest中索引为pi的粒子的随机rn个邻居粒子的位置;rn为随机邻域解的个数;ri表示第几个随机邻域解,ri∈[0,rn-1];randri为随机的邻域解在局部最优粒子群pbest中的索引;
初始粒子群pop中索引为pi的粒子的位置更新公式为:
步骤13:根据更新后的初始粒子群pop,更新每个目标函数的上限maxni和下限minni,更新初始粒子群pop的参考向量zk;
步骤14:更新局部最优粒子群pbest和外部储存集EP;如果局部最优粒子群pbest中所有粒子都没有进行更新,则令EP_tracker=EP_tracker+1;
所述的局部最优粒子群pbest和外部储存集EP的更新方法为:
步骤14.1:从初始粒子群pop中索引为pi的粒子的邻域中随机选择rn个不重复的邻居粒子将局部最优粒子群pbest中索引为pi的粒子与邻居粒子进行切比雪夫值比较;若局部最优粒子群pbest中索引为pi的粒子与邻居粒子的切比雪夫差值大于0.001时,将邻居粒子的信息更新给局部最优粒子群pbest中索引为pi的粒子;
步骤14.2:重复执行步骤14.1,直至遍历局部最优粒子群pbest中所有粒子;
步骤14.3:更新外部储存集EP;
如果局部最优粒子群pbest中存在索引为pi的粒子占优外部储存集EP中所有的粒子时,则将该粒子加入外部储存集EP中;若外部储存集EP中已存在索引为pi的粒子,则用局部最优粒子群pbest中索引为pi的粒子替换外部储存集EP中索引为pi的粒子;
如果局部最优粒子群pbest中索引为pi的粒子加入外部储存集EP后,外部储存集EP中的粒子数大于外部储存集EP的最大容量EP_num,则将局部最优粒子群pbest中索引为pi的粒子的切比雪夫值与外部储存集EP中各粒子的切比雪夫值做差,移除外部储存集EP中对应差值最大的粒子;
步骤15:令k=k+1,若EP_tracker==sg或者k==max_gen,则停止迭代并输出外部储存集EP作为最终的可选方案集;否则,返回步骤8。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011627216.2A CN112783207B (zh) | 2020-12-31 | 2020-12-31 | 一种基于多目标粒子群优化的无人机航迹规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011627216.2A CN112783207B (zh) | 2020-12-31 | 2020-12-31 | 一种基于多目标粒子群优化的无人机航迹规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112783207A true CN112783207A (zh) | 2021-05-11 |
CN112783207B CN112783207B (zh) | 2022-07-15 |
Family
ID=75754498
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011627216.2A Active CN112783207B (zh) | 2020-12-31 | 2020-12-31 | 一种基于多目标粒子群优化的无人机航迹规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112783207B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113110560A (zh) * | 2021-05-24 | 2021-07-13 | 四川大学 | 基于切比雪夫不等式的卫星编队重构模型预测控制算法 |
CN113358100A (zh) * | 2021-05-25 | 2021-09-07 | 电子科技大学 | 嵌入式与yolo4改进算法的无人机实时目标识别系统 |
CN113721660A (zh) * | 2021-09-03 | 2021-11-30 | 中国人民解放军国防科技大学 | 一种基于群体智能优化的无人机路径规划方法 |
CN113759958A (zh) * | 2021-07-07 | 2021-12-07 | 哈尔滨工程大学 | 基于定位精度的无人机编队航迹规划方法 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104020665A (zh) * | 2014-06-25 | 2014-09-03 | 北京邮电大学 | 基于多目标粒子群算法的机械臂最小跃度轨迹优化方法 |
US20150185033A1 (en) * | 2012-08-31 | 2015-07-02 | Bae Systems Plc | Route planning |
CN106127334A (zh) * | 2016-06-20 | 2016-11-16 | 浙江工业大学 | 一种基于网格排序的多目标粒子群优化方法 |
CN106647744A (zh) * | 2016-11-14 | 2017-05-10 | 深圳大学 | 一种机器人路径规划方法及装置 |
CN107506846A (zh) * | 2017-07-10 | 2017-12-22 | 北京石油化工学院 | 一种基于多目标粒子群优化算法的车辆调度方法与装置 |
CN107992051A (zh) * | 2017-12-26 | 2018-05-04 | 江南大学 | 基于改进的多目标粒子群算法的无人车路径规划方法 |
CN108326852A (zh) * | 2018-01-16 | 2018-07-27 | 西北工业大学 | 一种多目标优化的空间机械臂轨迹规划方法 |
US20190086938A1 (en) * | 2015-07-27 | 2019-03-21 | Genghiscomm Holdings, LLC | Airborne Relays in Cooperative-MIMO Systems |
CN109631900A (zh) * | 2018-12-24 | 2019-04-16 | 中国矿业大学 | 一种无人机三维航迹多目标粒子群全局规划方法 |
CN111256682A (zh) * | 2020-05-07 | 2020-06-09 | 北京航空航天大学 | 不确定条件下的无人机群路径规划方法 |
-
2020
- 2020-12-31 CN CN202011627216.2A patent/CN112783207B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20150185033A1 (en) * | 2012-08-31 | 2015-07-02 | Bae Systems Plc | Route planning |
CN104020665A (zh) * | 2014-06-25 | 2014-09-03 | 北京邮电大学 | 基于多目标粒子群算法的机械臂最小跃度轨迹优化方法 |
US20190086938A1 (en) * | 2015-07-27 | 2019-03-21 | Genghiscomm Holdings, LLC | Airborne Relays in Cooperative-MIMO Systems |
CN106127334A (zh) * | 2016-06-20 | 2016-11-16 | 浙江工业大学 | 一种基于网格排序的多目标粒子群优化方法 |
CN106647744A (zh) * | 2016-11-14 | 2017-05-10 | 深圳大学 | 一种机器人路径规划方法及装置 |
CN107506846A (zh) * | 2017-07-10 | 2017-12-22 | 北京石油化工学院 | 一种基于多目标粒子群优化算法的车辆调度方法与装置 |
CN107992051A (zh) * | 2017-12-26 | 2018-05-04 | 江南大学 | 基于改进的多目标粒子群算法的无人车路径规划方法 |
CN108326852A (zh) * | 2018-01-16 | 2018-07-27 | 西北工业大学 | 一种多目标优化的空间机械臂轨迹规划方法 |
CN109631900A (zh) * | 2018-12-24 | 2019-04-16 | 中国矿业大学 | 一种无人机三维航迹多目标粒子群全局规划方法 |
CN111256682A (zh) * | 2020-05-07 | 2020-06-09 | 北京航空航天大学 | 不确定条件下的无人机群路径规划方法 |
Non-Patent Citations (2)
Title |
---|
QISHENG CAI,等: "Multiple paths planning for UAVs using particle swarm optimization with sequential niche technique", 《IEEE》 * |
韩博文,等: "基于多目标MSQPSO 算法的UAVS 协同任务分配", 《电子学报》 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113110560A (zh) * | 2021-05-24 | 2021-07-13 | 四川大学 | 基于切比雪夫不等式的卫星编队重构模型预测控制算法 |
CN113110560B (zh) * | 2021-05-24 | 2021-12-07 | 四川大学 | 基于切比雪夫不等式的卫星编队重构模型预测控制方法 |
CN113358100A (zh) * | 2021-05-25 | 2021-09-07 | 电子科技大学 | 嵌入式与yolo4改进算法的无人机实时目标识别系统 |
CN113358100B (zh) * | 2021-05-25 | 2022-07-29 | 电子科技大学 | 嵌入式与yolo4改进算法的无人机实时目标识别系统 |
CN113759958A (zh) * | 2021-07-07 | 2021-12-07 | 哈尔滨工程大学 | 基于定位精度的无人机编队航迹规划方法 |
CN113759958B (zh) * | 2021-07-07 | 2023-08-01 | 哈尔滨工程大学 | 基于定位精度的无人机编队航迹规划方法 |
CN113721660A (zh) * | 2021-09-03 | 2021-11-30 | 中国人民解放军国防科技大学 | 一种基于群体智能优化的无人机路径规划方法 |
CN113721660B (zh) * | 2021-09-03 | 2023-07-04 | 中国人民解放军国防科技大学 | 一种基于群体智能优化的无人机路径规划方法 |
Also Published As
Publication number | Publication date |
---|---|
CN112783207B (zh) | 2022-07-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112783207B (zh) | 一种基于多目标粒子群优化的无人机航迹规划方法 | |
Cheikhrouhou et al. | A comprehensive survey on the Multiple Traveling Salesman Problem: Applications, approaches and taxonomy | |
Wu et al. | Cooperative path planning of UAVs & UGVs for a persistent surveillance task in urban environments | |
CN110428111B (zh) | Uav/ugv协同长时多任务作业轨迹规划方法 | |
Obermeyer | Path planning for a UAV performing reconnaissance of static ground targets in terrain | |
Xu et al. | A brief review of the intelligent algorithm for traveling salesman problem in UAV route planning | |
CN109919431B (zh) | 基于拍卖算法的异构多机器人任务分配方法 | |
Ghambari et al. | An enhanced NSGA-II for multiobjective UAV path planning in urban environments | |
Huang et al. | A novel hybrid discrete grey wolf optimizer algorithm for multi-UAV path planning | |
CN113485409A (zh) | 一种面向地理公平性的无人机路径规划分配方法及系统 | |
Rahili et al. | Optimal routing for autonomous taxis using distributed reinforcement learning | |
CN116451934B (zh) | 多无人机边缘计算路径优化与依赖任务调度优化方法及系统 | |
CN112683276A (zh) | 基于混合离散灰狼算法的无人机巡检电缆路径规划方法 | |
Hong et al. | UAV search-and-rescue planning using an adaptive memetic algorithm | |
CN116720642A (zh) | 车辆与无人机协同配送的路径优化方法和系统 | |
Reddy et al. | Minimizing the total completion time on a multi-machine FMS using flower pollination algorithm | |
CN109784585B (zh) | 一种无人机无人艇的混合布放调度方法 | |
Xiang et al. | An effective memetic algorithm for UAV routing and orientation under uncertain navigation environments | |
CN109062677B (zh) | 一种无人机系统计算迁移方法 | |
Julius Fusic et al. | Improved RRT* algorithm-based path planning for unmanned aerial vehicle in a 3D metropolitan environment | |
CN114142908A (zh) | 一种面向覆盖侦察任务的多无人机通信资源分配方法 | |
CN117367433A (zh) | 低空无人机路径规划方法、装置、无人机及可读存储介质 | |
CN112217558A (zh) | 一种基于资源互换的空间信息网络任务规划方法 | |
CN110662272A (zh) | 一种基于蜂群无人机的最少数量领航者选取方法 | |
CN112700025A (zh) | 覆盖区域的分配方法及装置、存储介质、电子设备 |
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 |