CN108592921B - 一种分段最速下降混合航线规划方法 - Google Patents
一种分段最速下降混合航线规划方法 Download PDFInfo
- Publication number
- CN108592921B CN108592921B CN201810407351.2A CN201810407351A CN108592921B CN 108592921 B CN108592921 B CN 108592921B CN 201810407351 A CN201810407351 A CN 201810407351A CN 108592921 B CN108592921 B CN 108592921B
- Authority
- CN
- China
- Prior art keywords
- threat
- route
- flight
- point
- model
- 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.)
- Expired - Fee Related
Links
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)
- Feedback Control In General (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明涉及一种分段最速下降混合航线规划方法,其特征在于采用以下步骤:1)在规划空域内,选择以起始点和目标点为最小外接矩形作为研究区,实现地形威胁的数字化和离散化;2)构建综合威胁模型:首先构建建筑物威胁模型,其次构建地形威胁模型;3)建立影响飞行安全的多目标决策模型;4)使用步骤3)分阶段最速下降算法求解综合威胁模型,确定各目标函数的权重系数,为各飞机选择安全性能最大的航线;5)航线优化,根据具体飞机的性能进行可飞性和可操作性对飞行航线进行优化。本发明采用分段最速下降混合航线规划方法求解飞机航线选优问题,能够复杂环境下飞行航迹规划问题,计算速度快、方法简便、稳定的优势明显。
Description
技术领域
本发明提供一种分段最速下降混合航线规划方法,属于飞机航线规划技术领域。
背景技术
到目前为止,国内外在复杂环境下航空救援的航线规划问题仍是研究热点,目前无人机航线规划技术存在响应速度缓慢、探测效果不佳、计算量较大等缺点。在不确定、复杂环境中规模较大时,使得航线突变性很大,但存在搜索速度慢、容易陷入局部最优较难得到最优航线,电势理论能够根据威胁环境的变化快速动态调整威胁场,但存在实用性差,易陷入局部最优;最速下降算法同样具有局部搜索速度快,但全局收敛性受目标函数的形态影响;如何综合运用动态规划和最速下降法在复杂、动态的飞行环境下为飞机设计快速、动态、安全的飞行航线具有极其重要的应用价值。
发明内容
本发明就是针对上述问题,提出在满足相关约束条件的情况下、以能够满足直升机协同规划提供便利服务、且尽量提高飞行的安全性和效率的一种分段最速下降混合航线规划方法。其技术方案为:
1)在规划空域内,选择以起始点和目标点为最小外接矩形作为研究区,实现地形威胁的数字化和离散化;
2)构建综合威胁模型:首先构建建筑物威胁模型
公式(1)中,Vk(x,y)表示第k个威胁在位置(x,y)处的影响力,tn指空域内建筑物威胁的总数,Qk表示位于(TXk,TYk)处的第k个威胁最大值,xsk、ysk分别是与第k个威胁沿x轴和y轴梯度下降方向有关的量,Tk(x,y)表示威胁k的影响半径,公式(2)中ε值为0.1;公式(3)内f1(x,y)是(x,y)处的建筑物威胁值在空域内形成的威胁场;
其次构建地形威胁模型,飞行航线地形威胁用f2(x,y)表示,其数学描述如下:
H0i是第i个山峰的高度,x0i、y0i是第i个山峰的坐标;xsi、xysi分别是与第i个山峰沿x轴和y轴方向的坡度有关的量;
3)建立影响飞行安全的多目标决策模型;
①航线收敛性约束模型f3(x,y),见公式(5):最短航程为起、止点间的直线l0距离,航程长度由与最短航程的近似度决定,表示为各航迹点到直线l0的距离之和,距离之和越小航程越短,反之亦然,其中(xs,ys)和(xe,ye)分别为起、止点的坐标,a、b和c分别为直线l0的参数;
②航程约束模型f4(x,y),见公式(6):为确保航线的收敛性,约束采用限制到目标点的距离平方实现,f4(x,y)选择当前航迹点Px和目标航迹点Pe间距离D(Px,Pe)的平方;
f4(x,y)=D2(Px,Pe)=(x-xe)2+(y-ye)2 (6)
③综合航线规划模型F构建:该模型由地形、建筑物威胁与航程加权叠加构成,其数学描述如下:
其中,f1、f2、f3和f4分别为公式(3)~(6)中的计算值,β1、β2、β3和β4对应为地形威胁、建筑物威胁、航程和航线收敛性约束的权重,四者和为1,若航程超过最大航程则航线规划失败,否则权重与航程成正比;
采用地势威胁和建筑物威胁构成的电势场,根据飞行高度的要求,将飞行高度值设为固定值H’,采用自适应最速下降算法代替电荷间的作用力实现航迹点的计算:
P(k+1)=P(k)-t*[F′x F′y]*βτ,k∈(1,ni) (8)
τ=(α(k+1)-γ0),α(k)=f(k)
当β大于1时,自适应系数βτ有:
本自适应最速下降算法将航线根据α(k)(指与航迹点顺序k有关的函数)值和γ0(指航线搜索策略的分界点)关系,将航线设计范围动态分为两个阶段:前一阶段自适应系数βτ小于1增加航线收敛时间,便于航线寻优,后一阶段βτ大于等于1,加大搜索的步长,促进航线的收敛;当β等于1时,该算法退化为普通最适应下降算法;当β小于1时的结果与β大于1的结果相反;
R=[P1 P2 … Pe] (9)
公式(8)、(9)中ni为搜索最优航迹生成的航迹点个数,P(k)表示第k个航迹点,F′x、F′y为F对x、y的一阶导数,β代表自适应系数,γ0为航线规划速度划分点,F″xx、F″yy为F对x、y的二阶导数,F″yx、F″xy为F对x、y的二阶偏导数,T代表矩阵转置,t为搜索方向,α(k+1)代表自变量为k+1的函数,R是规划的航线,由航迹点集合表示,Pe指航线最末的航迹点;
4)使用步骤3)分阶段最速下降算法求解综合威胁模型,确定各目标函数的权重系数,为各飞机选择安全性能最大的航线;
5)航线优化,根据具体飞机的性能进行可飞性和可操作性对飞行航线进行优化。
本发明与现有技术相比,其优点在于:
(1)威胁模型对突发威胁快速兼容能力,利用电势理论的威胁模型场能根据威胁变化动态调整的特点,适用与复杂环境下威胁模型的快速动态建模,为航线动态规划提供了必要条件。
(2)航线规划算法对威胁分布状况的快速适应能力,采用分段最速下降算法则能根据威胁分布状况动态调整最速下降算法搜索步长。
(3)复杂环境下最速下降算法快速全局收敛能力,在威胁模型中加入航迹点到目标点距离平方,加强最速下降算法的收敛于目标点。
具体实施方式
应用本发明对空域内4架伊尔-76飞机在包含10个威胁,其中4个建筑物威胁、6个地形威胁,在60km×60km的空域内对1个目标点进行航空救援,为各飞机设计安全、高效的飞行航线。
需要说明,对于多任务节点可以通过分航段连续设计航线,作为本模型的扩展,所提的算法仍然适用。
航线规划具体步骤如下:
1)在规划空域内,选择以起始点(1km,1km)和目标点(60km,60km)为左下角和右上角建立矩形作为研究区,并在纵横坐标轴分别1km的间隔将研究区数字化和离散化。
2)构建综合威胁模型:
首先构建建筑物威胁模型:空域内4架飞机的起点坐标分别为(1km,1km)、(13km,1km)、(1km,15km)和(7km,10km),目标点坐标(60km,60km),在空域内(20km,10km)、(10km,50km)、(35km,40km)和(45km,15km)处共有4个建筑物威胁。
根据威胁的已知分布数据,电势威胁模型加常数ε取0.1,航线的收敛阈值设置设为1,建立如下航线规划的威胁场:
其次构建地形威胁模型:在(10km,50km)、(15km,25km)、(30km,25km)、(10km,15km)、(40km,15km)和(40km,10km)处共有6个地形威胁;
3)建立影响飞行安全的多目标决策模型:
①航线收敛性约束模型为:f3(X,Y)=|1.72*X+Y-63.6|/1.9896
②航程约束模型为:f4(X,Y)=(X-60)^2+(Y-60)^2
③根据以上威胁场模型建立综合航线规划模型F:
表1影响因素权重系数
根据各个威胁对飞行安全的影响程度,设置各类威胁的权重,为简化计算取为整数,将各权重的10倍作为计算权重,如表1所示;自适应调整系数内α(k)取简单的一次函数,即为α(k)=k;
F(X,Y)=0.2*f1(X,Y)+0.2*f2(X,Y)+0.5*f3(X,Y)+0.1*f4(X,Y) (3)
为简化计算将权重乘10,并将f1,f2,f3和f4带入上式得:
P(k+1)=P(k)-0.1*[6*(30-Y)*exp(0.01*(30-Y))*Y)16*(12-X)*exp(0.007*(12-X))*X)]
公式(1)~公式(4)中变量X、Y表示空域内离散点的横坐标和纵坐标值。
4)采用分阶段最速下降算法求解综合威胁模型,确定各目标函数合理的权重系数,为各飞机选择安全性能最大的航线(见表2):
表2航迹计算参数和总航程评价结果
5)航线优化,根据具体飞机的性能进行可飞性和可操作性对飞行航线进行优化:选择米-18直升机的飞行性能指标俯仰角[-20,20],飞机的乘坐品质[g,-2g],飞行速度170m/s,平均飞行高度为1km。
以上所述仅为本发明的较佳实施例,凡依本发明申请专利范围所作的均等变化与修饰,皆应属本发明的涵盖范围。
实验数据证明:
(1)本专利建立的威胁模型,既有电势理论快速适应威胁变化的优点,又有最速下降算法快速、高效搜索可行路径的能力。
(2)分段最速下降算法则能根据威胁分布状况动态调整最速下降算法搜索步长。
(3)威胁模型中加入航迹点到目标点距离平方,加强最速下降算法的收敛于目标点。
Claims (1)
1.一种分段最速下降混合航线规划方法,其特征在于采用以下步骤:
1)在规划空域内,选择以起始点和目标点为最小外接矩形作为研究区,实现地形威胁的数字化和离散化;
2)构建综合威胁模型:首先构建建筑物威胁模型
公式(1)中,Vk(x,y)表示第k个威胁在位置(x,y)处的影响力,tn指空域内建筑物威胁的总数,Qk表示位于(TXk,TYk)处的第k个威胁最大值,xsk、ysk分别是与第k个威胁沿x轴和y轴梯度下降方向有关的量,rk(x,y)表示威胁k的影响半径,公式(2)中ε值为0.1;公式(3)内f1(x,y)是(x,y)处的建筑物威胁值在空域内形成的威胁场;
其次构建地形威胁模型,飞行航线地形威胁用f2(x,y)表示,其数学描述如下:
H0i是第i个山峰的高度,x0i、y0i是第i个山峰的坐标;xsi、ysi分别是与第i个山峰沿x轴和y轴方向的坡度有关的量;
3)建立影响飞行安全的多目标决策模型;
①航线收敛性约束模型f3(x,y),见公式(5):最短航程为起、止点间的直线l0距离,航程长度由与最短航程的近似度决定,表示为各航迹点到直线l0的距离之和,距离之和越小航程越短,反之亦然,其中(xs,ys)和(xe,ye)分别为起、止点的坐标,a、b和c分别为直线l0的参数;
②航程约束模型f4(x,y),见公式(6):为确保航线的收敛性,约束采用限制到目标点的距离平方实现,f4(x,y)选择当前航迹点Px和目标航迹点Pe间距离D(Px,Pe)的平方;
f4(x,y)=D2(Px,Pe)=(x-xe)2+(y-ye)2 (6)
③综合航线规划模型F构建:该模型由地形、建筑物威胁与航程加权叠加构成,其数学描述如下:
其中,f1、f2、f3和f4分别为公式(3)~(6)中的计算值,β1、β2、β3和β4对应为建筑物威胁、地形威胁、航线收敛性约束和航程约束的权重,四者和为1,若航程超过最大航程则航线规划失败,否则权重与航程成正比;
采用地形威胁和建筑物威胁构成的电势场,根据飞行高度的要求,将飞行高度值设为固定值H’,采用自适应最速下降算法代替电荷间的作用力实现航迹点的计算:
P(j+1)=P(j)-t*[F′x F′y]*βτ,j∈(1,ni) (8)
τ=(α(j+1)-γ0),α(j)=f(j)
当β大于1时,自适应系数βτ有:
a(j)指与航迹点顺序j有关的函数f(j)的值,γ0指航线搜索策略的分界点,本自适应最速下降算法将航线根据α(j)和γ0关系,将航线设计范围动态分为两个阶段:前一阶段自适应系数βτ小于1增加航线收敛时间,便于航线寻优,后一阶段βτ大于等于1,加大搜索的步长,促进航线的收敛;当β等于1时,该算法退化为普通最适应下降算法;当β小于1时的结果与β大于1的结果相反;
R=[P1 P2 … Pe] (9)
公式(8)、(9)中ni为搜索最优航迹生成的航迹点个数,P(j)表示第j个航迹点,F′x、F′y为F对x、y的一阶导数,β代表自适应系数,γ0为航线规划速度划分点,F″xx、F″yy为F对x、y的二阶导数,F″yx、F″xy为F对x、y的二阶偏导数,T代表矩阵转置,t为搜索方向,α(j+1)代表自变量为j+1的函数,R是规划的航线,由航迹点集合表示,Pe指航线最末的航迹点;
4)使用步骤3)分阶段最速下降算法求解综合威胁模型,确定各目标函数的权重系数,为各飞机选择安全性能最大的航线;
5)航线优化,根据具体飞机的性能进行可飞性和可操作性分析,对飞行航线进行优化。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810407351.2A CN108592921B (zh) | 2018-05-02 | 2018-05-02 | 一种分段最速下降混合航线规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810407351.2A CN108592921B (zh) | 2018-05-02 | 2018-05-02 | 一种分段最速下降混合航线规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108592921A CN108592921A (zh) | 2018-09-28 |
CN108592921B true CN108592921B (zh) | 2021-07-27 |
Family
ID=63620248
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810407351.2A Expired - Fee Related CN108592921B (zh) | 2018-05-02 | 2018-05-02 | 一种分段最速下降混合航线规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108592921B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109358652B (zh) * | 2018-12-21 | 2021-07-30 | 山东理工大学 | 一种直升机航线规划方法 |
CN109445463B (zh) * | 2018-12-21 | 2021-07-27 | 山东理工大学 | 一种无人机动态航线规划方法 |
CN109358651B (zh) * | 2018-12-21 | 2021-07-30 | 山东理工大学 | 一种直升机动态航线规划方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102506863A (zh) * | 2011-11-07 | 2012-06-20 | 北京航空航天大学 | 一种基于万有引力搜索的无人机航路规划方法 |
JP2014127083A (ja) * | 2012-12-27 | 2014-07-07 | Toyota Motor Corp | 車両動力プラントの制御装置 |
CN104991895A (zh) * | 2015-05-15 | 2015-10-21 | 南京航空航天大学 | 一种基于三维空域网格的低空救援航空器航迹规划方法 |
CN105865454A (zh) * | 2016-05-31 | 2016-08-17 | 西北工业大学 | 一种基于实时在线地图生成的无人机导航方法 |
CN106815443A (zh) * | 2017-01-23 | 2017-06-09 | 北京理工大学 | 面向变化环境的超低空飞行器三维多批多航迹规划方法 |
CN107504972A (zh) * | 2017-07-27 | 2017-12-22 | 北京航空航天大学 | 一种基于鸽群算法的飞行器航迹规划方法及装置 |
-
2018
- 2018-05-02 CN CN201810407351.2A patent/CN108592921B/zh not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102506863A (zh) * | 2011-11-07 | 2012-06-20 | 北京航空航天大学 | 一种基于万有引力搜索的无人机航路规划方法 |
JP2014127083A (ja) * | 2012-12-27 | 2014-07-07 | Toyota Motor Corp | 車両動力プラントの制御装置 |
CN104991895A (zh) * | 2015-05-15 | 2015-10-21 | 南京航空航天大学 | 一种基于三维空域网格的低空救援航空器航迹规划方法 |
CN105865454A (zh) * | 2016-05-31 | 2016-08-17 | 西北工业大学 | 一种基于实时在线地图生成的无人机导航方法 |
CN106815443A (zh) * | 2017-01-23 | 2017-06-09 | 北京理工大学 | 面向变化环境的超低空飞行器三维多批多航迹规划方法 |
CN107504972A (zh) * | 2017-07-27 | 2017-12-22 | 北京航空航天大学 | 一种基于鸽群算法的飞行器航迹规划方法及装置 |
Non-Patent Citations (2)
Title |
---|
Terrain following/terrain avoidance path optimization using the method of steepest descent;S.J. Asseo;《Proceedings of the IEEE 1988 National Aerospace and Electronics Conference》;20020806;第1128-1136页 * |
利用动态规划和电势理论规划UAV三维航迹;刘丽峰等;《计算机工程与应用》;20130703;第49卷(第20期);第235-239页 * |
Also Published As
Publication number | Publication date |
---|---|
CN108592921A (zh) | 2018-09-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110930770B (zh) | 一种基于管制意图和飞机性能模型的四维航迹预测方法 | |
CN110243359B (zh) | 基于低空风预测模型的安全航迹规划方法 | |
CN108592921B (zh) | 一种分段最速下降混合航线规划方法 | |
CN103983143B (zh) | 包含速度过程约束和多终端约束的空地导弹投放下滑段制导方法 | |
CN104991895A (zh) | 一种基于三维空域网格的低空救援航空器航迹规划方法 | |
CN106768123A (zh) | 一种无人直升机燃油预估方法 | |
CN111192481B (zh) | 一种基于碰撞风险的进离场程序无人机管控区边界确定方法 | |
CN109870906A (zh) | 一种基于bbo优化人工势场的高速旋翼飞行器路径规划方法 | |
CN109941460A (zh) | 航天器亚轨道返回再入过载降低设计方法 | |
CN109459929A (zh) | 火星大气进入段纵向可达区生成的解析同伦法 | |
CN109445463A (zh) | 一种无人机动态航线规划方法 | |
CN111895998B (zh) | 一种大型固定翼无人飞行器分段堆栈式航路规划方法 | |
CN109977543B (zh) | 基于侧向优先的三维剖面覆盖区域计算方法、系统及介质 | |
CN105759630A (zh) | 基于模糊pid控制的飞机4d航迹仿真系统及仿真方法 | |
Li et al. | Four-dimensional descent trajectory optimization for aircraft in turbulence | |
Wang et al. | Real-time path planning for low altitude flight based on A* algorithm and TF/TA algorithm | |
Fisch et al. | Aircraft configuration settings within the optimization of approach trajectories | |
Krawczyk et al. | Aircraft model for the automatic taxi directional control design | |
Campbell et al. | An operational strategy for persistent contrail mitigation | |
Wang et al. | Optimal Scheduling and Speed Adjustment in En Route Sector for Arriving Airplanes | |
Liu et al. | The application of artificial immune algorithm to earthquake relief route planning | |
CN116540778A (zh) | 一种旋翼无人直升机航线规划方法 | |
Wang et al. | Multi-objective Optimization for Cruising Phase in Civil Aircraft’s Trajectory Planning | |
CN109358651B (zh) | 一种直升机动态航线规划方法 | |
Valenzuela et al. | Cruise optimization using trajectory patterns |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20210727 |