CN107063255B - 一种基于改进果蝇优化算法的三维航路规划方法 - Google Patents
一种基于改进果蝇优化算法的三维航路规划方法 Download PDFInfo
- Publication number
- CN107063255B CN107063255B CN201710014194.4A CN201710014194A CN107063255B CN 107063255 B CN107063255 B CN 107063255B CN 201710014194 A CN201710014194 A CN 201710014194A CN 107063255 B CN107063255 B CN 107063255B
- Authority
- CN
- China
- Prior art keywords
- axis
- formula
- aerial vehicle
- unmanned aerial
- cost
- 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
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开一种三维航路规划方法,利用通过对原始果蝇优化算法做出改进,用来求解复杂地势环境与战场威胁态势下的无人机三维航路规划,在考虑复杂态势与无人机性能约束的前提下,为无人机计算出最优或次优三维飞行航路。
Description
技术领域
本发明属于机器人技术领域,尤其涉及一种基于改进果蝇优化算法的三维航路规划方法。
背景技术
航路规划是无人机自主控制的关键组成部分,航路规划算法的目标是在为无人机计算出最优或次最优的飞行路线,这个飞行路线能使无人机躲开复杂地形障碍并突防敌方武器威胁,在以较短的时间到达目标点的同时自我生存。无人机三维航路规划问题属于多目标、多约束的复杂优化问题,通常具有如下特点:1)评价航路性能的指标很多,构成的目标函数难以计算;2)战场环境情况复杂且动态变化;3)无人机自身性能约束条件较多;4)事先已知的信息量不全,而且可能发生变化;5)优化变量多,搜索空间往往具有维数***的特点;6)机上设备有限,允许存储的信息量较少并且机载计算机计算速度有限。因此,无人机航路规划的一个关键挑战就是如何处理无人机自身物理特性带来的多种复杂约束,克服变量过多带来的维数***问题,并在较短时间内快速的得出满足各种限制条件且性能指标接近最优的航路。
国内外求解无人机航路规划问题的方法大体可以分为传统规划算法和智能规划算法。其中,传统规划算法有动态规划法、以Voronoi图为代表的基于图形的方法、以A星算法为代表的基于栅格的方法等;智能规划方法有神经网络方法、人工势场方法、进化计算及群体智能方法等。从这些规划算法的特点和航路规划问题的要求来看,以进化计算及群体智能为代表的人工智能技术,已成为求解无人机航路规划问题的发展趋势,包括遗传算法(genetic algorithm,GA)、微粒群算法(particle swarm optimization,PSO)、蚁群优化算法(ant colony optimization,ACO)、人工蜂群算法(artificial bee colony,ABC)、微分进化算法(differential evolution,DE)、万有引力算法(gravitational searchalgorithm,GSA)、智能水滴算法(intelligent water drops,IWD)、生物地理优化(biogeography-based optimization,BBO)以及Memetic算法等。尽管这些航路规划技术正进一步向智能化、实用化方向发展,但仍各自存在着诸多问题。例如,A星算法搜索空间需求太大,计算时间过长;神经网络算法收敛速度慢,得到的航路可能只是局部最优解而非全局最优;人工势场法的收敛速度都具有较大的不确定性,收敛速度受地形轮廓影响较大;进化计算及群体智能方法的控制参数难于选择,性能不稳定、随机性较强,容易出现过早收敛和停滞现象。因此,现有的方法均没能真正有效地从实际意义上解决无人机三维航路规划问题,需要进一步发展更加优越的规划方法
果蝇优化算法(Fruit fly optimization algorithm,FOA)一种基于果蝇觅食行为的启发式全局最优化算法。果蝇在感官知觉,尤其是嗅觉与视觉上,优于其他物种。果蝇的嗅觉器官能够很好的搜集到空气中的各种气味,甚至能嗅到很远距离以外的食物源。当果蝇靠近食物位置后,能够使用敏锐的视觉器官发现食物的具***置与同伴的聚集位置,并且朝该方向飞去。与其它群体智能算法相比,果蝇优化算法的步骤更加简单,在编程时只需要很少的程序语句便可描述出核心算法程序。但是原始的果蝇优化算法存在着编码方式适用性限制多、易陷于局部最优等缺点,因此在应用果蝇优化算法解决三维航路规划问题时需要对原始算法进行改进。本发明针对无人机自身特点,在对原始果蝇优化算法进行改进的基础上,设计用于求解无人机三维航路规划问题的计算方法。与现有航路规划方法相比,本发明所提出的方法更加简单高效、计算速度快。与原始果蝇优化算法相比,本发明提出的方法更加稳定,得到的航路具有更优的代价值。该方法是解决复杂战场态势下无人机三维航路规划的有效技术途径,也可应用于地面机器人路径规划、城市交通规划等技术领域。
发明内容
本发明的目的是提供一种基于改进果蝇优化算法的三维航路规划方法,在考虑复杂态势与无人机性能约束的前提下,为无人机计算出最优或次优三维飞行航路。
为实现上述目的,本发明采用如下的技术方案:
一种基于改进果蝇优化算法的三维航路规划方法,首先确定无人机飞行任务信息,包括起点坐标(xS,yS,zS)T和终点坐标(xT,yT,zT)T,任务地图边界,需要规划出的航路控制点个数n;确定敌方地面武器信息,包括威胁类型(雷达、导弹、高炮),武器位置(xthreat j,ythreat j)T,以及各自的威胁范围;设定改进果蝇算法的相关参数,包括最大迭代次数Gmax,嗅觉搜索次数Mosp,以及变异概率Pm,其包括以下步骤:
步骤一:设迭代次数NC=1,随机初始化相位角向量Θaxis=[θaxis,1,Λ,θaxis,D],其中每一维相位角取值都在[-π/2,π/2]内,且D=3n,并设定相应的初始味道浓度判定值Smellaxis=+∞;
步骤二:按照如下公式计算果蝇的搜索半径
步骤三:执行果蝇嗅觉搜索操作,令i=1,j=1;
步骤四:在0到1区间上随机产生一个实数rj,若rj<Pm,则转步骤五;若rj≥Pm,则转步骤六;
步骤七:计算此次嗅觉搜索的味道浓度判定值如下
其中,Smax,j和Smin,j分别为搜索空间的上下边界;
步骤八:令j=j+1,若j≤D,则转到步骤五,否则,转到步骤十;
步骤九:利用航路起点和终点,以及向量[Si,j,Si,n+j,Si,2n+j]生成完整的航路PUAV,i;
步骤十一:令i=i+1,若i≤Mosp,则令j=1,并转到步骤四;否则,转到步骤十二;
步骤十四:更新迭代次数NC=NC+1,若迭代次数NC≤Gmax,则转到步骤二;若迭代次数NC>Gmax,则将Θaxis转换为Saxis=[Saxis,1,Saxis,2,Λ,Saxis,D],进而生成无人机飞行航路,并输出最终的规划结果。
作为优选,对果蝇的位置采用的是相位角编码方式,即用相位角向量Θaxis=[θaxis,1,θaxis,2,Λ,θaxis,D]来表示果蝇所处的位置,每一维上的相位角均在区间[-π/2,π/2]上。用Smin,表示规划空间的上下边界,采用从相位角空间到航路搜索空间的单调映射关系,对果蝇位置的味道浓度判定值Saxis=[Saxis,1,Saxis,2,Λ,Saxis,D]进行计算:
Saxis=((Smax-Smin)sinΘaxis+Smax+Smin,)/2 (3)
作为优选,在步骤九和步骤十四中所述生成无人机航路的方式,其详细描述及计算方式如下:
设果蝇位置浓度判定值向量为[S1,S2,Λ,SD],利用该向量确定出为控制点w1,w2,…,wn,其中每个控制点的三维坐标为wj=(Xj,Yj,Zj)T=(Sj,Sn+j,S2n+j)T。另外,取任务起点为控制点w0,终点为控制点wn+1。
将无人机航路表示为N+2个离散点的集合PUAV:{p0,p1,p2,Λ,pN,pN+1},其中p0和pN+1分别表示任务起点与终点,且每一个航路点pk的三维坐标为(xk,yk,zk)T。利用控制点wi,i=1,2…,n+2,计算航路点pk坐标的方式如下:
式中,Bi,K(k)为航路弯曲函数,由下式确定:
且
Knot(i)=0,若i<K
Knot(i)=i-K+1,若K≤i≤n+1 (6)
Knot(i)=n-K+3,若n<i-1
式中,K为航路的阶次,表征了航路的平滑度;参数k以固定的步长从0变化到n-K+3。
作为优选,在步骤十中所述的航路代价值J(PUAV),考虑航路长度、飞行高度、敌方武器威胁、地图限制、转弯角限制、爬升/下滑限制、地形限制等,其计算过程如下:
式中,fi,i=1,2,Λ,7分别为航路长度代价JL,飞行高度代价JH,威胁代价JT,任务地图溢出代价Jmap,转弯代价Jturn,爬升/下滑代价JS,地形代价Jter。
其中,
JL是整条飞行航路的长度,通过下式进行计算:
JH为飞行高度沿航路的积分,通过下式进行计算:
JT为各个航路段受到敌方威胁程度的总和,通过下式进行计算:
式中,Pj,k为第j个地面武器对航路段pkpk+1造成的威胁概率,计算方式如下:
若地面武器为雷达,则威胁概率如下
式中,αz=sinψe,βz=cosψe,αφ=sinφe,βφ=cosφe,其中ψe为无人机运动方向与其相对于雷达的位置矢量之间的夹角,φe=φ-arctan(tanθ/sinψ)且φ、θ、ψ分别为无人机的位置相对于雷达的滚转角、仰角、方位角。
若地面武器为地空导弹,则威胁概率如下
式中,RMmax为地空导弹的最大打击范围,d为无人机到导弹中心的距离。
若地面武器为高炮,则威胁概率如下
式中,RG和RGmax分别为高炮的有效打击范围和最大打击范围,d为无人机和防空高炮之间的水平距离。
Jmap为任务地图溢出代价,通过下式进行计算:
Jturn为航路转弯代价,通过下式进行计算:
JS为爬升/下滑代价,通过下式进行计算:
式中,
Jter为地形代价,通过下式进行计算:
式中,Hsafe为无人机距地面的最小安全飞行高度,Hter(xk,yk)为第k个航路点处的地面高度。
本发明的有益如下:
本发明提出了一种基于改进果蝇优化算法的三维航路规划方法,该方法控制参数少,更加简单且易于实现,无论使用何种编程语言,核心算法程序都仅需要少数的代码语句便可完成期望的计算。在果蝇的嗅觉搜索过程引入了变异适应操作,有利于果蝇从最优个体解中继承优秀的元素。同时,在算法中设定果蝇嗅觉搜索范围随着迭代的进行而逐渐缩小,从而提高算法的收敛能力。本发明所提出的这种基于改进果蝇优化算法的三维航路规划方法增加了航路搜索的多样性,既提高了算法的收敛速度,又克服了陷于局部最优的缺点,提高了获得最优航路解的概率。该航路规划方法使无人机能突破敌方地面武器的威胁,在满足自身与环境限制的同时能以较短时间到达任务终点。本发明能够有效地解决无人机三维航路规划问题,也可用于其它多维函数优化问题。
附图说明
图1为相位角映射函数曲线;
图2果蝇嗅觉搜索范围随迭代次数变化的曲线;
图3改进果蝇优化算法的流程图;
图4本发明所提方法得到的无人机飞行航路的三维视图;
图5本发明所提方法得到的无人机飞行航路的俯视图;
图6本发明所提方法得到的无人机飞行航路的高度随航路长度的变化曲线;
图7本发明所提方法的航路代价进化曲线与原始果蝇算法的对比;
图中标号及符号说明如下:
S——果蝇的味道浓度判定值
θ——相位角
Gmax——最大迭代次数
NC——当前计算迭代
RNC——第NC次计算迭代的果蝇嗅觉搜索半径
i——第i次嗅觉搜索
j——第j维的变量
D——变量维数
rand——0到1区间上的随机数
Pm——变异概率
Θaxis——果蝇位置
Smellaxis——果蝇位置的味道浓度值
Mosp——果蝇最大嗅觉搜索次数
具体实施方式
本发明实施例提供一种基于改进果蝇优化算法的三维航路规划方法,利用通过对原始果蝇优化算法做出改进,用来求解复杂地势环境与战场威胁态势下的无人机三维航路规划,其步骤如下。
预备工作:
确定无人机飞行任务信息,包括起点坐标(xS,yS,zS)T和终点坐标(xT,yT,zT)T,任务地图边界,需要规划出的航路控制点个数n;
确定敌方地面武器信息,包括威胁类型(雷达、导弹、高炮),武器位置(xthreat j,ythreat j)T,以及各自的威胁范围。
设定改进果蝇算法的相关参数,包括最大迭代次数Gmax,嗅觉搜索次数Mosp,以及变异概率Pm。
步骤一:设迭代次数NC=1,随机初始化相位角向量Θaxis=[θaxis,1,Λ,θaxis,D],其中每一维相位角取值都在[-π/2,π/2]内,且D=3n,并设定相应的初始味道浓度判定值Smellaxis=+∞。
步骤二:按照如下公式计算果蝇的搜索半径
步骤三:执行果蝇嗅觉搜索操作,令i=1,j=1。
步骤四:在0到1区间上随机产生一个实数rj,若rj<Pm,则转步骤五;若rj≥Pm,则转步骤六。
步骤七:计算此次嗅觉搜索的味道浓度判定值如下
其中,Smax,j和Smin,j分别为搜索空间的上下边界。
步骤八:令j=j+1,若j≤D,则转到步骤五,否则,转到步骤十。
步骤九:利用航路起点和终点,以及向量[Si,j,Si,n+j,Si,2n+j]生成完整的航路PUAV,i。
步骤十一:令i=i+1,若i≤Mosp,则令j=1,并转到步骤四;否则,转到步骤十二。
步骤十四:更新迭代次数NC=NC+1,若迭代次数NC≤Gmax,则转到步骤二;若迭代次数NC>Gmax,则将Θaxis转换为Saxis=[Saxis,1,Saxis,2,Λ,Saxis,D],进而生成无人机飞行航路,并输出最终的规划结果。
其中,上述算法步骤中对果蝇的位置采用的是相位角编码方式,即用相位角向量Θaxis=[θaxi,s1,θaxi,s2,Λ,θaxi,sD]来表示果蝇所处的位置,每一维上的相位角均在区间[-π/2,π/2]上。用Smin,表示规划空间的上下边界,采用附图1所示的从相位角空间到航路搜索空间的单调映射关系,对果蝇位置的味道浓度判定值Saxis=[Saxis,1,Saxis,2,Λ,Saxis,D]进行计算:
Saxis=((Smax-Smin)sinΘaxis+Smax+Smin,)/2 (22)
其中,在步骤一中所述的随机初始化,是指在算法的初始化阶段,将果蝇的相位角Θaxis=[θaxi,s1,θaxi,s2,Λ,θaxi,sD]在[-π/2,π/2]上随机取值,按照下式进行计算:
θaxis,j=random(-π/2,π/2),j=1,2,Λ,D (23)
式中的random(·)表示在区间内按照均匀分布选取的随机实数。
其中,在步骤二中所述果蝇的搜索半径RNC,随迭代次数的增加而逐渐缩小,如附图2所示。
其中,在步骤九和步骤十四中所述生成无人机航路的方式,其详细描述及计算方式如下:
记算法得到的果蝇位置浓度判定值向量为[S1,S2,Λ,SD],利用该向量确定出为控制点w1,w2,…,wn,其中每个控制点的三维坐标为wj=(Xj,Yj,Zj)T=(Sj,Sn+j,S2n+j)T。另外,取任务起点为控制点w0,终点为控制点wn+1。
将无人机航路表示为N+2个离散点的集合PUAV:{p0,p1,p2,Λ,pN,pN+1},其中p0和pN+1分别表示任务起点与终点,且每一个航路点pk的三维坐标为(xk,yk,zk)T。利用控制点wi,i=1,2…,n+2,计算航路点pk坐标的方式如下:
式中,Bi,K(k)为航路弯曲函数,由下式确定:
且
Knot(i)=0,若i<K
Knot(i)=i-K+1,若K≤i≤n+1 (26)
Knot(i)=n-K+3,若n<i-1
式中,K为航路的阶次,表征了航路的平滑度;参数k以固定的步长从0变化到n-K+3。
其中,在步骤十中所述的航路代价值J(PUAV),考虑航路长度、飞行高度、敌方武器威胁、地图限制、转弯角限制、爬升/下滑限制、地形限制等,其计算过程如下:
式中,fi,i=1,2,Λ,7分别为航路长度代价JL,飞行高度代价JH,威胁代价JT,任务地图溢出代价Jmap,转弯代价Jturn,爬升/下滑代价JS,地形代价Jter。
其中,
JL是整条飞行航路的长度,通过下式进行计算:
JH为飞行高度沿航路的积分,通过下式进行计算:
式中,zp为航路点p的绝对高度,Hter(zp)为航路点p下方的地面高度。
JT为各个航路段受到敌方威胁程度的总和,通过下式进行计算:
式中,Pj,k为第j个地面武器对航路段pkpk+1造成的威胁概率,计算方式如下:
若地面武器为雷达,则威胁概率如下
式中,αz=sinψe,βz=cosψe,αφ=sinφe,βφ=cosφe,其中ψe为无人机运动方向与其相对于雷达的位置矢量之间的夹角,φe=φ-arctan(tanθ/sinψ)且φ、θ、ψ分别为无人机的位置相对于雷达的滚转角、仰角、方位角。
若地面武器为地空导弹,则威胁概率如下
式中,RMmax为地空导弹的最大打击范围,d为无人机到导弹中心的距离。
若地面武器为高炮,则威胁概率如下
式中,RG和RGmax分别为高炮的有效打击范围和最大打击范围,d为无人机和防空高炮之间的水平距离。
Jmap为任务地图溢出代价,通过下式进行计算:
Jturn为航路转弯代价,通过下式进行计算:
JS为爬升/下滑代价,通过下式进行计算:
式中,
Jter为地形代价,通过下式进行计算:
式中,Hsafe为无人机距地面的最小安全飞行高度,Hter(xk,yk)为第k个航路点处的地面高度。
下面通过一个具体实例描述本发明所提基于改进果蝇优化算法的三维航路规划方法的实施方式,并验证本发明所提方法的性能。实例所用计算软件为MATLAB 2009a,具体实施流程如附图3所示,详细实施步骤如下(步骤中的长度单位均为km)。
确定无人机飞行任务信息:起点坐标(5,10,zS)和终点坐标(85,85,zT),任务地图边界,需要规划出的航路控制点个数n=5,其中的zS和zT分别为起点和终点处的地面高度。
确定敌方地面武器信息:高炮武器位置坐标(45,45),威胁范围9;两个导弹武器位置坐标分别为(35,70)和(20,41),威胁范围均为8;两个雷达位置坐标分别为(40,25)和(75,60),威胁范围均为15.
设定改进果蝇算法的相关参数:最大迭代次数Gmax=400,嗅觉搜索次数Mosp=40,变异概率Pm=0.9.
步骤一:设迭代次数NC=1,按照公式θaxis,j=random(-π/2,π/2),j=1,2,Λ,D随机生成初始的相位角向量Θaxis=[θaxis,1,Λ,θaxis,D],使得向量中的每一维相位角取值都在[-π/2,π/2]内,且向量维数D=3n=15,并设定相应的初始味道浓度判定值Smellaxis=+∞。
步骤二:按照如下公式计算果蝇的搜索半径
步骤三:执行果蝇嗅觉搜索操作,令i=1,j=1。
步骤四:在0到1区间上随机产生一个实数rj,若rj<Pm,则转步骤五;若rj≥Pm,则转步骤六。
步骤七:计算此次嗅觉搜索的味道浓度判定值如下
其中,Smax,j和Smin,j分别为任务地图的上下边界。
步骤八:令j=j+1,若j≤D,则转到步骤五,否则,转到步骤十。
步骤九:令w0坐标为航路起点坐标,即w0=(X0,Y0,Z0)=(xS,yS,zS),
wn+1坐标为航路终点坐标,即wn+1=(Xn+1,Yn+1,Zn+1)=(xT,yT,zT),
利用点列w0,w1,w2,…,wn+1,通过下面的公式计算出航路点pk的三维坐标(xk,yk,zk)T,
式中,取K=3,参数k以固定的步长从0变化到n-K+3,且
且
Knot(i)=0,若i<K
Knot(i)=i-K+1,若K≤i≤n+1
Knot(i)=n-K+3,若n<i-1
通过上述计算,得出完整的无人机航路点序列PUAV,j:{p0,p1,p2,Λ,pN,pN+1}。
通过下式进行计算出航路的长度代价JL:
通过下式计算出航路的飞行高度代价JH:
式中,zp为航路点p的绝对高度,Hter(zp)为航路点p下方的地面高度。
通过下式计算各个航路段受到敌方威胁程度的总和JT:
式中,nT=5为地面武器威胁的个数,Pj,1和Pj,2为两个雷达武器对航路段pkpk+1造成的威胁概率,计算方式如下:
式中,αz=sinψe,βz=cosψe,αφ=sinφe,βφ=cosφe,其中ψe为无人机运动方向与其相对于雷达的位置矢量之间的夹角,φe=φ-arctan(tanθ/sinψ)且φ、θ、ψ分别为无人机的位置相对于雷达的滚转角、仰角、方位角。
Pj,3和Pj,4为两个导弹武器对航路段pkpk+1造成的威胁概率,计算方式如下:
式中,k=3,4,Rkmax为地空导弹的最大打击范围,d为无人机到导弹中心的距离。
Pj,5高炮武器对航路段pkpk+1造成的威胁概率,计算方式如下:
式中,k=5,Rk和Rkmax分别为高炮的有效打击范围和最大打击范围,d为无人机和防空高炮之间的水平距离。
通过下式计算航路的任务地图溢出代价Jmap,:
通过下式计算航路转弯代价Jturn:
通过下式计算航路的爬升/下滑代价JS:
式中,
通过下式航路的地形代价Jter:
式中,Hsafe=0.03km,Hter(xk,yk)为第k个航路点处的地面高度,通过任务地图的地形数据得到。
综合上面的航路代价值,计算PUAV,i的总的代价如下:
J(PUAV,i)=JL+JH+JT+Jmap+Jturn+JS+Jter
步骤十一:令i=i+1,若i≤Mosp,则令j=1,并转到步骤四;否则,转到步骤十二。
步骤十四:更新迭代次数NC=NC+1,若迭代次数NC≤Gmax,则转到步骤二;若迭代次数NC>Gmax,则将Θaxis转换为Saxis=[Saxis,1,Saxis,2,Λ,Saxis,D],进而生成无人机飞行航路,并输出最终的规划结果。
附图4显示了通过上述计算步骤得到的无人机航路的三维立体视图,附图5为无人机航路的俯视图,其中同心圆为敌方地面武器的威胁范围,附图6为得到的航路高度随着航路长度的变化情况。从结果图中可以看出,本发明所提算法得到的航路成功地绕开了所有威胁,为无人机规划出一条平滑有效的飞行路径。附图7为计算过程中得到的最优航路代价值随迭代次数变化的曲线,图中将本发明所提的改进果蝇算法与原始的果蝇算法进行了对比,显示出本发明所提算法的收敛速度、优化能力上均优于原始算法。
本发明所提基于改进果蝇优化算法的三维航路规划方法为无人机战场航路规划问题提供了解决方案,同时也为高维函数优化问题提供了非常有效的途径,可广泛应用于机器人、航空、航天、工业生产等涉及高维函数优化问题的领域。
Claims (4)
1.一种基于改进果蝇优化算法的三维航路规划方法,其特征在于,首先确定无人机飞行任务信息,包括起点坐标(xS,yS,zS)T和终点坐标(xT,yT,zT)T,任务地图边界,需要规划出的航路控制点个数n;确定敌方地面武器信息,包括威胁类型,其为:雷达、导弹、高炮,武器位置(xthreatj,ythreatj)T,以及各自的威胁范围;设定改进果蝇算法的相关参数,包括最大迭代次数Gmax,嗅觉搜索次数Mosp,以及变异概率Pm,其包括以下步骤:
步骤一:设迭代次数NC=1,随机初始化相位角向量Θaxis=[θaxis,1,…,θaxis,D],其中,每一维相位角取值都在[-π/2,π/2]内,且D=3n,并设定相应的初始味道浓度判定值Smellaxis=+∞,其中,θaxis,j,j=1,2,…,D代表果蝇位置浓度判定值向量Saxis的第j维分量Saxis,j所对应的相位角;
步骤二:按照如下公式计算果蝇的搜索半径
步骤三:执行果蝇嗅觉搜索操作,令i=1,j=1;
步骤四:在0到1区间上随机产生一个实数rj,若rj<Pm,则转步骤五;若rj≥Pm,则转步骤六;
步骤七:计算此次嗅觉搜索的味道浓度判定值如下
其中,Smax,j和Smin,j分别为搜索空间的上下边界;
步骤八:令j=j+1,若j≤D,则转到步骤五,否则,转到步骤十;
步骤十一:令i=i+1,若i≤Mosp,则令j=1,并转到步骤四;否则,转到步骤十二;
步骤十四:更新迭代次数NC=NC+1,若迭代次数NC≤Gmax,则转到步骤二;若迭代次数NC>Gmax,则将Θaxis转换为Saxis=[Saxis,1,Saxis,2,…,Saxis,D],进而生成无人机飞行航路,并输出最终的规划结果,其中,Saxis,1,Saxis,2,…,Saxis,D代表果蝇位置浓度判定值向量Saxis在各个维度上的分量。
3.如权利要求1所述的基于改进果蝇优化算法的三维航路规划方法,其特征在于,在步骤九和步骤十四中所述生成无人机航路的方式,其详细描述及计算方式如下:
设果蝇位置浓度判定值向量为[S1,S2,…,SD],利用该向量确定出为控制点w1,w2,…,wn,其中每个控制点的三维坐标为wj=(Xj,Yj,Zj)T=(Sj,Sn+j,S2n+j)T,另外,取任务起点为控制点w0,终点为控制点wn+1;
将无人机航路表示为N+2个离散点的集合PUAV:{p0,p1,p2,…,pN,pN+1},其中p0和pN+1分别表示任务起点与终点,且每一个航路点pk的三维坐标为(xk,yk,zk)T,利用控制点wi,i=1,2…,n+2,计算航路点pk坐标的方式如下:
式中,Bi,K(k)为航路弯曲函数,由下式确定:
且
式中,K为航路的阶次,表征了航路的平滑度;参数k以固定的步长从0变化到n-K+3。
4.如权利要求1所述的基于改进果蝇优化算法的三维航路规划方法,其特征在于,在步骤十中所述的航路代价值J(PUAV),考虑航路长度、飞行高度、敌方武器威胁、地图限制、转弯角限制、爬升/下滑限制、地形限制,其计算过程如下:
式中,fi,i=1,2,…,7分别为航路长度代价JL,飞行高度代价JH,威胁代价JT,任务地图溢出代价Jmap,转弯代价Jturn,爬升/下滑代价JS,地形代价Jter;
其中,
JL是整条飞行航路的长度,通过下式进行计算:
JH为飞行高度沿航路的积分,通过下式进行计算:
式中,zp为航路点p的绝对高度,Hter(zp)为航路点p下方的地面高度,
JT为各个航路段受到敌方威胁程度的总和,通过下式进行计算:
式中,Pj,k为第j个地面武器对航路段pkpk+1造成的威胁概率,计算方式如下:
若地面武器为雷达,则威胁概率如下
式中,αz=sinψe,βz=cosψe,αφ=sinφe,βφ=cosφe,其中ψe为无人机运动方向与其相对于雷达的位置矢量之间的夹角,φe=φ-arctan(tanθ/sinψ)且φ、θ、ψ分别为无人机的位置相对于雷达的滚转角、仰角、方位角;a、b、c分别为无人机相对于雷达在滚转、俯仰、方位三个姿态上的散射截面权重;
若地面武器为地空导弹,则威胁概率如下
式中,RMmax为地空导弹的最大打击范围,d为无人机到导弹中心的距离,
若地面武器为高炮,则威胁概率如下
式中,RG和RGmax分别为高炮的有效打击范围和最大打击范围,d为无人机和防空高炮之间的水平距离;
Jmap为任务地图溢出代价,通过下式进行计算:
Jturn为航路转弯代价,通过下式进行计算:
式中,表示在航路点pk处的转弯角,且nmax为无人机最大横向过载,V为无人机飞行速度,g为重力加速度;当航路满足转弯角度的约束时,Jturn取值为0;当航路不能满足转弯角度的约束时,Jturn的取值会很大,
JS为爬升/下滑代价,通过下式进行计算:
式中,
Jter为地形代价,通过下式进行计算:
式中,Hsafe为无人机距地面的最小安全飞行高度,Hter(xk,yk)为第k个航路点处的地面高度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710014194.4A CN107063255B (zh) | 2017-01-09 | 2017-01-09 | 一种基于改进果蝇优化算法的三维航路规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710014194.4A CN107063255B (zh) | 2017-01-09 | 2017-01-09 | 一种基于改进果蝇优化算法的三维航路规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107063255A CN107063255A (zh) | 2017-08-18 |
CN107063255B true CN107063255B (zh) | 2020-10-30 |
Family
ID=59624505
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710014194.4A Active CN107063255B (zh) | 2017-01-09 | 2017-01-09 | 一种基于改进果蝇优化算法的三维航路规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107063255B (zh) |
Families Citing this family (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109541960B (zh) * | 2017-09-21 | 2022-06-10 | 成都紫瑞青云航空宇航技术有限公司 | 一种用于飞行器数字化战场对抗的***和方法 |
CN108387232B (zh) * | 2018-01-30 | 2021-08-03 | 河北科技大学 | 基于人工势场的进化算法的飞行物航迹规划方法 |
CN111047019B (zh) * | 2018-10-12 | 2022-09-23 | 兰州交通大学 | 一种基于改进脉冲耦合神经网络的网络加权Voronoi图构建方法 |
CN109947136B (zh) * | 2019-02-28 | 2020-07-10 | 清华大学 | 一种面向无人机群体快速目标搜索的协同主动感知方法 |
CN110084390B (zh) * | 2019-03-26 | 2024-01-12 | 河南科技学院 | 一种基于改进型果蝇算法的多车协同拼车路径优化方法 |
CN109901402B (zh) * | 2019-04-08 | 2021-10-29 | 哈尔滨工程大学 | 一种基于航向平滑技术的自主水下机器人路径跟踪方法 |
CN110544157A (zh) * | 2019-09-04 | 2019-12-06 | 北京三快在线科技有限公司 | 乘车位置推荐方法、装置、电子设备及存储介质 |
CN110836670B (zh) * | 2019-11-14 | 2021-08-20 | 北京工业大学 | 一种求解无人机约束航路规划的混合烟花粒子群协同方法 |
CN110930772A (zh) * | 2019-12-05 | 2020-03-27 | 中国航空工业集团公司沈阳飞机设计研究所 | 一种多飞机协同航路规划方法 |
CN111024085B (zh) * | 2019-12-18 | 2020-10-16 | 四川大学 | 一种具有端点方向和时间约束的无人机航迹规划方法 |
CN110986958B (zh) * | 2019-12-24 | 2021-11-26 | 北京工业大学 | 基于多种群协作果蝇优化的多无人机协同路径规划方法 |
CN111256681B (zh) * | 2020-05-07 | 2020-08-11 | 北京航空航天大学 | 一种无人机群路径规划方法 |
CN112327939B (zh) * | 2020-10-15 | 2024-04-12 | 广东工业大学 | 一种城市街区环境下高层消防多无人机协同路径规划方法 |
CN113551682B (zh) * | 2021-07-19 | 2022-07-08 | 大连理工大学 | 一种考虑地形与地势影响的两栖无人战车的路径规划方法 |
CN113495564A (zh) * | 2021-07-30 | 2021-10-12 | 中国人民解放军陆军装甲兵学院 | 一种基于进化型果蝇算法的地面无人平台路径规划方法 |
CN115440091B (zh) * | 2022-11-03 | 2023-07-04 | 成都沃飞天驭科技有限公司 | 航路切换视景显示方法、装置、飞行器及存储介质 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102506863A (zh) * | 2011-11-07 | 2012-06-20 | 北京航空航天大学 | 一种基于万有引力搜索的无人机航路规划方法 |
CN105841702A (zh) * | 2016-03-10 | 2016-08-10 | 赛度科技(北京)有限责任公司 | 一种基于粒子群优化算法的多无人机航路规划方法 |
CN105972185A (zh) * | 2016-07-10 | 2016-09-28 | 北京工业大学 | 基于果蝇优化算法的摆线轮工作齿廓计算方法 |
-
2017
- 2017-01-09 CN CN201710014194.4A patent/CN107063255B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102506863A (zh) * | 2011-11-07 | 2012-06-20 | 北京航空航天大学 | 一种基于万有引力搜索的无人机航路规划方法 |
CN105841702A (zh) * | 2016-03-10 | 2016-08-10 | 赛度科技(北京)有限责任公司 | 一种基于粒子群优化算法的多无人机航路规划方法 |
CN105972185A (zh) * | 2016-07-10 | 2016-09-28 | 北京工业大学 | 基于果蝇优化算法的摆线轮工作齿廓计算方法 |
Non-Patent Citations (2)
Title |
---|
On the performance comparison of multi-objective evolutionary UAV path planners;Eva Besada-Portas 等;《Information Sciences》;20130226;第238卷;全文 * |
基于果蝇优化算法的月球车全局路径规划;毛正阳 等;《电子设计工程》;20141231;第22卷(第23期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN107063255A (zh) | 2017-08-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107063255B (zh) | 一种基于改进果蝇优化算法的三维航路规划方法 | |
Huang et al. | UAV path planning based on particle swarm optimization with global best path competition | |
CN108168381B (zh) | 一种多枚导弹协同作战的控制方法 | |
CN110031004B (zh) | 基于数字地图的无人机静态和动态路径规划方法 | |
Zhang et al. | An improved constrained differential evolution algorithm for unmanned aerial vehicle global route planning | |
CN111240353B (zh) | 基于遗传模糊树的无人机协同空战决策方法 | |
CN114413906B (zh) | 一种基于改进粒子群优化算法的三维轨迹规划方法 | |
CN107168380B (zh) | 一种基于蚁群算法的无人机群区域覆盖的多步寻优方法 | |
CN108153328B (zh) | 一种基于分段贝塞尔曲线的多导弹协同航迹规划方法 | |
CN109144102A (zh) | 一种基于改进蝙蝠算法的无人机航路规划方法 | |
CN112666981B (zh) | 基于原鸽群动态群组学习的无人机集群动态航路规划方法 | |
CN108919818B (zh) | 基于混沌种群变异pio的航天器姿态轨道协同规划方法 | |
Li et al. | Deep reinforcement learning with application to air confrontation intelligent decision-making of manned/unmanned aerial vehicle cooperative system | |
CN110986958B (zh) | 基于多种群协作果蝇优化的多无人机协同路径规划方法 | |
CN111750869A (zh) | 一种实时重构Voronoi图的无人机路径规划方法 | |
CN105512769A (zh) | 基于遗传规划的无人机航迹规划***及方法 | |
CN113268081B (zh) | 一种基于强化学习的小型无人机防控指挥决策方法及*** | |
CN110928329A (zh) | 一种基于深度q学习算法的多飞行器航迹规划方法 | |
CN114330115B (zh) | 一种基于粒子群搜索的神经网络空战机动决策方法 | |
CN114840020A (zh) | 一种基于改进鲸鱼算法的无人机飞行轨迹规划方法 | |
CN114492805A (zh) | 一种基于模糊推理的空战机动决策设计方法 | |
CN113625569B (zh) | 一种基于混合决策模型的小型无人机防控决策方法及*** | |
CN112824998A (zh) | 马尔可夫决策过程的多无人机协同航路规划方法和装置 | |
CN112733251A (zh) | 一种多无人飞行器协同航迹规划方法 | |
CN114777789A (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 |