法律状态公告日
法律状态信息
法律状态
2017-03-29
授权
授权
2015-07-15
实质审查的生效 IPC(主分类):G05D1/10 申请日:20150114
实质审查的生效
2015-06-17
公开
公开
技术领域
本发明涉及一种滑翔飞行器末端能量管理轨迹规划方法,特别是涉及一种基于几何规划的滑翔飞行器末端能量管理轨迹规划方法。
背景技术
末端能量管理(Terminal Area Energy Management,以下简称TAEM)段指的是飞行器从再入段起点至自动着陆段开始点的一段飞行状态。飞行器在此阶段需要对自身的高度和速度进行调整从而满足着陆的要求,使飞行器能够平稳的着陆到指定的着陆场。本阶段飞行器处于无动力飞行状态,只能通过气动舵来调整飞行器的飞行状态,机动能力有限,因此如何合理规划飞行轨迹,使得飞行器能够准确快速的满足自动着陆段的要求是TAEM段需要解决的主要问题。
TAEM段的轨迹规划核心问题是使飞行器飞行方向快速的对准着陆场并且使飞行器的状态满足着陆要求。现有的方法中,轨迹规划一般采用在自动着陆段初始点附近选取航向校准圆的方式来实现着陆对准。这种方式使得飞行器在进入航向校准圆的起始切点时可能会出现较大的过载,对飞行器的机动性要求较高。文献“《Terminal Area Energy Management Trajectory Planning for an Unpowered Reusable Launch Vehicle》,Kenneth R,Atmospheric Flight Mechanics Conference and Exhibit 16-19August 2004,5183”提出了采用螺旋线的方式进入自动着陆段,有效避免了过载较大的情况,同时该文还对TAEM阶段进行了划分,随后对TAEM各个阶段进行了详细的能量推演,最终得到最优的TAEM段规划轨迹。但是该文没有考虑多进场方向的情况,应用于实际工程时有一定局限性。
发明内容
为了克服现有滑翔飞行器末端能量管理轨迹规划方法实用性差的不足,本发明提供一种基于几何规划的滑翔飞行器末端能量管理轨迹规划方法。该方法根据飞行器进入TAEM段的状态,利用几何规划方法快速规划出合理可行的TAEM平面轨迹。在TAEM平面轨迹规划的基础上进行高度推演从而给出完整的轨迹规划策略。由于采用几何规划过程中采用螺旋线的方式进入自动着陆段的入口,有效避免了过载突变情况的出现,从而对飞行器机动性的要求降低。同时,轨迹规划时考虑了飞行器在TAEM 段初始时刻的状态,针对飞行器进场状态分类规划出相应的飞行轨迹,能够快速规划出合理轨迹,适应不同进场方向的要求,且经过仿真验证规划速度较快。
本发明解决其技术问题所采用的技术方案是:一种基于几何规划的滑翔飞行器末端能量管理轨迹规划方法,其特点是采用以下步骤:
步骤一、建立机场坐标系,原点为机场坐标位置,x轴沿机场方向45°指向东北方向为正,y轴垂直于当地水平面向上,z轴与x轴y轴构成右手坐标系。
步骤二、对于各点的坐标值以及相应的航程计算推导如下:
A点是末端能量管理的起始点,坐标记为(x1,z1),末端能量管理段的初始速度记为vA,则得到圆弧段AB的近似转弯半径:
式中g=9.8204m/s2,为标准重力加速度,θA为A点的当地弹道倾角,ψA为A点的当地航迹偏角,γA为A点的倾侧角,△ψ为捕获转角。由圆弧的半径和A点的坐标推出O1的坐标和B点的坐标:
根据螺旋线的相关计算方法计算出其余各个关键点C、D、E的坐标。
末端能量管理的一个重要任务是地面跟踪航程的准确预测,待飞航程表示为:
Sto=SAC+SHAC+SPF (2)
式中SAC、SHAC、SPF分别是捕获段、HAC转弯段和预着陆段的预测航程。分别计算各段航程,从而得出总航程。
步骤三、水平轨迹规划和航程预测的基础上,需要进行高度策略的规划。入场方式一高度的规划分为两段:A点到C点和C点到E点。两段高度分别用与航程有关的二次多项式来进行规划。两个二次多项式设计如下:
CE段:hCE=a11+a12sAC+a13sAC2 (3)
AC段:hAC=a01+a02sCE+a03sCE2 (4)
式中a11、a12、a13、a01、a02、a03均是待定系数。sAC为A点和C点间的航程,sCE为C点和E点间的航程。
步骤四、要获得完整的参考轨迹,对轨迹上各个点的能量加以推演,确定轨迹末端的能量状态,判定最优轨迹。
捕获段和直线段的能量推演:
飞行器单位重量的能量值表示如下:
式中,V为飞行器当前的速度值,h为飞行器的高度值,g为重力加速度。从入口点到螺旋线初始点的能量推演采用简化的欧拉积分得到
其中△s=sAC/N,N是迭代步数。为能量随航程的变化关系。EK为当前能量值,EK+1为下一时刻能量值。当前速度V由式(5)中的E决定。
HAC和ALI段的能量推演:
HAC段和直线预着陆段的能量规划采用的独立变量由原来的地面跟踪航程变为能量:
其中△E=(EALI-EHAC)/N,为航程随能量的变化,sk为当前迭代航程,sk+1为下一步的航程。初始能量由上一段结束点来计算,末端能量根据约束已知。
预定着陆段设倾侧角为零,HAC转弯段的角度通过下式计算:
在航程满足要求的基础上,寻找使高度偏差最小的轨迹,记为最优轨迹:
|hALI-hkend|<δk (9)
hkend是第k次最后推演的高度值,hALI为能量推演终点要求高度。δk为第k次迭代得到的高度偏差。若第k+1次推演得到的δk+1满足:
δk+1<δk (10)
则用k+1次迭代的得到的参数对原有的参数进行更新最终确定出最优的λ、Rf、△ψ。
本发明的有益效果是:本发明方法根据飞行器进入TAEM段的状态,利用几何规划方法快速规划出合理可行的TAEM平面轨迹。在TAEM平面轨迹规划的基础上进行 高度推演从而给出完整的轨迹规划策略。由于采用几何规划过程中采用螺旋线的方式进入自动着陆段的入口,有效避免了过载突变情况的出现,从而对飞行器机动性的要求降低。同时,轨迹规划时考虑了飞行器在TAEM段初始时刻的状态,针对飞行器进场状态分类规划出相应的飞行轨迹,能够快速规划出合理轨迹,适应不同进场方向的要求,且经过仿真验证规划速度较快。
本发明通过地面航程预测和水平轨迹规划使得轨迹规划方法能够根据飞行器的不同初始状态,进行分类处理,得出合理的飞行轨迹。有效的解决了背景技术中无法实现多进场方式快速规划的局限性。在此基础上进行参考高度策略的设计和能量的推演,使飞行器能够满足末端状态的要求。最终得到的高度偏差为8.15米,速度偏差为2.07米/秒,横向偏差为57.47米,航程偏差为523.7米,航向角偏差为0.3度。规划过程快速易实现,有利于工程应用。
下面结合附图和具体实施方式对本发明作详细说明。
附图说明
图1是本发明方法中几种不同的飞行器进场方向示意图。
图2是本发明方法中航迹规划的水平投影示意图。
图3是本发明方法中速度随航程变化的规划曲线。
图4是本发明方法中高度随航程变化的规划曲线。
图5是本发明方法中的入场示意图。图5(a)是左手螺旋线反向入场示意图;图5(b)是右手螺旋线正向入场示意图;图5(c)是左手螺旋线正向入场示意图;图5(d)是右手螺旋线反向入场示意图。
具体实施方式
参照图1-5。以RLV飞行器为例,本发明基于几何规划的滑翔飞行器末端能量管理轨迹规划方法具体步骤如下:
一、建立坐标系。
滑翔飞行器在TAEM初始状态有几种不同的进场方式,以机场坐标系为基准,飞行器从四个不同的象限进场。为了便于末端能量管理段轨迹规划,首先建立机场坐标系:原点为机场坐标位置,x轴沿机场方向45°指向东北方向为正,y轴垂直于当地水平面向上,z轴与x轴y轴构成右手坐标系。飞行器TAEM段初始条件:高度29099.41m,速度949.985m/s,TAEM段结束点状态为:高度3000m,速度180m/s,与机场之间的 距离为21000m时进入自动着陆段。
二、水平轨迹规划。
不同的象限进场分别用几何方法规划不同的TAEM轨迹。以末端能量管理段的初始点在机场坐标系的第一象限为例分析四种入场方式的几何关系。
TAEM段初始点在机场坐标系中的坐标为(x,z)=(119322.10,64390.67),即为A点的坐标。当地弹道倾角为3.54°,航向角(与x轴正方向的夹角)为152.08°,初始倾侧角为44.89°。
圆弧段的转弯半径为
式中g=9.8204m/s2,为标准重力加速度,θA为A点的当地弹道倾角,ψA为A点的当地航迹偏角,即航向角152.08°。γA为A点的倾侧角44.89°。将相关初始量代入得R=92928.55m。利用下式求解O1和B点的坐标。
(x1,z1)为A点的坐标,(x2,z2)为B点坐标,为O1点的坐标,式中△ψ∈(-2π,2π)为捕获转角为待寻优变量,从而推出B点的坐标。
参照表1,根据螺旋线的几何关系利用求解出C点的坐标,其中Rf∈(0,50000)和λ∈(0,2π)是待寻优变量。
Rf∈(0,50000),根据螺旋线的极坐标公式得到:
r=Rfeφcot(λ)
式中λ∈(0,2π)。参照表1,则求出不同入场方式下各点坐标。
表1
末端能量管理的一个重要任务是地面跟踪航程的准确预测,基于上图所示的参考轨迹的待飞航程表示为:
Sto=SAC+SHAC+SPF (2)
式中SAC、SHAC、SPF分别是捕获段,HAC转弯段和预着陆段的预测航程。其中捕获段SAC的地面跟踪航程近似于常值半径转弯:
SAT=RAT|△ψAT|
此处△ψAT是捕获段的转角,RAT是近似捕获转弯半径,采用拟平衡滑翔假设得
其中γvAT是预测的常值倾侧角,VH是水平速度。
HAC的转弯半径为:
RHAC=Rf+R2△ψHAC2
Rf是HAC终点半径,R2是常值系数。对上式两边求积分得:
预着陆段航程为:
SPF=xALI-xHAC
综上所述,根据各个点的坐标及△ψAT、RAT、Rf、R2、△ψHAC这些参数对各段的航程进行计算:
圆弧段AB:lAB=R△ψ
直线捕获段BC:
螺旋线阶段CD:lCD=(r-Rf)/cos(λ)
航向调整段DE:lDE=4000
总的航程为:S=lAB+lBC+lCD+lDE
三、高度规划。
水平轨迹规划和航程预测的基础上,进行高度的规划。高度的规划分为两段:A点到C点和C点到E点。两段高度分别用与航程有关的二次多项式来进行规划。两个二次多项式求解过程如下:
CE段:hCE=a11+a12sAC+a13sAC2 (3)
AC段:hAC=a01+a02sCE+a03sCE2 (4)
说明:式中a11、a12、a13、a01、a02、a03均是待定系数。sAC为A点和C点间的航程,sCE为C点和E点间的航程。两个式子中s都从0开始取值。
对于AC段,在初始点A有:sAC=0,则
a01=h1
式中h1为A点的高度值即29099.41m。
对于CE段,在初始点C有:sCE=0,则
a11=h3
式中h3为C点的高度值。
取高度对航程的导数得到弹道倾角的值。
在两段高度规划的初始点得到:
a02=tanθA
a12=tanθC
上述两个式子中θA为3.54°,θC通过以下步骤求得。
C点在AC段上,根据tanθAC的表达式得到:
a02+2a03s13=tanθC
式中s13表示A点到C点的总航程。将a02的表达式代入上式并整理得到:
同理C点在CE段的表达式上从而得到:
式中s35表示C点到E点的总航程,θE为E点的弹道倾角,为已知量。
点C对两段的高度表达式都成立所以又有:
式中h5表示点E的高度值,为3000m。
将a03和a13的表达式代入h3和h5的方程组即解出tanθC:
将a03代入h3式解出h3,再根据tanθC的值求出a03和a13,得到两个二次式的全部系数。从而完成高度规划的过程,根据当前时刻的航程实时计算出当前的高度值。
四、能量推演。
完成水平轨迹规划和高度规划之后需要对能量进行推演从而获得各个点的速度信息,同时获得末端的状态以获得最优轨迹。分两段进行(两段划分中为了保证规划的准确性,同时保证程序计算效率,取N为100):
第一段:捕获段和直线段的能量推演。
飞行器单位重量的能量值表示如下:
式中,V为飞行器当前的速度值,h为飞行器的高度值,g为重力加速度。对上式求导:
将运动方程和式中X为气动阻力,θT为当前弹道倾角,代入的表达式,并且利用ds/dt=VcosθT得到能量随着地面航程的变化:
式中气动阻力X通过查询气动数据表得到。从入口点到螺旋线初始点的能量推演采用简化的欧拉积分得到
其中△s=sAC/N,N是迭代步数。参考高度和航迹角用高度推演的结果进行计算(其中航程sKH=sK+△s),当前速度V由式(5)中的E决定。
推演过程中在圆弧转弯段倾侧角:
式中R为圆弧段转弯半径,θ为当前弹道倾角。利用tanθ=a02+2a03·s,计算航程对应的弹道倾角。在直线捕获段,倾侧角取为0。
第二段:HAC和ALI段的能量推演。
HAC段和直线预着陆段的能量规划采用的独立变量由原来的地面跟踪航程变为能量:
其中△E=(EALI-EHAC)/N,sk+1为当前迭代航程,初始能量由上一段结束点来计算,末端能量根据约束已知。在能量推演过程同时根据高度、速度和能量关系完成速度规划。
预定着陆段设倾侧角为零,HAC转弯段的角度通过下式计算:
在航程满足要求的基础上,寻找使高度偏差最小的轨迹,记为最优轨迹:
|hALI-hkend|<δk (9)
式中hALI取3000m,hkend是第k次最后推演的高度值,通过高度推演的结果进行计算,若第k+1次推演得到的δk+1满足:
δk+1<δk (10)
则用k+1次迭代的得到的参数对原有的参数进行更新,最终确定出最优的λ=1.3、Rf
ERROR: limitcheck
OFFENDING COMMAND: string
STACK:
66038
33018
32512
33019 。
机译: 轨迹规划生成装置,轨迹规划方法和轨迹规划生成计划
机译: 集成计算机数控机床的轨迹规划系统,轨迹规划装置,轨迹规划方法及其计算机程序
机译: 集成计算机数控(CNC)机的轨迹规划系统,轨迹规划装置,轨迹规划方法及其计算机程序