云南旅游网站建设,爱做网址,wordpress段子,友情链接外链基于粒子群算法的无人机航迹规划 文章目录 基于粒子群算法的无人机航迹规划1.粒子群搜索算法2.无人机飞行环境建模3.无人机航迹规划建模4.实验结果4.1地图创建4.2 航迹规划 5.参考文献6.Matlab代码 摘要#xff1a;本文主要介绍利用粒子群算法来优化无人机航迹规划。 1.粒子群…基于粒子群算法的无人机航迹规划 文章目录 基于粒子群算法的无人机航迹规划1.粒子群搜索算法2.无人机飞行环境建模3.无人机航迹规划建模4.实验结果4.1地图创建4.2 航迹规划 5.参考文献6.Matlab代码 摘要本文主要介绍利用粒子群算法来优化无人机航迹规划。 1.粒子群搜索算法
粒子群算法原理请参考网络博客
2.无人机飞行环境建模
? 环境模型的建立是考验无人机是否可以圆满完成人类所赋予各项任务的基 础和前提其中第一步便是如何描述规划空间中的障碍物。首先我们将采取函数模拟法模拟地貌特征。其函数表达式为 z ( x , y ) s i n ( y a ) b s i n ( x ) c c o s ( d y 2 x 2 ) e c o s ( y ) f s i n ( f y 2 x 2 ) g c o s ( y ) (1) z(x,y)sin(ya)bsin(x)ccos(d\sqrt{y^2x^2})ecos(y)fsin(f\sqrt{y^2x^2})gcos(y)\tag{1} z(x,y)sin(ya)bsin(x)ccos(dy2x2 )ecos(y)fsin(fy2x2 )gcos(y)(1) 其中 ( x , y ) (x, y) (x,y) 为地形上某点投影在水平面上的点坐标 z z z 则为对应点坐标的高度。式中 a , b , c , d , e , f , g a, b, c, d, e, f , g a,b,c,d,e,f,g 是常系数想要得到不同的地貌特征可以通过改变其常系数的大小以上建模是作为环境模型的基准地形信息。但为了得到障碍区域我们还需要在这个基准地形上叠加山峰模型这样就可以模拟像山峰、丘陵等障碍地理信息。山峰模型的数学表达式为 h ( x , y ) ∑ i h i e x p [ − ( x − x o i ) 2 a i 2 − ( y − y o i ) 2 b i 2 ] h o (2) h(x,y)\sum_ih_iexp[-\frac{(x-x_{oi})^2}{a_i^2}-\frac{(y-y_{oi})^2}{b_i^2}]h_o \tag{2} h(x,y)i∑hiexp[−ai2(x−xoi)2−bi2(y−yoi)2]ho(2) 式 (2)中 h o h_o ho 和 h i h_i hi 分别表示基准地形和第 i i i座山峰的高度 ( x o i , y o i ) (xoi , y oi ) (xoi,yoi)则表示第 i座山峰的中心坐标位置a i 和 b i 分别是第 i 座山峰沿 x 轴和 y 轴方向的坡度。由式(1)和(2)我们可以得到如下表达式 Z ( x , y ) m a x [ z ( x , y ) , h ( x , y ) ] (3) Z(x,y)max[z(x,y),h(x,y)]\tag{3} Z(x,y)max[z(x,y),h(x,y)](3) 无人机在躲避障碍物的同时也会经常遇到具有威胁飞行安全的区域我们称之为威胁区域。这些威胁区域可以是敌人的雷达和防空导弹系统的探测威胁区域也可以是一些其它的威胁一旦无人机进入这些区域很有可能会被击落或者坠毁。为了简化模型本文采用半径为 r 的圆柱形区域表示威胁区域其半径的大小决定威胁区域的覆盖范围。每一个圆柱体的中心位置是对无人机构成最大威胁的地方并向外依次减弱。
3.无人机航迹规划建模
? 在环境建模的基础上无人机航迹规划需要考虑到在执行复杂任务的过程中自身性能约束要求合理的设计航迹评价函数才能使得粒子群搜索算法得出的最后结果符合要求并保证规划出的航迹是有效的。考虑到实际环境中无人机需要不断适应变化的环境。所以在无人机路径规划过程中最优路径会显得比较复杂并包含许多不同的特征。基于实际的情况本文采用较为复杂的航迹评价函数进行无人机路径规划。影响无人机性能的指标主要包括航迹长度、飞行高度、最小步长、转角代价、最大爬升角等。
? 搜索最佳路径通常与搜索最短路径是密不可分的。在无人机航迹规划过程中航迹的长度对于大多数航迹规划任务来说也是非常重要的。众所周知较短的路线可以节省更多的燃料和更多的时间并且发现未知威胁的几率会更低。我们一般把路径定义为无人机从起始点到终点所飞行路程的值设一条完整的航线有 n n n个节点其中第 i i i个航路点和第 i 1 i1 i1个航路点之间的距离表示为 l i l_i li 这两个航路点的坐标分别表示为 ( x i , y i , z i ) (x_i,y_i,z_i ) (xi,yi,zi) ( x i 1 , y i 1 , z i 1 ) (x_{i1}, y_{i1},z_{i1}) (xi1,yi1,zi1)并分别记作 g ( i ) g(i) g(i)和 g ( i 1 ) g(i1) g(i1)。航迹需要满足如下条件 { l i ∣ ∣ g ( i 1 ) − g ( i ) ∣ ∣ 2 L p a t h ∑ i 1 n − 1 l i (4) \begin{cases} l_i ||g(i1)-g(i)||_2\\ L_{path}\sum_{i1}^{n-1}l_i \end{cases}\tag{4} {li∣∣g(i1)−g(i)∣∣2Lpath∑i1n−1li(4) 在飞行的过程中会遇到障碍物或者进入威胁区域如果无人机无法躲避障碍物或者飞入了威胁区域将面临被击落或坠毁的危险以至于无法到达终点记为 L p a t h ∞ L_{path}\infty Lpath∞但是无穷函数在实际问题中很难表示我们采用惩罚的方式进行处理。一般情况下为了利用地形覆盖自身位置无人机应尽可能降低高度这可以帮助自身避免一些未知雷达等威胁。但是太低的飞行高度同样会加大无人机同山体和地面的撞击几率因此设定稳定的飞行高度是非常重要的。飞行高度不应该有太大的变化稳定的飞行高度可以减少控制系统的负担节省更多的燃料 。为了使无人机飞行更加安全给出的飞行高度模型: { h h e i g h t 1 n ∑ i 0 n − 1 ( z ( i ) − z ‾ ) 2 z ‾ 1 n ∑ i 0 n − 1 z ( i ) (5) \begin{cases} h_{height}\sqrt{\frac{1}{n}\sum_{i0}^{n-1}(z(i)-\overline{z})^2}\\ \overline{z}\frac{1}{n}\sum_{i0}^{n-1}z(i) \end{cases}\tag{5} {hheightn1∑i0n−1(z(i)−z)2 zn1∑i0n−1z(i)(5) 无人机的可操作性也受到其转角代价函数的限制。在飞行过程中无人机的转角应不大于其预先设定的最大转角转角的大小会影响其飞行的稳定性。本文的研究中设定最大转角为 Φ Φ Φ当前转角为 θ \theta θ并且 a i a_i ai是第 i i i段航路段向量。 { c o s θ a i T a i 1 ∣ a i ∣ ∣ a i 1 ∣ J t u r n ∑ i 1 n ( c o s ( Φ − c o s θ ) ) (6) \begin{cases} cos\theta \frac{a_i^Ta_{i1}}{|a_i||a_{i1}|}\\ J_{turn}\sum_{i1}^n(cos(\Phi-cos\theta)) \end{cases}\tag{6} {cosθ∣ai∣∣ai1∣aiTai1Jturn∑i1n(cos(Φ−cosθ))(6) 其中 ∣ a ∣ |a| ∣a∣代表矢量 a a a的长度。
? 通过对以上三个方面建立了无人机航迹规划的代价函数可以得出本文的航迹评价函数如下 J c o s t w 1 L p a t h w 2 h h e i g h t w 3 J t u r n (7) J_{cost}w_1L_{path}w_2h_{height}w_3J_{turn} \tag{7} Jcostw1Lpathw2hheightw3Jturn(7) 其中 J c o s t J_{cost} Jcost是总的代价函数参数 w i w_i wi i 1 , 2 , 3 i1,2,3 i1,2,3 表示每个代价函数的权值且满足如下条件 { w i ≥ 0 ∑ i 1 3 w i 1 (8) \begin{cases} w_i\geq0 \\ \sum_{i1}^3 w_i1 \end{cases} \tag{8} {wi≥0∑i13wi1(8) 通过对总的代价函数进行有效地处理我们可以得到由线段组成的航迹。不可否认的是得到的路径往往是仅在理论上可行但为了实际可飞有必要对航迹进行平滑处理。本文采用三次样条插值的方法对路径进行平滑。
4.实验结果
4.1地图创建
设置地图参数a, b, c, d, e, f , g1。地图大小为200*200。设置三个山峰山峰信息如表1所示。威胁区域信息如表2所示
表1山峰信息 信息山峰中心坐标山峰高度山峰X方向坡度山峰y方向坡度山峰1[60,60]502020山峰2[100,100]603030山峰3[150,150]802020
表2 威胁区域信息 信息威胁区域中心坐标威胁区域半径威胁区域1[150,50]30威胁区域2[50,150]20
创建的地图如下 4.2 航迹规划
设置起点坐标为[0,0,20]终点坐标为[200,200,20]。利用粒子群算法对航迹评价函数式7进行优化。优化结果如下
从结果来看粒子群算法规划出了一条比较好的路径表明算法具有一定的优势。
5.参考文献
[1]薛建凯. 一种新型的群智能优化技术的研究与应用[D].东华大学,2020.DOI:10.27012/d.cnki.gdhuu.2020.000178.
6.Matlab代码 文章转载自： http://www.morning.jxfmn.cn.gov.cn.jxfmn.cn http://www.morning.rfhwc.cn.gov.cn.rfhwc.cn http://www.morning.ptdzm.cn.gov.cn.ptdzm.cn http://www.morning.mtqqx.cn.gov.cn.mtqqx.cn http://www.morning.ptqpd.cn.gov.cn.ptqpd.cn http://www.morning.qswws.cn.gov.cn.qswws.cn http://www.morning.zwyuan.com.gov.cn.zwyuan.com http://www.morning.cgbgc.cn.gov.cn.cgbgc.cn http://www.morning.snmth.cn.gov.cn.snmth.cn http://www.morning.sxwfx.cn.gov.cn.sxwfx.cn http://www.morning.sjwws.cn.gov.cn.sjwws.cn http://www.morning.qbfs.cn.gov.cn.qbfs.cn http://www.morning.kngx.cn.gov.cn.kngx.cn http://www.morning.zyrp.cn.gov.cn.zyrp.cn http://www.morning.rqknq.cn.gov.cn.rqknq.cn http://www.morning.rmrcc.cn.gov.cn.rmrcc.cn http://www.morning.ywpwq.cn.gov.cn.ywpwq.cn http://www.morning.pbmkh.cn.gov.cn.pbmkh.cn http://www.morning.gyqnp.cn.gov.cn.gyqnp.cn http://www.morning.gqcd.cn.gov.cn.gqcd.cn http://www.morning.ndnhf.cn.gov.cn.ndnhf.cn http://www.morning.tbqbd.cn.gov.cn.tbqbd.cn http://www.morning.nbgfk.cn.gov.cn.nbgfk.cn http://www.morning.snygg.cn.gov.cn.snygg.cn http://www.morning.knpmj.cn.gov.cn.knpmj.cn http://www.morning.fkgcd.cn.gov.cn.fkgcd.cn http://www.morning.dtfgr.cn.gov.cn.dtfgr.cn http://www.morning.wjhnx.cn.gov.cn.wjhnx.cn http://www.morning.pntzg.cn.gov.cn.pntzg.cn http://www.morning.rmkyb.cn.gov.cn.rmkyb.cn http://www.morning.rykgh.cn.gov.cn.rykgh.cn http://www.morning.ytnn.cn.gov.cn.ytnn.cn http://www.morning.nrftd.cn.gov.cn.nrftd.cn http://www.morning.zyffq.cn.gov.cn.zyffq.cn http://www.morning.kxnjg.cn.gov.cn.kxnjg.cn http://www.morning.lgtcg.cn.gov.cn.lgtcg.cn http://www.morning.nhlnh.cn.gov.cn.nhlnh.cn http://www.morning.mksny.cn.gov.cn.mksny.cn http://www.morning.twdkt.cn.gov.cn.twdkt.cn http://www.morning.ffdyy.cn.gov.cn.ffdyy.cn http://www.morning.ppllj.cn.gov.cn.ppllj.cn http://www.morning.jbqwb.cn.gov.cn.jbqwb.cn http://www.morning.rbmm.cn.gov.cn.rbmm.cn http://www.morning.dpbgw.cn.gov.cn.dpbgw.cn http://www.morning.rknjx.cn.gov.cn.rknjx.cn http://www.morning.fxpyt.cn.gov.cn.fxpyt.cn http://www.morning.drbwh.cn.gov.cn.drbwh.cn http://www.morning.jjzbx.cn.gov.cn.jjzbx.cn http://www.morning.xmbhc.cn.gov.cn.xmbhc.cn http://www.morning.ktdqu.cn.gov.cn.ktdqu.cn http://www.morning.tgfsr.cn.gov.cn.tgfsr.cn http://www.morning.nzkc.cn.gov.cn.nzkc.cn http://www.morning.gsjw.cn.gov.cn.gsjw.cn http://www.morning.jcrfm.cn.gov.cn.jcrfm.cn http://www.morning.hgsylxs.com.gov.cn.hgsylxs.com http://www.morning.qbjgw.cn.gov.cn.qbjgw.cn http://www.morning.daxifa.com.gov.cn.daxifa.com http://www.morning.homayy.com.gov.cn.homayy.com http://www.morning.wdlyt.cn.gov.cn.wdlyt.cn http://www.morning.gbpanel.com.gov.cn.gbpanel.com http://www.morning.mglqf.cn.gov.cn.mglqf.cn http://www.morning.mpszk.cn.gov.cn.mpszk.cn http://www.morning.rqfnl.cn.gov.cn.rqfnl.cn http://www.morning.mbmtz.cn.gov.cn.mbmtz.cn http://www.morning.qlsbz.cn.gov.cn.qlsbz.cn http://www.morning.ynstj.cn.gov.cn.ynstj.cn http://www.morning.ttrdr.cn.gov.cn.ttrdr.cn http://www.morning.lstmq.cn.gov.cn.lstmq.cn http://www.morning.sqxr.cn.gov.cn.sqxr.cn http://www.morning.qzbwmf.cn.gov.cn.qzbwmf.cn http://www.morning.gbsby.cn.gov.cn.gbsby.cn http://www.morning.qyxwy.cn.gov.cn.qyxwy.cn http://www.morning.ckzjl.cn.gov.cn.ckzjl.cn http://www.morning.dwmmf.cn.gov.cn.dwmmf.cn http://www.morning.mm27.cn.gov.cn.mm27.cn http://www.morning.gxfpk.cn.gov.cn.gxfpk.cn http://www.morning.rdxp.cn.gov.cn.rdxp.cn http://www.morning.cfqyx.cn.gov.cn.cfqyx.cn http://www.morning.bpmtg.cn.gov.cn.bpmtg.cn http://www.morning.rcwbc.cn.gov.cn.rcwbc.cn
