CN107608372B - 一种基于改进rrt算法与改进ph曲线相结合的多无人机协同航迹规划方法 - Google Patents

一种基于改进rrt算法与改进ph曲线相结合的多无人机协同航迹规划方法 Download PDF

Info

Publication number
CN107608372B
CN107608372B CN201710691678.2A CN201710691678A CN107608372B CN 107608372 B CN107608372 B CN 107608372B CN 201710691678 A CN201710691678 A CN 201710691678A CN 107608372 B CN107608372 B CN 107608372B
Authority
CN
China
Prior art keywords
unmanned aerial
track
aerial vehicle
planning
point
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.)
Active
Application number
CN201710691678.2A
Other languages
English (en)
Other versions
CN107608372A (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.)
GUILIN FEIYU TECHNOLOGY Corp.,Ltd.
Original Assignee
Guangxi Normal University
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 Guangxi Normal University filed Critical Guangxi Normal University
Priority to CN201710691678.2A priority Critical patent/CN107608372B/zh
Publication of CN107608372A publication Critical patent/CN107608372A/zh
Application granted granted Critical
Publication of CN107608372B publication Critical patent/CN107608372B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种基于改进RRT算法与改进PH曲线相结合的多无人机协同航迹规划方法,其特征是,包括如下步骤:1)环境建模;2)规划单机航迹集;3)规划多机协同航迹。这种方法结合多无人机初末速度方向、能加快多无人机航迹规划算法速度、可以节约无人机燃油、能平滑无人机航程航迹,在多无人机协同航迹规划中具有广泛的应用前景。

Description

一种基于改进RRT算法与改进PH曲线相结合的多无人机协同 航迹规划方法
技术领域
本发明涉及无人机航迹搜索领域,具体是一种基于改进快速扩展随机树RRT(Rapidly-exploring Random Tree,简称RRT)算法与改进毕达哥拉斯矢端曲线(Pythagorean Hodograph,简称PH曲线)相结合的多无人机协同航迹规划方法。
背景技术
快速扩展随机树RRT算法第一次提出是在1998年由美国科学S.M.LaValle提出,其基本原理是在任务空间内以节点生长的方式构建随机树,主要优点是能够在复杂环境中快速找到路径规划问题的可行解。
毕达哥拉斯矢端PH曲线,是由Farouki和Sakkalis在1990年研究等距曲线的过程中率先提出,他们将PH曲线定义为多项式曲线的形式,并且PH曲线的矢端矢量满足勾股条件。
随着环境和任务的日益复杂性,单架无人机已经不法完成所需任务需求,需要通过多架无人机合作来完成,多无人机协同是指多架无人机通过采取协作的方式完成某项任务。航迹规划是最大限度的利用地形信息,综合考虑无人机导航精度和机动能力的限制,在最短的时间内计算出从现在位置到指定位置的最优或次优的飞行轨迹,能使无人机回避威胁环境,安全地完成预定任务。
假设N架无人机分别处于不同起始位置S1,S2,…,SN,要求在同一时刻t1到达同一目标点D,实施打击且代价最小,协同航迹问题多假设为多机同时到达问题,通常使用两种方法使得无人机能够同时到达目标:一种为通过调节无人机的飞行速度,航程较大的无人机的速度较大,航程较小的无人机的速度较小;另一种是修正航迹长度,使得每架无人机的航程大致相同。
发明内容
本发明的目的针对现有技术的不足,而提供一种基于改进RRT算法与改进PH曲线相结合的多无人机协同航迹规划方法。这种方法结合多无人机初末速度方向、能加快多无人机航迹规划算法速度、可以节约无人机燃油、能平滑无人机航程航迹,在多无人机协同航迹规划中具有广泛的应用前景。
实现本发明目的的技术方案是:
一种基于改进RRT算法与改进PH曲线相结合的多无人机协同航迹规划方法,包括如下步骤:
1)环境建模:假设无人机进行等高飞行,结合无人机飞行中自然威胁分布构建环境模型,自然威胁主要是山川地形威胁;
2)规划单机航迹集:首先根据起始点和终止点,运用改进PH曲线算法,得到6个控制点,分别为b0,b1,b2,b3,b4,b5;然后选取规划得到的6个控制点中的b2和b3作为新起始点和新终止点,并在新起始点和新终止点之间多次运用改进RRT算法规划得到单机航迹集;
3)规划多机协同航迹:根据多无人机协同航迹规划原理以及多无人机协同航迹规划的代价函数,在规划航迹集中选取一条符合多无人机协同规划原理以及航迹代价函数的最小航迹。
步骤1)中所述自然威胁为:某飞行高度上对无人机飞行有可能造成威胁的山峰和高地在水平截图面上的截面是圆周,则
Figure GDA0002676739510000021
其中,dT min表示地形所允许的最靠近距离,dT max表示地形能影响的最远距离,dT为某一时刻无人机距离地形中心轴距离。
步骤2)包括:
(1)根据任务要求的起始点和终止点,运用改进PH曲线算法,得到6个控制点,分别为b0,b1,b2,b3,b4,b5,具体为:
PH曲线贝塞尔(Bezier)形式的多项式为
Figure GDA0002676739510000022
Figure GDA0002676739510000031
路径r(q)的一阶导数为
Figure GDA0002676739510000032
采用艾米特(Hermite)插值法,确定基准路径的形状,起始点和终止点分别为(xs,ys)和(xf,yf),Bezier曲线的6个控制点b0,b1,b2,b3,b4,b5
Figure GDA0002676739510000033
其中:φs表示起始点方位角,φR表示无人机转弯角,φf表示终止点方位角,常数m0∈[1,+∞],常数m3∈[1,+∞],常数m5∈[1,+∞];
(2)选取步骤(1)得到的6个控制点中的b2和b3作为新的起始点和新的终止点,并在新起始点和新终止点之间运用改进RRT算法规划得到单无人机航迹集,由于RRT算法具有随机性,所以运用改进RRT算法得到三条航迹集,具体为:
经典RRT算法在选择qrand时需要遍历当前随机树的所有节点并且计算相应的欧式距离,因此减少qrand的选取次数,可以降低计算运行时间,运用基于威胁值和航路代价构建随机点空间的概率矩阵作为航迹规划的先验知识,然后使用轮盘赌算法优先拓展概率大(适应度值高)的随机点,设置随机搜索空间的航路代价值如公式(5)所示:
JL=K*[(A+B)/C]2 (5)
其中:K为常数,A为起点到路径点的距离,B为目标点到路径点的距离,C为起点到目标点的距离;
设置随机搜索空间威胁代价值如公式(6)所示:
JT=K/(D-d)2 (6)
其中:K为常数,D为路径上点到障碍物距离,d为绝对杀伤区的距离;
设置随机点的适应度值如公式(7)所示:
Pij=1/(λ1*JL2+JT) (7)
其中:Pij表示点(i,j)的适应度值,λ1、λ2分别表示JL和JT的权重系数;
使用轮盘赌算法优先拓展概率大(适应度值高)的随机点,个体被选中的概率与其适应度函数值成正比,群体全部个体的适当度值由一张轮盘来代表,设群体大小为n即有n个点,每个点代表群体中的一个群员,个体i的适应度为Fi,则个体i被选中的概率如公式(8)所示:
Figure GDA0002676739510000041
(3)航迹平滑处理:采用平滑算法与滑窗滤波相结合的形式对单无人机航迹进行航迹平滑处理,首先运用平滑算法,从起始点开始,每三个航迹点考虑一次最小转弯半径约束,如果不满足约束条件,即单机最小转弯半径,则删除三个航迹点的中间节点,插入满足约束的临界节点,虽然平滑算子解决了转弯半径约束的问题,但没有解决航段出现左右波动的问题,因此,接着采用滑动平均法滤波,滤波法是指通过对各航迹节点进行滤波处理,削弱波动性,滑动平均是对一定长度移动窗口的数据进行加权平均,设第k个航迹点为v(k),对其前后各i个点加权平均得u(k):
Figure GDA0002676739510000042
其中,w为常数是窗口宽度,w(j)是窗口加权函数。
步骤3)所述的规划多机协同航迹具体为:
路径总长度在无法躲避的障碍物中的路径长度是航迹规划结果的重要指标,设fij为路径在威胁区代价,Dij为路径总长度燃油消耗代价,假设共有N架无人机,每架无人机单独规划出M条备选航迹,每一架无人机的速度vi∈[vmin vmax],那么T∈[Li/vmax Li/vmin],其中Li是某架无人机的第i条航迹;对于某架无人机的M条航迹,预计到达目标的时间则是M个时间范围的并集St,那么N架无人机共同到达的时间交集S=St,1∩St,2∩...∩St,n,那么多无人机协同航迹规划的代价函数如公式(10):
J=min(λ1∑(wkfij+wDDij)+λ2T) (10)
其中,J为航路总代价值;λ1,λ2为系数;wk>0为安全代价权,wD>0为路径长度代价权;fij为安全代价;Dij为航线段的长度,作为燃油消耗的代价指标;T∈S。
这种方法与现有技术相比的优点在于:
(1)利用了改进PH曲线的曲率连续,曲线平滑以及有理特性,充分考虑无人机初、末速度方向,可实现无人机路径规划,具有弯曲能量小,曲线上曲率和长度均有闭合解等优点;
(2)改进RRT算法省去了选取随机点时太多的无用空间搜索,缩短了航迹航程,节约了燃油燃料,且能成功躲避障碍物;
(3)采用了平滑算法和滑窗滤波相结合的航迹平滑处理方法,能够很好的解决无人机转弯半径约束的问题且削弱了航段出现左右波动的问题。
这种方法结合多无人机初末速度方向、能加快多无人机航迹规划算法速度、可以节约无人机燃油、能平滑无人机航程航迹,在多无人机协同航迹规划中具有广泛的应用前景。
附图说明
图1为实施例中的方法流程示意图;
图2为实施例中的山川地形威胁示意图;
图3为实施例中的随机搜索空间航路代价值示意图;
图4为实施例中的随机搜索空间威胁代价值示意图;
图5为实施例中的轮盘赌选择示意图;
图6为实施例中的航迹平滑处理示意图;
图7为实施例中的经典RRT算法的多机单目标备选航迹集仿真图;
图8为实施例中的经典RRT算法最优飞行航迹与飞行速度仿真图;
图9为实施例中的改进RRT算法和改进PH曲线相结合算法的单目标备选航迹集仿真图;
图10为实施例中改进RRT算法和改进PH曲线相结合算法的最优飞行航迹与飞行速度仿真图。
具体实施方式
下面结合附图和实施例对本发明内容作进一步的阐述,但不是对本发明的限定。
参照图1,一种基于改进RRT算法与改进PH曲线相结合的多无人机协同航迹规划方法,包括如下步骤:
1)环境建模:假设无人机进行等高飞行,结合无人机飞行中自然威胁分布构建环境模型,自然威胁主要是山川地形威胁;
2)规划单机航迹集:首先根据起始点和终止点,运用改进PH曲线算法,得到6个控制点,分别为b0,b1,b2,b3,b4,b5;然后选取规划得到的6个控制点中的b2和b3作为新起始点和新终止点,并在新起始点和新终止点之间多次运用改进RRT算法规划得到单机航迹集;
3)规划多机协同航迹:根据多无人机协同航迹规划原理以及多无人机协同航迹规划的代价函数,在规划航迹集中选取一条符合多无人机协同规划原理以及航迹代价函数的最小航迹。
步骤1)中所述自然威胁为:某飞行高度上对无人机飞行有可能造成威胁的山峰和高地在水平截图面上的截面是圆周,如图2所示,
Figure GDA0002676739510000061
其中,dT min表示地形所允许的最靠近距离,dT max表示地形能影响的最远距离,dT为某一时刻无人机距离地形中心轴距离。
步骤2)包括:
(1)根据任务要求的起始点和终止点,运用改进PH曲线算法,得到6个控制点,分别为b0,b1,b2,b3,b4,b5,具体为:
PH曲线贝塞尔(Bezier)形式的多项式为
Figure GDA0002676739510000071
路径r(q)的一阶导数为
Figure GDA0002676739510000072
采用艾米特(Hermite)插值法,确定基准路径的形状,起始点和终止点分别为(xs,ys)和(xf,yf),Bezier曲线的6个控制点b0,b1,b2,b3,b4,b5
Figure GDA0002676739510000073
其中:φs表示起始点方位角,φR表示无人机转弯角,φf表示终止点方位角,常数m0∈[1,+∞],常数m3∈[1,+∞],常数m5∈[1,+∞];
(2)选取步骤(1)得到的6个控制点中的b2和b3作为新的起始点和新的终止点,并在新起始点和新终止点之间运用改进RRT算法规划得到单无人机航迹集,由于RRT算法具有随机性,所以运用改进RRT算法得到三条航迹集,具体为:
经典RRT算法在选择qrand时需要遍历当前随机树的所有节点并且计算相应的欧式距离,因此减少qrand的选取次数,可以降低计算运行时间,运用基于威胁值和航路代价构建随机点空间的概率矩阵作为航迹规划的先验知识,然后使用轮盘赌算法优先拓展概率大(适应度值高)的随机点。如图3所示,设置随机搜索空间航路代价值如公式(5)所示:
JL=K*[(A+B)/C]2 (5)
其中:K为常数,A为起点到路径点的距离,B为目标点到路径点的距离,C为起点到目标点的距离;
如图4所示,设置随机搜索空间威胁代价值如公式(6)所示:
JT=K/(D-d)2 (6)
其中:K为常数,D为路径上点到障碍物距离,d为绝对杀伤区的距离;
设置随机点的适应度值如公式(7)所示:
Pij=1/(λ1*JL2+JT) (7)
其中:Pij表示点(i,j)的适应度值,λ1、λ2分别表示JL和JT的权重系数;
如图5所示,使用轮盘赌算法优先拓展概率大(适应度值高)的随机点,个体被选中的概率与其适应度函数值成正比,群体全部个体的适当度值由一张轮盘来代表,设群体大小为n即有n个点,每个点代表群体中的一个群员,个体i的适应度为Fi,则个体i被选中的概率如公式(8)所示:
Figure GDA0002676739510000081
(3)航迹平滑处理:如图6所示,采用平滑算法与滑窗滤波相结合的形式对单机航迹进行航迹平滑处理,首先运用平滑算法,从起始点开始,每三个航迹点考虑一次最小转弯半径约束,如果不满足约束条件,即单机最小转弯半径,则删除三个航迹点的中间节点,插入满足约束的临界节点,虽然平滑算子解决了转弯半径约束的问题,但没有解决航段出现左右波动的问题,因此,接着采用滑动平均法滤波,滤波法是指通过对各航迹节点进行滤波处理,削弱波动性,滑动平均是对一定长度移动窗口的数据进行加权平均,设第k个航迹点为v(k),对其前后各i个点加权平均得u(k):
Figure GDA0002676739510000091
其中,w为常数是窗口宽度,w(j)是窗口加权函数。
步骤3)所述的规划多机协同航迹具体为:
路径总长度在无法躲避的障碍物中的路径长度是航迹规划结果的重要指标,设fij为路径在威胁区代价,Dij为路径总长度燃油消耗代价,假设共有N架无人机,每架无人机单独规划出M条备选航迹,每一架无人机的速度vi∈[vmin vmax],那么T∈[Li/vmax Li/vmin],其中Li是某架无人机的第i条航迹;对于某架无人机的M条航迹,预计到达目标的时间则是M个时间范围的并集St,那么N架无人机共同到达的时间交集S=St,1∩St,2∩...∩St,n,那么多无人机协同航迹规划的代价函数如公式(10):
J=min(λ1∑(wkfij+wDDij)+λ2T) (10)
其中,J为航路总代价值;λ1,λ2为系数;wk>0为安全代价权,wD>0为路径长度代价权;fij为安全代价;Dij为航线段的长度,作为燃油消耗的代价指标;T∈S。
参照图2,本例中的环境建模如下
某飞行高度上对无人机飞行有可能造成威胁的山峰和高地在水平截图面上的截面是圆周,则
Figure GDA0002676739510000092
其中,dTmin表示地形所允许的最靠近距离,dTmax表示地形能影响的最远距离,dT为某一时刻无人机距离地形中心轴距离。
参照图3,本例中设置随机搜索空间的航路代价值如下所示:
JL=K*[(A+B)/C]2
其中:K为常数,A为起点到路径点的距离,B为目标点带路径点的距离,C为起点到目标点的距离;
参照图4,本例中设置随机搜索空间威胁代价值如公式下所示:
JT=K/(D-d)2
其中:K为常数,D为路径上点到障碍物距离,d为绝对杀伤区的距离;
参照图5,本例中使用轮盘赌算法优先拓展概率大(适应度值高)的随机点,个体被选中的概率与其适应度函数值成正比,群体全部个体的适当度值由一张轮盘来代表设群体大小为n,个体i的适应度为Fi,则个体i被选中的概率如下所示:
Figure GDA0002676739510000101
参照图6,本例采用平滑算法与滑窗滤波相结合的形式对单机航迹进行航迹平滑处理,首先运用平滑算法,从起始点开始,每三个航迹点考虑一次最小转弯半径约束,如果不满足约束条件,即单机最小转弯半径,则删除三个航迹点的中间节点,插入满足约束的临界节点,虽然平滑算子解决了转弯半径约束的问题,但没有解决航段出现左右波动的问题,因此,接着采用滑动平均法滤波,滤波法是指通过对各航迹节点进行滤波处理,削弱波动性,滑动平均是对一定长度移动窗口的数据进行加权平均,设第k个航迹点为v(k),对其前后各i个点加权平均得u(k):
Figure GDA0002676739510000102
其中,w为常数是窗口宽度,w(j)是窗口加权函数。
参照图7和图8,设定三架无人机分别从不同位置起飞,同时到达同一终点。采用RRT算法规划多无人机协同航迹规划,如图7所示,三架无人机分别规划三条不同航迹;如图8所示,依据多无人机协同航迹规划原理和多无人机协同航迹规划代价函数,得到每一架无人机的协同航迹。
参照图9和图10,设定三架无人机分别从不同位置起飞,同时到达同一终点。采用本例采取的方案规划多无人机协同航迹规划,选取初、末速度方向为90°。如图9所示,三架无人机分别规划三条不同航迹;如图10所示,依据多无人机协同航迹规划原理和多无人机协同航迹规划代价函数,得到每一架无人机的协同航迹。
参照表1和表2,表1为实施例中的基于RRT算法的多无人机协同航迹规划协调预计到达时间、协调速度、航迹长度,表2为实施例中的基于改进PH曲线和改进RRT算法相结合的多无人机协同航迹规划协调预计到达时间、协调速度、航迹长度。
仿真结果表明:改进算法的多机协同到达时间(ETA)缩短了17.88%,UAV1航迹长度缩短了5.22%,UAV2航迹长度缩短了20.25%,UAV3航迹长度缩短了13.60%。
本例的改进算法与RRT算法仿真结果及分析:
设定三架无人机分别从不同位置起飞,同时到达同一终点。采用RRT算法规划多无人机协同航迹规划,如图7所示,三架无人机分别规划三条不同航迹;如图8所示,依据多无人机协同航迹规划原理和多无人机协同航迹规划代价函数,得到每一架无人机的协同航迹;
设定三架无人机分别从不同位置起飞,同时到达同一终点。采用本例采取的方案规划多无人机协同航迹规划,选取初、末速度方向为90°,如图9所示,三架无人机分别规划三条不同航迹;如图10所示,依据多无人机协同航迹规划原理和多无人机协同航迹规划代价函数,得到每一架无人机的协同航迹;
通过将本例的改进算法与RRT算法进行仿真对比,仿真结果表明:改进算法的多机协同到达时间(ETA)缩短了17.88%,UAV1航迹长度缩短了5.22%,UAV2航迹长度缩短了20.25%,UAV3航迹长度缩短了13.60%。如表1,2所示,具有较好的应用价值。
Figure GDA0002676739510000111
表1
Figure GDA0002676739510000112
表2

Claims (3)

1.一种基于改进RRT算法与改进PH曲线相结合的多无人机协同航迹规划方法,其特征是,包括如下步骤:
1)环境建模:假设无人机进行等高飞行,结合无人机飞行中自然威胁分布构建环境模型,自然威胁主要是山川地形威胁;
2)规划单机航迹集:首先根据起始点和终止点,运用改进PH曲线算法,得到6个控制点,分别为b0,b1,b2,b3,b4,b5;然后选取规划得到的6个控制点中的b2和b3作为新起始点和新终止点,并在新起始点和新终止点之间多次运用改进RRT算法规划得到单机航迹集,过程为:
2-1)根据任务要求的起始点和终止点,运用改进PH曲线算法,得到6个控制点,分别为b0,b1,b2,b3,b4,b5,具体为:
PH曲线贝塞尔(Bezier)形式的多项式为
Figure FDA0002676739500000011
路径r(q)的一阶导数为
Figure FDA0002676739500000012
采用艾米特(Hermite)插值法,确定基准路径的形状,起始点和终止点分别为(xs,ys)和(xf,yf),Bezier曲线的6个控制点b0,b1,b2,b3,b4,b5
Figure FDA0002676739500000021
其中:φs表示起始点方位角,φR表示无人机转弯角,φf表示终止点方位角,常数m0∈[1,+∞],常数m3∈[1,+∞],常数m5∈[1,+∞];
2-2)选取步骤2-1)得到的6个控制点中的b2和b3作为新的起始点和新的终止点,并在新的起始点和新的终止点之间运用改进RRT算法规划得到单无人机的航迹集,由于RRT算法具有随机性,所以三次运用改进RRT算法得到三条航迹集,并将三条单无人机航迹作为一个单无人机航迹集,具体为:
设置随机搜索空间的航路代价值如公式(5)所示:
JL=K*[(A+B)/C]2 (5)
其中:K为常数,A为起点到路径点的距离,B为目标点到路径点的距离,C为起点到目标点的距离;
设置随机搜索空间威胁代价值如公式(6)所示:
JT=K/(D-d)2 (6)
其中:K为常数,D为路径上点到障碍物距离,d为绝对杀伤区的距离;
设置随机点的适应度值如公式(7)所示:
Pij=1/(λ1*JL2+JT) (7)
其中:Pij表示点(i,j)的适应度值,λ1、λ2分别表示JL和JT的权重系数;
使用轮盘赌算法优先拓展概率大即适应度值高的随机点,个体被选中的概率与其适应度函数值成正比,群体全部个体的适当度值由一张轮盘来代表,设群体大小为n即有n个点,每个点代表群体中的一个群员,个体i的适应度为Fi,则个体i被选中的概率如公式(8)所示:
Figure FDA0002676739500000031
2-3)航迹平滑处理:采用平滑算法与滑窗滤波相结合的形式对单无人机航迹进行航迹平滑处理,首先运用平滑算法,从起始点开始,每三个航迹点考虑一次最小转弯半径约束,如果不满足约束条件,即单无人机最小转弯半径,则删除三个航迹点的中间节点,插入满足约束的临界节点,接着采用滑动平均法滤波,滤波法是指通过对各航迹节点进行滤波处理,削弱波动性,滑动平均是对一定长度移动窗口的数据进行加权平均,设第k个航迹点为v(k),对其前后各i个点加权平均得u(k):
Figure FDA0002676739500000032
其中,w为常数是窗口宽度,w(j)是窗口加权函数;
3)规划多机协同航迹:根据多无人机协同航迹规划原理以及多无人机协同航迹规划的代价函数,在规划航迹集中选取一条符合多无人机协同规划原理以及航迹代价函数的最小航迹。
2.根据权利要求1所述的基于改进RRT算法与改进PH曲线相结合的多无人机协同航迹规划方法,其特征是,步骤1)中所述自然威胁为:某飞行高度上对无人机飞行有可能造成威胁的山峰和高地在水平截图面上的投影截面是圆周,则
Figure FDA0002676739500000033
其中,dTmin表示地形所允许的最靠近距离,dTmax表示地形能影响的最远距离,dT为某一时刻无人机距离地形中心轴距离。
3.根据权利要求1所述的基于改进RRT算法与改进PH曲线相结合的多无人机协同航迹规划方法,其特征是,步骤3)所述的规划多机协同航迹具体为:
设fij为路径在威胁区代价,Dij为路径总长度燃油消耗代价,假设共有N架无人机,每架无人机单独规划出M条备选航迹,每一架无人机的速度vi∈[vmin vmax],那么T∈[Li/vmax Li/vmin],其中Li是某架无人机的第i条航迹;对于某架无人机的M条航迹,预计到达目标的时间则是M个时间范围的并集St,那么N架无人机共同到达的时间交集S=St,1∩St,2∩...∩St,n,那么多无人机协同航迹规划的代价函数如公式(10):
J=min(λ1∑(wkfij+wDDij)+λ2T) (10)
其中,J为航路总代价值;λ1,λ2为系数;wk>0为安全代价权,wD>0为路径长度代价权;fij为安全代价;Dij为航线段的长度,作为燃油消耗的代价指标;T∈S。
CN201710691678.2A 2017-08-14 2017-08-14 一种基于改进rrt算法与改进ph曲线相结合的多无人机协同航迹规划方法 Active CN107608372B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710691678.2A CN107608372B (zh) 2017-08-14 2017-08-14 一种基于改进rrt算法与改进ph曲线相结合的多无人机协同航迹规划方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710691678.2A CN107608372B (zh) 2017-08-14 2017-08-14 一种基于改进rrt算法与改进ph曲线相结合的多无人机协同航迹规划方法

Publications (2)

Publication Number Publication Date
CN107608372A CN107608372A (zh) 2018-01-19
CN107608372B true CN107608372B (zh) 2020-12-04

Family

ID=61065375

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710691678.2A Active CN107608372B (zh) 2017-08-14 2017-08-14 一种基于改进rrt算法与改进ph曲线相结合的多无人机协同航迹规划方法

Country Status (1)

Country Link
CN (1) CN107608372B (zh)

Families Citing this family (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108494730B (zh) * 2018-02-08 2020-11-17 西安工程大学 改进选择算子的nids多媒体包多线程择危处理方法
CN108459616B (zh) * 2018-03-07 2021-08-03 西安电子科技大学 基于人工蜂群算法的无人机群协同覆盖航路规划方法
CN108563243B (zh) * 2018-06-28 2020-11-06 西北工业大学 一种基于改进rrt算法的无人机航迹规划方法
CN109358638B (zh) * 2018-09-10 2021-07-27 南京航空航天大学 基于分布式地图的无人机视觉避障方法
CN109520507B (zh) * 2018-12-05 2021-05-07 智灵飞(北京)科技有限公司 一种基于改进rrt的无人机实时路径规划方法
CN109596136B (zh) * 2018-12-21 2020-07-07 广东嘉腾机器人自动化有限公司 基于Hermite插值路径生成方法、插入路径生成方法及存储装置
CN110108284B (zh) * 2019-05-24 2020-10-30 西南交通大学 一种顾及复杂环境约束的无人机三维航迹快速规划方法
CN110544296B (zh) * 2019-07-31 2023-05-30 中国矿业大学 一种敌方威胁不确定环境下无人机三维全局航迹智能规划方法
CN110531782A (zh) * 2019-08-23 2019-12-03 西南交通大学 用于社区配送的无人机航迹路径规划方法
CN110659771B (zh) * 2019-09-04 2022-11-22 中国航空工业集团公司沈阳飞机设计研究所 飞机协同航路规划方法
CN110617818A (zh) * 2019-10-15 2019-12-27 中国人民解放军军事科学院国防科技创新研究院 一种无人机航迹生成方法
CN111813144B (zh) * 2020-06-11 2022-02-18 南京航空航天大学 一种基于改进羊群算法的多无人机协同航路规划方法
CN112129291B (zh) * 2020-08-26 2022-04-01 南京航空航天大学 一种基于Bezier曲线的固定翼无人机航迹优化方法
CN112214037B (zh) * 2020-09-29 2021-09-17 北京大学 一种基于野外台站的无人机遥感组网航迹规划方法
CN112650306A (zh) * 2020-12-25 2021-04-13 北京理工大学 一种基于动力学rrt*的无人机运动规划方法
CN113175930B (zh) * 2021-03-22 2024-04-30 西安理工大学 基于mmea的多无人机协同航迹规划方法
CN113253744B (zh) * 2021-07-16 2021-10-01 中国科学院自动化研究所 多机器人协同轨迹规划方法、装置、电子设备和存储介质
CN113608555B (zh) * 2021-10-08 2021-12-21 广东博创佳禾科技有限公司 多无人机协同控制方法和装置
CN114442668B (zh) * 2022-01-30 2023-08-18 武汉理工大学 载体边界动态保护方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103324993A (zh) * 2013-07-15 2013-09-25 中国电子科技集团公司第二十八研究所 一种基于多飞行器协同作战的轨迹优化方法
CN104359473A (zh) * 2014-10-24 2015-02-18 南京航空航天大学 一种动态环境下无人机编队飞行的协同航迹智能规划方法
CN105867421A (zh) * 2016-05-25 2016-08-17 华中科技大学 一种基于ph曲线的无人机路径规划方法
CN105929848A (zh) * 2016-06-28 2016-09-07 南京邮电大学 一种三维环境中的多无人机系统的航迹规划方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8244469B2 (en) * 2008-03-16 2012-08-14 Irobot Corporation Collaborative engagement for target identification and tracking

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103324993A (zh) * 2013-07-15 2013-09-25 中国电子科技集团公司第二十八研究所 一种基于多飞行器协同作战的轨迹优化方法
CN104359473A (zh) * 2014-10-24 2015-02-18 南京航空航天大学 一种动态环境下无人机编队飞行的协同航迹智能规划方法
CN105867421A (zh) * 2016-05-25 2016-08-17 华中科技大学 一种基于ph曲线的无人机路径规划方法
CN105929848A (zh) * 2016-06-28 2016-09-07 南京邮电大学 一种三维环境中的多无人机系统的航迹规划方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
基于PH曲线的无人机路径规划算法;王怿等;《计算机仿真》;20130331;第30卷(第3期);76-79 *
无人机航路规划技术研究;杨力;《中国优秀硕士学位论文全文数据库 工程科技II辑》;20111215(第S2期);1-66 *

Also Published As

Publication number Publication date
CN107608372A (zh) 2018-01-19

Similar Documents

Publication Publication Date Title
CN107608372B (zh) 一种基于改进rrt算法与改进ph曲线相结合的多无人机协同航迹规划方法
Edison et al. Integrated task assignment and path optimization for cooperating uninhabited aerial vehicles using genetic algorithms
CN112733421B (zh) 一种针对有人无人机协同对地作战的任务规划方法
CN110308740B (zh) 一种面向移动目标追踪的无人机群动态任务分配方法
CN110134140B (zh) 一种环境信息未知连续状态下基于势函数奖赏dqn的无人机路径规划方法
CN110544296B (zh) 一种敌方威胁不确定环境下无人机三维全局航迹智能规划方法
Ali et al. Cooperative path planning of multiple UAVs by using max–min ant colony optimization along with cauchy mutant operator
CN110617818A (zh) 一种无人机航迹生成方法
CN109726866A (zh) 基于q学习神经网络的无人船路径规划方法
CN109357678B (zh) 一种基于异质化鸽群优化算法的多无人机路径规划方法
CN105841702A (zh) 一种基于粒子群优化算法的多无人机航路规划方法
CN108153328A (zh) 一种基于分段贝塞尔曲线的多导弹协同航迹规划方法
CN112034887A (zh) 无人机躲避柱状障碍物到达目标点的最优路径训练方法
CN111626500A (zh) 一种基于改进人工蜂群算法的路径规划方法
CN111024092A (zh) 一种多约束条件下智能飞行器航迹快速规划方法
CN105045095B (zh) 一种多无人机应急救灾任务分配方法
CN108225333B (zh) 一种用于航线规划的最优路径生成方法
CN112947594B (zh) 一种面向无人机的航迹规划方法
CN114115362B (zh) 一种基于双向apf-rrt*算法的无人机航迹规划方法
CN111813144B (zh) 一种基于改进羊群算法的多无人机协同航路规划方法
CN113848919A (zh) 一种基于蚁群算法的室内agv路径规划方法
CN111723983B (zh) 一种未知环境下无人机的时间参数化航路规划方法与系统
CN111121784A (zh) 一种无人侦察机航路规划方法
CN110930772A (zh) 一种多飞机协同航路规划方法
CN110470305A (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
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20220406

Address after: 541004 Feiyu intelligent industrial park, No. 2, CHUANGYOU Road, Qixing District, Guilin City, Guangxi Zhuang Autonomous Region

Patentee after: GUILIN FEIYU TECHNOLOGY Corp.,Ltd.

Address before: 541004 No. 15 Yucai Road, Qixing District, Guilin, the Guangxi Zhuang Autonomous Region

Patentee before: Guangxi Normal University