本发明属于直升机航线规划领域,涉及到使用直升机性能和环境威胁等信息规划出最优飞行航线方法,具体是一种无人直升机双重电磁场动态航线规划方法。
背景技术:
1、到目前为止,国内外在复杂动态威胁环境下无人直升机安全性能最大化航线规划方面的研究尚未有成熟的理论和技术,还没有系统地应用到中小型无人直升机飞控系统中。复杂动态威胁环境的无人直升机动态航线规划目前还没有实施有效的措施,如何能应用动态、静态威胁的电磁场特征来规划安全性能最大的飞行航线,回避混合威胁以及实现紧急事故救援是亟待解决的问题,此问题的解决对拓宽无人直升机应用领域具有极其重要的应用价值。
技术实现思路
1、1.一种无人直升机双重电磁场动态航线规划方法,其特征采用以下实现步骤:
2、(1)构建混合静态威胁模型zs,数学描述如下:
3、
4、z1=peaks(n) (2)
5、zs=z1+z0 (3)
6、上述公式中,z0、z1、zs分别表示通讯威胁、地形威胁和混合静态模型值,cx、cy分别表示规划空域内通讯威胁中心点的横坐标和纵坐标;peaks和n分别表示地形威胁生成函数和规划空域的范围,单位为公里;
7、(2)计算混合静态威胁模型平面适飞数据集:
8、首先利用公式(4)~(5)得到混合静态威胁模型平面图形im和及其二值化图像bw:
9、im=imagesc(zs) (4)
10、bw=im2bw(im.cdata) (5)
11、公式(4)~(5)中,imagesc、im分别为图形矩阵生成二维图形的函数及其生成的混合静态威胁模型平面,im2bw、im.cdata、bw分别为图像二值化函数、图像数据矩阵和二值化后的图像;
12、然后利用公式(6)~(7)得到适飞区域图像ultimateerosion及其对应行row、列col、值v:
13、ultimateerosion=bwulterode(~bw) (6)
14、[row,col,v]=find(ultimateerosion) (7)
15、最后利用公式(8)~(10)对mt求梯度值得到地形威胁模型梯度数据集v:
16、rdx(i,:)=fix(rand(1,nc)*length(row))+1 (8)
17、xs=row(rdx(i,:)) (9)
18、ys=col(rdx(i,:)) (10)
19、公式(6)~(10)中,bwulterode、ultimateerosion分别表示距离变换的极大值函数及其生成的图像,符号“~”为求相反数的标志,find、v、row、col分别为查找函数、查找到的数值及其所在的行数和列数,fix、rand、length分别为取整函数、生成随机数函数和求解最大维度数的函数,rdx、nc分别表示生成随机数矩阵和矩阵的列数,xs、ys、i分别表示适飞数据集在x轴、y轴的分量和其对应的数量,冒号“:”表示所有的元素;
20、(3)生成适飞区航迹点集,构建飞行航线集:
21、首先利用公式(11)初始化电磁场变化率的横坐标分量u和纵坐标分量v:
22、u=zs*coth(x)*y (11)
23、v=zs*tanh(y)*x (12)
24、公式(11)中,u、v分别为电磁场变化率的横、纵坐标分量,coth、tanh分别matlab软件模拟双曲余切函数和双曲正切函数;
25、然后利用公式(13)~(14)遴选安全电磁场的变化率横坐标分量u1和纵坐标分量v1:
26、
27、利用公式(15)~(20)执行适飞区航迹点集遴选,构建飞行航线集:
28、fs(i,k)=(xs(i)-xs(k))+1j*(ys(i)-ys(k)),i≠k (15)
29、ag(i,k)=angle(fs(i,k))-angle(u1(xs(i),ys(i))+1j*vl(xs(i),ys(i)))(16)
30、[mf,mfx]=min(ag) (17)
31、fss=[fss xs(mfx)+1j*ys(mfx)] (18)
32、xp=real(fss),yp=imag(fss) (19)
33、px=[1,xp,n],py=[1,yp,n],pz=zs(px,py) (20)
34、公式(15)~(20)中,i、k、fs分别表示适飞区航迹点的第i、k个复数及其差值,j表示复数的标志,angle、ag分别表示计算幅角的函数及其计算的幅角差值,min、mf、mfx、fss分别表示计算最小值的函数及其得到的最小值及其索引值、所有的最小航迹点组成的虚数矩阵,xp,yp,real,imag分别表示航迹点横、纵坐标和计算虚数实部和虚部的函数,px,py,pz分别表示构建飞行航线集的三维坐标集合;
35、(4)执行航线评价函数,计算实时飞行航线:
36、d(i)=mydist(px′,py′,pz′) (21)
37、[md,mdx]=min(d) (22)
38、xl=px(mdx,:) (23)
39、yl=py(mdx,:) (24)
40、zl=pz(mdx,:)+hs (25)
41、[xc,yc,zc]=dcdttj(x0,y0,z0,xl,yl,zl) (25)
42、公式(21)~(25)中,d(i)、mydist、“’”分别表示第i条航线的航程、航程计算函数和矩阵的转置符号,md、mdx分别表示最短航程及其索引,xl,yl,zl分别表示最短航程的航线的三维坐标集合,hs表示设计的安全飞行航高,x0,y0,z0分别表示动态威胁中心点的三维坐标,dcdttj表示基于局部电磁场动态威胁回避函数,xc,yc,zc分别表示实时飞行航线的三维坐标集合;
43、(5)采用样条函数改进最优飞行航线,实现航线可飞行性优化,为避免飞机撞地和减少油耗的问题提供了一种有效的方法。
44、本发明与现有技术相比,其优点在于:
45、a.实现复杂动态威胁环境下全局最安全航线的快速规划。采用图形学方法遴选适飞航线集和航程最短的方法相结合,为避免无人直升机坠毁的问题提供了一种有效的方法。
46、b.利用双重电磁场方法进行的复杂动态环境下实时航线优化。利用双重电磁场方法通过精细计算电场速率幅角与航线段幅角的最小插值,并建立局部电磁场规避动态威胁,获得适飞区域以达到较高的安全性的特点,在复杂动态环境下航线快速生成,及时回避动态和静态威胁方面具有重要的作用。
1.一种无人直升机双重电磁场动态航线规划方法,其特征采用以下实现步骤: