CN115357050A - 一种基于分层粒子群算法的无人机路径规划方法及其应用 - Google Patents
一种基于分层粒子群算法的无人机路径规划方法及其应用 Download PDFInfo
- Publication number
- CN115357050A CN115357050A CN202211138201.9A CN202211138201A CN115357050A CN 115357050 A CN115357050 A CN 115357050A CN 202211138201 A CN202211138201 A CN 202211138201A CN 115357050 A CN115357050 A CN 115357050A
- Authority
- CN
- China
- Prior art keywords
- point
- path
- generation
- generation population
- formula
- 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.)
- Pending
Links
- 239000002245 particle Substances 0.000 title claims abstract description 168
- 238000000034 method Methods 0.000 title claims abstract description 28
- 238000005457 optimization Methods 0.000 title claims description 11
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 28
- 230000006870 function Effects 0.000 claims description 27
- 230000009194 climbing Effects 0.000 claims description 10
- 239000000126 substance Substances 0.000 claims description 9
- 238000009499 grossing Methods 0.000 claims description 8
- 238000004590 computer program Methods 0.000 claims description 6
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 claims description 3
- 230000001174 ascending effect Effects 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 claims description 3
- 238000010276 construction Methods 0.000 claims description 3
- 239000000203 mixture Substances 0.000 claims description 3
- 238000012163 sequencing technique Methods 0.000 claims description 3
- 150000001875 compounds Chemical class 0.000 claims description 2
- 101100208381 Caenorhabditis elegans tth-1 gene Proteins 0.000 claims 1
- 230000015572 biosynthetic process Effects 0.000 claims 1
- 230000004888 barrier function Effects 0.000 abstract description 6
- 230000007423 decrease Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 230000007547 defect Effects 0.000 description 2
- 241000282461 Canis lupus Species 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 239000000446 fuel Substances 0.000 description 1
- 230000002068 genetic effect Effects 0.000 description 1
- 238000011423 initialization method Methods 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 239000000575 pesticide Substances 0.000 description 1
- 239000011541 reaction mixture Substances 0.000 description 1
- 238000012959 renal replacement therapy Methods 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
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
本发明公开了一种基于分层粒子群算法的无人机路径规划方法及其应用,该方法包括:1)构建无人机的路径规划模型;2)利用障碍物中点信息去初始化种群,使种群中的个体在初始化时找到多条可行的路径;3)改进粒子群算法的实现,按照适应度值对种群个体分成三层,每层按照不同的更新公式去更新。本发明能够适用于复杂场景,同时能找到近似最优的路径规划方案。
Description
技术领域
本发明涉及到无人机路径规划领域,具体的说是一种基于障碍物中点信息初始化的分层粒子群算法解决无人机路径规划问题。
背景技术
在过去的几十年里,无人机从过去的军事领域拓展到了农业、快递业、电力系、通信、图像识别等领域,比如利用无人机喷洒农药,配送包裹,电力巡检等。而无人机路径规划成为无人机任务中的关键技术之一,同时作为一种现实的优化问题,得到了国内外学者的广泛研究。无人机路径规划可以看作是一个复杂的优化问题,主要目标是得到最小的综合成本,同时满足无人机性能要求。无人机需要在不碰撞到障碍物的前提下,从给定的起始位置到目标位置,设计出一条平滑的、满足任务需要的近似最优的路径。因为无人机要躲避山脉、树木、建筑物等障碍物,使得无人机很难高效完成任务,因此,无人机路径规划问题需要高效的算法来解决。已有的解决路径规划问题的方法有Voronoi图,概率路线图(PRM),A*算法,人工势场法(APF),快速探索随机树(RRT)。但这些方法大多数存在容易陷入局部最优、时间复杂度高等问题。
近年来,元启发式算法以其更灵活、更有效的特点受到了研究者的广泛研究。为了解决无人机的路径规划问题,人们提出了一系列改进的元启发式算法,如遗传算法(GA)、差分进化算法(DE)、粒子群算法(PSO)、蚁群算法(ACO)、人工蜂群算法(ABC)、灰狼优化算法(GWO)等。这些方法虽然已经取得了一些路径规划的结果,但是在障碍物较多的复杂场景下找到更高质量的近似最优解仍然需要进一步改进。
发明内容
本发明为克服现有技术的不足之处,提供一种新基于分层粒子群算法的无人机路径规划方法及其应用,以期能解决较复杂环境下的无人机路径规划问题,从而能够提供最优的路径飞行方案。
本发明为达到上述发明目的,采用如下技术方案:
本发明一种基于分层粒子群算法的无人机路径规划方法,其特征在于,是按如下步骤进行:
步骤1、获取一目标区域,并以所述目标区域的外接矩形的一个顶点为原点,以与原点相连的两条边分别作为x轴和y轴,以垂直于oxy水平面的方向为z轴,从而建立三维坐标系;令Pj表示无人机的第j个路径点,Pj的坐标为(xj,yj,zj),令起点S的坐标为(x1,y1,z1),令终点E的坐标为(xN,yN,zN);
步骤2、构建目标函数:
步骤2.1、最小化路径长度:
利用式(1)构建使无人机从起点S到终点E的飞行距离最小的路径长度f1,并作为第1个目标函数:
式(1)中,lj表示从第j个路径点Pj到第j+1个路径点Pj+1的欧几里得距离,N是路径点的个数,N-1是路径段的个数;
步骤2.2、最小化威胁代价函数:
利用式(2)和式(3)构建无人机飞行的威胁代价f2,并作为第2个目标函数:
式(2)和式(3)中,K为障碍物的数目,Rk为第k个障碍物的半径,S为碰撞区的危险距离,D为无人机的直径,表示从第j个路径点Pij到第j+1个路径点Pj+1构成的向量,djk表示路径段到第k个障碍物的圆心之间的距离;Tk(·)表示第k个障碍物的威胁代价;
步骤2.3、最小化高度代价:
利用式(4)和式(5)构建无人机在飞行过程中的高度代价f3,并作为第3个目标函数:
式(4)和式(5)中,hj表示无人机在第j个路径点Pj相对于地面的飞行高度,hmin和hmax分别为无人机飞行的最小高度和最大高度,Hj表示无人机在第j个路径点Pj的高度代价;
步骤2.4、最小化平滑代价:
式(6)中,P'j表示在第j个路径点Pj在oxy水平面的投影点,P'j+1表示在第j+1个路径点Pj+1在oxy水平面的投影点,表示在第j个路径点Pj指向第j+1个路径点Pj+1构成的向量在oxy水平面的投影,表示在第j+1个路径点Pj+1指向第j+2个路径点Pj+2构成的向量在oxy水平面的投影;
式(7)中,zj表示在第j个路径点Pj的z轴坐标,zj+1表示在第j+1个路径点Pj+1的z轴坐标;
利用式(8)构建无人机的平滑成本f4,并作为第4个目标函数:
式(8)中,a1和a2分别为转角Φj和爬升角ψj的惩罚系数;表示从第j-1个路径点Pij到第j个路径点Pj+1构成的向量,表示在第j-1个路径点Pj指向第j个路径点Pj+1构成的向量在oxy水平面的投影,ψj-1表示无人机在路径段与其在oxy水平面上的投影之间的爬升角;
利用式(9)构建无人机路径规划模型:
式(9)中,J是无人机路径的目标函数,bs是第s个目标函数fs的权重系数;
步骤3、基于改进的分层粒子群算法求解无人机路径规划模型:
步骤3.1、根据障碍物信息初始化种群:
步骤3.1.1、定义障碍物的数目为K,定义k1、k2、k3为障碍物的编号,并初始化k1=1、k2=k1+1、k3=1;
步骤3.1.3、判断k3=k1或k3=k2是否成立,若成立,则执行步骤3.1.5;否则,执行步骤3.1.4;
步骤3.1.5、将k3+1赋值给k3,判断k3≤K是否成立,若成立,则执行步骤3.1.3;否则,执行步骤3.1.6;
步骤3.1.7、将k2+1赋值给k2后,初始化k3=1,并判断k2≤K是否成立,若成立,则执行步骤3.1.3;否则,执行步骤3.1.8;
步骤3.1.8、将k1+1赋值给k1后,将k1+1赋值给k2,判断k1≤K是否成立,若成立,则执行步骤3.1.3;否则,表示得到所有相邻障碍物之间的中点并形成中点列表,并将中点列表中所有相邻障碍物之间的中点的个数记为G,执行步骤3.1.9;
步骤3.1.9、将终点E加入所述中点列表中,定义g1、g2为中点的编号,并初始化g1=0,g2=1;
步骤3.1.10、定义k为障碍物的编号,并初始化k=1;
步骤3.1.16、将k+1赋值给k,判断k≤K是否成立,若成立,则执行步骤3.1.12;否则,执行步骤3.1.17;
步骤3.1.18、将g2+1赋值给g2,初始化k=1,判断g2≤G+1是否成立,若成立,则执行步骤3.1.12;否则,执行步骤3.1.19;
步骤3.1.19、将g1+1赋值给g1,初始化g2=1,判断g1≤G是否成立,若成立,则执行步骤3.1.12;否则,表示得到起点S以及每个中点的可达点列表;
步骤3.1.20、定义t为当前迭代次数,令tmax为最大迭代次数,并初始化t=1;
步骤3.1.21、定义并初始化种群大小为M,定义i为粒子的编号,并初始化i=1;
步骤3.1.22、定义并初始化路径点的总个数为N,并初始化j=1;
步骤3.1.27、判断j<N是否成立,若成立,执行步骤3.1.23;否则,未找到一条从起点S到终点E的路径,令j=1,重新执行步骤3.1.23;
步骤3.1.28、判断j<N是否成立,若成立,则表示找到的路径点的数目小于N,执行步骤3.1.29;否则,表示完成对第t-1代种群第i个粒子的迭代,并获得第t-1代种群第i个粒子的初始位置并执行步骤3.1.30;
步骤3.1.30、利用式(9)计算第t-1代第i个粒子的适应度的值;
步骤3.2、利用分层粒子群算法更新种群;
步骤3.2.1、根据式(11)得到第t次迭代的惯性权重为wt:
式(11)中,w0表示惯性权重的初始值;
式(12)和(13)中,cmin为学习因子的最小值,cmax为学习因子的最大值;
步骤3.2.3、利用式(9)计算第t代种群的适应度值,并根据适应度值对第t代种群中的粒子进行升序排序,得到排序后的第t代种群;
步骤3.2.4、根据适应度值将排序后的第t代种群划分为三层,并将第t代种群的粒子数目M划分为和从而根据式(15)-式(17)分别计算排序后的第t代种群的第一层的粒子数目第二层的粒子数目和第三层的粒子数目
式(15)-式(17)中,floor()为向下取整,ceil()为向上取整,参数a1、a2、a3和a4取固定的参数,且满足a1+a2+a3=1;
步骤3.2.5、初始化i=1;
步骤3.2.6、初始化j=1;
式(18)-式(20)中,表示第t-1代第i个粒子的第j个路径点的位置,α1表示从第一层随机选取的粒子的序号,表示第t代第α1个粒子的第j个路径点的位置,α2表示从第二层随机选取的粒子的序号,表示第t代第α2个粒子的第j个路径点的位置,表示第t-1代第i个粒子的第j个路径点的速度,表示第t代第i个粒子的第j个路径点的速度,表示第t-1代第i个粒子的第j个路径点的局部最优解,表示第t-1代的第j个路径点的全局最优解,wt表示第t代种群的惯性权重,和为第t次迭代(0,1)之间的随机数;
步骤3.2.9、将j+1赋值给j,判断j≤N是否成立,若成立,则执行步骤3.2.7;否则,表示完成对排序后的第t代种群中第i个粒子的迭代;
步骤3.2.10、利用式(9)计算第t代种群中第i个粒子的适应度值;
本发明一种电子设备,包括存储器以及处理器,其特点在于,所述存储器用于存储支持处理器执行所述的无人机路径规划方法的程序,所述处理器被配置为用于执行所述存储器中存储的程序。
本发明一种计算机可读存储介质,计算机可读存储介质上存储有计算机程序,其特点在于,所述计算机程序被处理器运行时执行所述的无人机路径规划方法的步骤。
与已有技术相比,本发明的有益效果体现在:
1、本发明提出了一种路径规划问题初始化种群的方法,利用障碍物中点信息去初始化种群,使种群中的个体在初始化时找到多条可行的路径,提高了种群的多样性,解决了随机初始化方法中只能找到一条或找不到可行路径的弊端。
2、本发明提出了一种分层粒子群算法的无人机路径规划方法,可以提高算法的收敛速度,具有较好的鲁棒性,提高了种群搜索的精度和多样性,使无人机能快速规划出较短路径,该方法在解决无人机三维路径规划问题上具有更显著的性能,同时适用于较复杂的无人机路径规划问题。
附图说明
图1为本发明分层粒子群算法的流程图;
图2为本发明无人机路径规划示意图;
图3为本发明威胁成本示意图;
图4为本发明转角和爬升角的计算示意图。
具体实施方式
在实施例中,一种基于分层粒子群算法的无人机路径规划方法是针对无人机的飞行场景,找到使路径长度、威胁成本和高度成本和平滑成本最小的路径规划方案,使无人机避开所有的障碍物,生成从起点到终点的高质量的接近最优的飞行路径。具体地说,如图1所示,按该方法是按如下步骤进行:
步骤1、获取一目标区域,并以目标区域的外接矩形的一个顶点为原点,以与原点相连的两条边分别作为x轴和y轴,以垂直于oxy水平面的方向为z轴,从而建立三维坐标系,具体来说,如图2所示。令Pj表示无人机的第j个路径点,Pj的坐标为(xj,yj,zj),令起点S的坐标为(x1,y1,z1),令终点E的坐标为(xN,yN,zN);
步骤2、构建目标函数:
步骤2.1、最小化路径长度:
第一个目标函数是使无人机从起点到终点的飞行距离最小。一般来说,无人机路径越短,飞行所需的时间和燃料消耗越少,利用式(1)构建使无人机从起点S到终点E的飞行距离最小的路径长度f1,并作为第1个目标函数:
式(1)中,lj表示从第j个路径点Pj到第j+1个路径点Pj+1的欧几里得距离,N是路径点的个数,N-1是路径段的个数;
步骤2.2、最小化威胁代价函数:
除了优化路径长度之外,无人机在飞行过程中还需要躲避障碍物,来确保无人机的安全飞行。假设每个威胁用圆柱体表示。具体来说,如图3所示,利用式(2)和式(3)构建无人机飞行的威胁代价f2,并作为第2个目标函数:
式(2)和式(3)中,K为障碍物的数目,Rk为第k个障碍物的半径,S为碰撞区的危险距离,D为无人机的直径,直径D由无人机大小决定,距离S取决于几个因素,如应用、操作环境和定位精度;表示从第j个路径点Pij到第j+1个路径点Pj+1构成的向量,djk表示路径段到第k个障碍物的圆心之间的距离;Tk(·)表示第k个障碍物的威胁代价;
步骤2.3、最小化高度代价:
无人机在飞行过程中,飞行高度经常被限制在给定的最小高度和最大高度之间。利用式(4)和式(5)构建无人机在飞行过程中的高度代价f3,并作为第3个目标函数:
式(4)和式(5)中,hj表示无人机在第j个路径点Pj相对于地面的飞行高度,hmin和hmax分别为无人机飞行的最小高度和最大高度,Hj表示无人机在第j个路径点Pj的高度代价。该目标使无人机保持平均高度,并惩罚超出范围的值。
步骤2.4、最小化平滑代价:
式(6)中,P'j表示在第j个路径点Pj在oxy水平面的投影点,P'j+1表示在第j+1个路径点Pj+1在oxy水平面的投影点,表示在第j个路径点Pj指向第j+1个路径点Pj+1构成的向量在oxy水平面的投影,表示在第j+1个路径点Pj+1指向第j+2个路径点Pj+2构成的向量在oxy水平面的投影;
式(7)中,zj表示在第j个路径点Pj的z轴坐标,zj+1表示在第j+1个路径点Pj+1的z轴坐标;
利用式(8)构建无人机的平滑成本f4,并作为第4个目标函数:
式(8)中,a1和a2分别为转角Φj和爬升角ψj的惩罚系数;表示从第j-1个路径点Pij到第j个路径点Pj+1构成的向量,表示在第j-1个路径点Pj指向第j个路径点Pj+1构成的向量在oxy水平面的投影,ψj-1表示无人机在路径段与其在oxy水平面上的投影之间的爬升角;
将无人机路径规划问题建模为由一组优化准则和约束条件定义的最小化问题,无人机路径的成本函数被定义为四个目标函数的加权和,利用式(9)构建无人机路径规划模型:
式(9)中,J是无人机路径的目标函数,bs是第s个目标函数fs的权重系数,f1到f4分别是与路径长度、威胁、飞行高度和平滑相关的代价;
步骤3、基于改进的分层粒子群算法求解无人机路径规划模型,粒子群算法是一种智能优化算法,本发明主要对将粒子分为三层,提高搜索精度和多样性,从而使得分层粒子群算法能够更好地求解无人机路径规划问题,分层粒子群算法按如下步骤进行:
步骤3.1、根据障碍物信息初始化种群:
步骤3.1.1、定义障碍物的数目为K,定义k1、k2、k3为障碍物的编号,并初始化k1=1、k2=k1+1、k3=1;
步骤3.1.3、判断k3=k1或k3=k2是否成立,若成立,则执行步骤3.1.5;否则,执行步骤3.1.4;
步骤3.1.5、将k3+1赋值给k3,判断k3≤K是否成立,若成立,则执行步骤3.1.3;否则,执行步骤3.1.6;
步骤3.1.7、将k2+1赋值给k2后,初始化k3=1,并判断k2≤K是否成立,若成立,则执行步骤3.1.3;否则,执行步骤3.1.8;
步骤3.1.8、将k1+1赋值给k1后,将k1+1赋值给k2,判断k1≤K是否成立,若成立,则执行步骤3.1.3;否则,表示得到所有相邻障碍物之间的中点并形成中点列表,并将中点列表中所有相邻障碍物之间的中点的个数记为G,执行步骤3.1.9;
步骤3.1.9、将终点E加入中点列表尾部,定义g1、g2为中点的编号,并初始化g1=0,g2=1;
步骤3.1.10、定义k为障碍物的编号,并初始化k=1;
步骤3.1.16、将k+1赋值给k,判断k≤K是否成立,若成立,则执行步骤3.1.12;否则,执行步骤3.1.17;
步骤3.1.18、将g2+1赋值给g2,初始化k=1,判断g2≤G+1是否成立,若成立,则执行步骤3.1.12;否则,执行步骤3.1.19;
步骤3.1.19、将g1+1赋值给g1,初始化g2=1,判断g1≤G是否成立,若成立,则执行步骤3.1.12;否则,表示得到起点S以及每个中点的可达点列表;
步骤3.1.20、定义t为当前迭代次数,令tmax为最大迭代次数,并初始化t=1;
步骤3.1.21、定义并初始化种群大小为M,定义i为粒子的编号,并初始化i=1;
步骤3.1.22、定义并初始化路径点的总个数为N,并初始化j=1;
步骤3.1.24、计算第t-1代种群第i个粒子的第j个路径点与其第l个可达点的距离为多个可达点,尽量选择距离短的点,距离越短被选择的概率越大。利用式(10)计算第t-1代第i个粒子的第j个路径点的第l个可达点的选择概率
步骤3.1.27、判断j<N是否成立,若成立,执行步骤3.1.23;否则,表示找到的路径点的数目达到N,没有找到一条从起点到终点的路径,令j=1,重新执行步骤3.1.23;
步骤3.1.28、判断j<N是否成立,若成立,则表示找到的路径点的数目小于N,执行步骤3.1.29;否则,表示完成对第t-1代种群第i个粒子的迭代,并获得第t-1代种群第i个粒子的初始位置并执行步骤3.1.30;
步骤3.1.30、利用式(9)计算第t-1代第i个粒子的适应度的值;
步骤3.2、利用分层粒子群算法更新种群;
步骤3.2.1、wt采用指数形式,动态非线性变化。根据式(11)得到第t次迭代的惯性权重为wt:
式(11)中,w0表示惯性权重的初始值;
步骤3.2.3、利用式(9)计算第t代种群的适应度值,并根据适应度值对第t代种群中的粒子进行升序排序,得到排序后的第t代种群;
步骤3.2.4、根据适应度值将排序后的第t代种群划分为三层,并将第t代种群的粒子数目M划分为和从而根据式(15)-式(17)分别计算排序后的第t代种群的第一层的粒子数目第二层的粒子数目和第三层的粒子数目
式(15)-式(17)中,floor()为向下取整,ceil()为向上取整,参数a1、a2、a3和a4取固定的参数,且满足a1+a2+a3=1;n1和n3随着迭代次数变化,n2在迭代过程中固定不变。在迭代初期,需要提高粒子的多样性,所以n1设置的比较小,n3比较大。在迭代后期,粒子需要提高搜索精度,所以n1比较大,n3比较小。n1随着迭代次数慢慢增加,n3随着迭代次数慢慢减少。
步骤3.2.5、初始化i=1;
步骤3.2.6、初始化j=1;
式(18)-式(20)中,表示第t-1代第i个粒子的第j个路径点的位置,α1表示从第一层随机选取的粒子的序号,表示第t代第α1个粒子的第j个路径点的位置,α2表示从第二层随机选取的粒子的序号,表示第t代第α2个粒子的第j个路径点的位置,表示第t-1代第i个粒子的第j个路径点的速度,表示第t代第i个粒子的第j个路径点的速度,表示第t-1代第i个粒子的第j个路径点的局部最优解,表示第t-1代的第j个路径点的全局最优解,wt表示第t代种群的惯性权重,和为第t次迭代(0,1)之间的随机数;
第一层为适应度较好的粒子,该层的粒子主要进行全局搜索,向全局最优解学习,提高了搜索精度,第二层粒子适应度值适中,同时向全局最优解和局部最优解学习,第三层的粒子适应度值较差,该层的粒子随机选择两个第一层和第二层的个体对当前个体进行引导,主要为了增加粒子的多样性。
步骤3.2.9、将j+1赋值给j,判断j≤N是否成立,若成立,则执行步骤3.2.7;否则,表示完成对排序后的第t代种群中第i个粒子的迭代;
步骤3.2.10、利用式(9)计算第t代种群中第i个粒子的适应度值;
本实施例中,一种电子设备,包括存储器以及处理器,该存储器用于存储支持处理器执行该无人机路径规划方法的程序,该处理器被配置为用于执行该存储器中存储的程序。
本实施例中,一种计算机可读存储介质,是在计算机可读存储介质上存储有计算机程序,该计算机程序被处理器运行时执行该无人机路径规划方法的步骤。
Claims (3)
1.一种基于分层粒子群算法的无人机路径规划方法,其特征在于,是按如下步骤进行:
步骤1、获取一目标区域,并以所述目标区域的外接矩形的一个顶点为原点,以与原点相连的两条边分别作为x轴和y轴,以垂直于oxy水平面的方向为z轴,从而建立三维坐标系;令Pj表示无人机的第j个路径点,Pj的坐标为(xj,yj,zj),令起点S的坐标为(x1,y1,z1),令终点E的坐标为(xN,yN,zN);
步骤2、构建目标函数:
步骤2.1、最小化路径长度:
利用式(1)构建使无人机从起点S到终点E的飞行距离最小的路径长度f1,并作为第1个目标函数:
式(1)中,lj表示从第j个路径点Pj到第j+1个路径点Pj+1的欧几里得距离,N是路径点的个数,N-1是路径段的个数;
步骤2.2、最小化威胁代价函数:
利用式(2)和式(3)构建无人机飞行的威胁代价f2,并作为第2个目标函数:
式(2)和式(3)中,K为障碍物的数目,Rk为第k个障碍物的半径,S为碰撞区的危险距离,D为无人机的直径,表示从第j个路径点Pij到第j+1个路径点Pj+1构成的向量,djk表示路径段到第k个障碍物的圆心之间的距离;Tk(·)表示第k个障碍物的威胁代价;
步骤2.3、最小化高度代价:
利用式(4)和式(5)构建无人机在飞行过程中的高度代价f3,并作为第3个目标函数:
式(4)和式(5)中,hj表示无人机在第j个路径点Pj相对于地面的飞行高度,hmin和hmax分别为无人机飞行的最小高度和最大高度,Hj表示无人机在第j个路径点Pj的高度代价;
步骤2.4、最小化平滑代价:
式(6)中,P'j表示在第j个路径点Pj在oxy水平面的投影点,P'j+1表示在第j+1个路径点Pj+1在oxy水平面的投影点,表示在第j个路径点Pj指向第j+1个路径点Pj+1构成的向量在oxy水平面的投影,表示在第j+1个路径点Pj+1指向第j+2个路径点Pj+2构成的向量在oxy水平面的投影;
式(7)中,zj表示在第j个路径点Pj的z轴坐标,zj+1表示在第j+1个路径点Pj+1的z轴坐标;
利用式(8)构建无人机的平滑成本f4,并作为第4个目标函数:
式(8)中,a1和a2分别为转角Φj和爬升角ψj的惩罚系数;表示从第j-1个路径点Pij到第j个路径点Pj+1构成的向量,表示在第j-1个路径点Pj指向第j个路径点Pj+1构成的向量在oxy水平面的投影,ψj-1表示无人机在路径段与其在oxy水平面上的投影之间的爬升角;
利用式(9)构建无人机路径规划模型:
式(9)中,J是无人机路径的目标函数,bs是第s个目标函数fs的权重系数;
步骤3、基于改进的分层粒子群算法求解无人机路径规划模型:
步骤3.1、根据障碍物信息初始化种群:
步骤3.1.1、定义障碍物的数目为K,定义k1、k2、k3为障碍物的编号,并初始化k1=1、k2=k1+1、k3=1;
步骤3.1.3、判断k3=k1或k3=k2是否成立,若成立,则执行步骤3.1.5;否则,执行步骤3.1.4;
步骤3.1.5、将k3+1赋值给k3,判断k3≤K是否成立,若成立,则执行步骤3.1.3;否则,执行步骤3.1.6;
步骤3.1.7、将k2+1赋值给k2后,初始化k3=1,并判断k2≤K是否成立,若成立,则执行步骤3.1.3;否则,执行步骤3.1.8;
步骤3.1.8、将k1+1赋值给k1后,将k1+1赋值给k2,判断k1≤K是否成立,若成立,则执行步骤3.1.3;否则,表示得到所有相邻障碍物之间的中点并形成中点列表,并将中点列表中所有相邻障碍物之间的中点的个数记为G,执行步骤3.1.9;
步骤3.1.9、将终点E加入所述中点列表中,定义g1、g2为中点的编号,并初始化g1=0,g2=1;
步骤3.1.10、定义k为障碍物的编号,并初始化k=1;
步骤3.1.16、将k+1赋值给k,判断k≤K是否成立,若成立,则执行步骤3.1.12;否则,执行步骤3.1.17;
步骤3.1.18、将g2+1赋值给g2,初始化k=1,判断g2≤G+1是否成立,若成立,则执行步骤3.1.12;否则,执行步骤3.1.19;
步骤3.1.19、将g1+1赋值给g1,初始化g2=1,判断g1≤G是否成立,若成立,则执行步骤3.1.12;否则,表示得到起点S以及每个中点的可达点列表;
步骤3.1.20、定义t为当前迭代次数,令tmax为最大迭代次数,并初始化t=1;
步骤3.1.21、定义并初始化种群大小为M,定义i为粒子的编号,并初始化i=1;
步骤3.1.22、定义并初始化路径点的总个数为N,并初始化j=1;
步骤3.1.27、判断j<N是否成立,若成立,执行步骤3.1.23;否则,未找到一条从起点S到终点E的路径,令j=1,重新执行步骤3.1.23;
步骤3.1.28、判断j<N是否成立,若成立,则表示找到的路径点的数目小于N,执行步骤3.1.29;否则,表示完成对第t-1代种群第i个粒子的迭代,并获得第t-1代种群第i个粒子的初始位置并执行步骤3.1.30;
步骤3.1.30、利用式(9)计算第t-1代第i个粒子的适应度的值;
步骤3.2、利用分层粒子群算法更新种群;
步骤3.2.1、根据式(11)得到第t次迭代的惯性权重为wt:
式(11)中,w0表示惯性权重的初始值;
式(12)和(13)中,cmin为学习因子的最小值,cmax为学习因子的最大值;
步骤3.2.3、利用式(9)计算第t代种群的适应度值,并根据适应度值对第t代种群中的粒子进行升序排序,得到排序后的第t代种群;
步骤3.2.4、根据适应度值将排序后的第t代种群划分为三层,并将第t代种群的粒子数目M划分为和从而根据式(15)-式(17)分别计算排序后的第t代种群的第一层的粒子数目第二层的粒子数目和第三层的粒子数目
式(15)-式(17)中,floor()为向下取整,ceil()为向上取整,参数a1、a2、a3和a4取固定的参数,且满足a1+a2+a3=1;
步骤3.2.5、初始化i=1;
步骤3.2.6、初始化j=1;
式(18)-式(20)中,表示第t-1代第i个粒子的第j个路径点的位置,α1表示从第一层随机选取的粒子的序号,表示第t代第α1个粒子的第j个路径点的位置,α2表示从第二层随机选取的粒子的序号,表示第t代第α2个粒子的第j个路径点的位置,表示第t-1代第i个粒子的第j个路径点的速度,表示第t代第i个粒子的第j个路径点的速度,表示第t-1代第i个粒子的第j个路径点的局部最优解,表示第t-1代的第j个路径点的全局最优解,wt表示第t代种群的惯性权重,和为第t次迭代(0,1)之间的随机数;
步骤3.2.9、将j+1赋值给j,判断j≤N是否成立,若成立,则执行步骤3.2.7;否则,表示完成对排序后的第t代种群中第i个粒子的迭代;
步骤3.2.10、利用式(9)计算第t代种群中第i个粒子的适应度值;
2.一种电子设备,包括存储器以及处理器,其特征在于,所述存储器用于存储支持处理器执行权利要求1所述的无人机路径规划方法的程序,所述处理器被配置为用于执行所述存储器中存储的程序。
3.一种计算机可读存储介质,计算机可读存储介质上存储有计算机程序,其特征在于,所述计算机程序被处理器运行时执行权利要求1所述的无人机路径规划方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211138201.9A CN115357050A (zh) | 2022-09-19 | 2022-09-19 | 一种基于分层粒子群算法的无人机路径规划方法及其应用 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211138201.9A CN115357050A (zh) | 2022-09-19 | 2022-09-19 | 一种基于分层粒子群算法的无人机路径规划方法及其应用 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN115357050A true CN115357050A (zh) | 2022-11-18 |
Family
ID=84005838
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211138201.9A Pending CN115357050A (zh) | 2022-09-19 | 2022-09-19 | 一种基于分层粒子群算法的无人机路径规划方法及其应用 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115357050A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115576333A (zh) * | 2022-12-08 | 2023-01-06 | 青岛科技大学 | 最优向避障策略 |
-
2022
- 2022-09-19 CN CN202211138201.9A patent/CN115357050A/zh active Pending
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115576333A (zh) * | 2022-12-08 | 2023-01-06 | 青岛科技大学 | 最优向避障策略 |
CN115576333B (zh) * | 2022-12-08 | 2023-05-05 | 青岛科技大学 | 最优向避障策略 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111240319B (zh) | 室外多机器人协同作业系统及其方法 | |
CN110632931B (zh) | 动态环境下基于深度强化学习的移动机器人避碰规划方法 | |
CN112130581B (zh) | 一种面向空中机动作战的无人机集群协同任务规划方法 | |
CN111880561B (zh) | 城市环境下基于改进鲸鱼算法的无人机三维路径规划方法 | |
CN110134140B (zh) | 一种环境信息未知连续状态下基于势函数奖赏dqn的无人机路径规划方法 | |
CN107607120B (zh) | 基于改进修复式Anytime稀疏A*算法的无人机动态航迹规划方法 | |
CN101118622A (zh) | 在城市环境下微型飞行器三维轨迹仿真方法 | |
CN112747736A (zh) | 一种基于视觉的室内无人机路径规划方法 | |
CN108919818B (zh) | 基于混沌种群变异pio的航天器姿态轨道协同规划方法 | |
CN112327939B (zh) | 一种城市街区环境下高层消防多无人机协同路径规划方法 | |
CN112161627A (zh) | 一种消防机器人智能路径规划方法 | |
CN113848919A (zh) | 一种基于蚁群算法的室内agv路径规划方法 | |
CN112733251B (zh) | 一种多无人飞行器协同航迹规划方法 | |
CN114840020A (zh) | 一种基于改进鲸鱼算法的无人机飞行轨迹规划方法 | |
CN113238232B (zh) | 面向海洋静态目标的自主水下航行器系统目标搜索方法 | |
CN115903879A (zh) | 基于地形数据插值技术的无人机航迹规划方法 | |
CN112414405A (zh) | 一种顾及dsm的应急任务的无人机集群航迹规划方法 | |
CN115357050A (zh) | 一种基于分层粒子群算法的无人机路径规划方法及其应用 | |
CN115903888A (zh) | 一种基于天牛群算法的旋翼无人机自主路径规划方法 | |
CN114777789A (zh) | 一种基于球面矢量鸽群算法的三维避障航路规划方法 | |
CN113220008B (zh) | 多火星飞行器的协同动态路径规划方法 | |
Kareem et al. | Planning the Optimal 3D Quadcopter Trajectory Using a Delivery System-Based Hybrid Algorithm. | |
CN117724524A (zh) | 一种基于改进球面向量粒子群算法的无人机航线规划方法 | |
CN116382334A (zh) | 一种针对多无人机协同航迹规划的融合优化方法 | |
CN115840465A (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 |