CN108548541A - 一种以开伞高度为控制目标的大气进入制导方法 - Google Patents
一种以开伞高度为控制目标的大气进入制导方法 Download PDFInfo
- Publication number
- CN108548541A CN108548541A CN201810205370.7A CN201810205370A CN108548541A CN 108548541 A CN108548541 A CN 108548541A CN 201810205370 A CN201810205370 A CN 201810205370A CN 108548541 A CN108548541 A CN 108548541A
- Authority
- CN
- China
- Prior art keywords
- ref
- nominal
- height
- guidance law
- flown
- 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.)
- Granted
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/24—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for cosmonautical navigation
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Astronomy & Astrophysics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Aiming, Guidance, Guns With A Light Source, Armor, Camouflage, And Targets (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种以开伞高度为控制目标的大气进入制导方法,(1)完成标称轨迹设计,获得标称制导律uref,标称纵程sref,标称高度变化率标称阻力加速度Dref,标称升力加速度Lref,标称待飞高度Htogo_ref,标称飞行路径角γref;(2)根据当前飞行纵程s,阻力D和高度变化率相对标称量sref,Dref,的偏差,以及当前速度对应的标称待飞高度Htogo_ref,预测当前的待飞高度Htogo_p;(3)根据预测的待飞高度Htogo_p,求解控制补偿量Δu,以消除预测的待飞高度与参考待飞高度的偏差;(4)利用制导律补偿量Δu以及步骤(1)中获得的标称制导律uref确定最终的制导律uc;(5)在大气进入点至开伞前,实时获取着陆器的纵程s、高度变化率阻力加速度D,生成制导律uc,发送至着陆巡视器进行闭环控制。
Description
技术领域
本发明属于深空探测行星表面着陆项目中的小升力体稀薄大气进入过程的制导领域,涉及一种基于标称轨迹的解析预测校正制导方法。
背景技术
我国首次行星探测任务将通过一次发射实施行星环绕、着陆和巡视探测,任务的关键是成功实施行星表面软着陆。然而目前世界范围内共实施了18次行星着陆探测任务,完全成功仅7次,成功率不到39%,可见行星着陆探测任务难度非常大,其中,进入、下降和着陆过程(EDL,Entry,Descent,and Landing)是行星着陆探测任务面临的最大挑战。
要实现安全软着陆,降落伞能否成功打开是关键。因此大气进入段制导的首要任务是保证满足各项开伞条件约束,如开伞高度约束和动压约束。由于与地球再入情况相比,进入过程地面测控时延大,行星表面大气环境复杂多变,同时探测器的气动参数具有较大的不确定性,导致在多次打靶仿真中,进入段的终端状态散布很大,很难确保开伞条件约束均得到满足。
目前国内外公开发表的文献主要以制导精度、脱靶量为首要控制目标,很少关注开伞高度的散布,更很少文章以控制开伞高度为目标设计制导律。
发明内容
本发明的技术解决问题是:克服现有技术的不足,针对行星探测任务对开伞条件的强约束问题,提出了一种以开伞高度为控制目标的大气进入制导方法。以高度控制为目的,基于标称轨迹解析地预测终端开伞高度偏差,通过调整倾侧角实现偏差补偿,有效地减小了开伞高度和动压的散布情况,较大程度地保证了开伞的安全性,同时满足落点精度要求。
本发明的技术方案是:一种以开伞高度为控制目标的大气进入制导方法,步骤如下:
(1)完成标称轨迹设计,获得标称制导律uref,标称纵程sref,标称高度变化率标称阻力加速度Dref,标称升力加速度Lref,标称待飞高度Htogo_ref,标称飞行路径角γref;
(2)根据当前飞行纵程s,阻力D和高度变化率相对标称量sref,Dref,的偏差,以及当前速度对应的标称待飞高度Htogo_ref,预测当前的待飞高度Htogo_p;
(3)根据预测的待飞高度Htogo_p,求解控制补偿量Δu,以消除预测的待飞高度与参考待飞高度的偏差;
(4)利用制导律补偿量Δu以及步骤(1)中获得的标称制导律uref确定最终的制导律uc;
(5)在大气进入点至开伞前,实时获取着陆器的纵程s、高度变化率阻力加速度D,生成制导律uc,发送至着陆巡视器进行闭环控制。
进一步的,步骤(2)中预测待飞高度Htogo_p通过如下计算公式计算:
为待飞高度相对纵程、高度和阻力加速度的偏导数,表征高度受以上3个状态量影响的灵敏度。
进一步的,步骤(3)中的制导律补偿量Δu通过下述公式计算:
其中,K为过控系数,为高度对制导律的偏导数;制导律形式定义为D为阻力加速度,L/D为升阻比,σ为倾侧角。
进一步的,所述的过控系数K>1且在着陆巡视器升力控制能力范围内越大越好。
进一步的,制导律uc表达形式如下:
进一步的,制导指令通过下述方式进行描述:
其中,V为当前地速;Kld_R为升阻比估计修正系数,F1(V),F2(V),F3(V),F4(V)均为偏差反馈增益系数。
进一步的,所述的偏差反馈增益系数通过下述方式进行确定:
1)简化得到纵向平面内的质心动力学方程;
2)将步骤1)简化的质心动力学方程在参考轨迹附近进行线性化处理,得到线性时变***方程;
3)获得上述线性时变***方程的伴随***方程;
4)通过边界条件和伴随***方程反向积分得到其他各时刻的协态变量值λ(t),利用协态变量值计算偏差反馈增益系数。
进一步的,偏差反馈增益系数计算公式如下:
λh(V),λγ(V),λs(V),λu(V)为当前速度下的协态变量,即伴随方程的状态变量。
进一步的,升阻比估计修正系数Kld_R通过先计算实际升阻比与参考升阻比的比值,再经过一阶滤波得到。
本发明与现有技术相比有益效果为:
为了使降落伞的强开伞条件约束得到满足,本发明以高度控制为目的,基于标称轨迹解析地预测终端开伞高度偏差,通过调整倾侧角实现偏差补偿,设计了一种大气进入制导开伞高度控制方法。该方法有效地减小了开伞高度和动压的散布情况,较大程度地保证了开伞的安全性,同时满足落点精度要求。
附图说明
图1为本发明方法流程图。
具体实施方式
下面结合附图及实例对本发明作详细说明。
一种以开伞高度为控制目标的大气进入制导方法,如图1所示,步骤如下:
(1)完成标称轨迹设计,获得标称制导律uref,标称纵程sref,标称高度变化率标称阻力加速度Dref,标称升力加速度Lref,标称待飞高度Htogo_ref,标称飞行路径角γref;
(2)根据当前飞行纵程s,阻力D和高度变化率相对标称量sref,Dref,的偏差,以及当前速度对应的标称待飞高度Htogo_ref,预测当前的待飞高度Htogo_p;
为待飞高度相对纵程、高度和阻力加速度的偏导数,表征高度受以上3个状态量影响的灵敏度。
(3)制导律补偿量Δu求解,以消除预测的待飞高度与标称待飞高度的偏差:
其中,K为过控系数,为高度对制导律的偏导数;制导律形式定义为D为阻力加速度,L/D为升阻比,σ为倾侧角。
(4)利用制导律补偿量Δu以及步骤(1)中获得的标称制导律uref确定最终制导律:
即:
其中,V为当前地速。Kld_R为升阻比估计修正系数,均为偏差反馈增益系数。反馈系数具体求解步骤描述如下:
1)、简化得到纵向平面内的质心动力学方程
其中,h为飞行高度;r=rm+h为进入器质心与火星质心的距离,rm为火星半径,s为纵向航程;V为进入器相对于火星的速度大小;γ为进入器相对于火星的航迹角;σ为进入器倾侧角,用于描述进入器相对于火星的速度矢量与纵向平面的夹角,控制升力在纵向平面和水平面内的分量;μ火星的引力常数;L和D进入器的阻力和升力加速度,m为进入器质量,CL和CD分别为升力和阻力加速度系数,Sref为气动特征面积,ρ火星大气密度。
2)、将简化动力学方程在标称轨迹xref(t)=x*(t)=[s*(t),V*(t),γ*(t),h*(t)]T邻域线性化:
即
3)、获得该线性时变***的伴随***:
其边界条件为,
4)、通过反项积分求解λ(t)后求反馈增益系数:
具体求解过程原理说明如下:
不考虑控制量偏差,则在任意时刻状态偏差对末端开伞高度偏差的影响可表示为:
δHf=λT(t)δx(t)=λs(t)δs(t)+λV(t)δV(t)+λγ(t)δγ(t)+λh(t)δh(t)
因为希望飞行器到达指定的开伞高度时在理想的航程位置处,即
可得因此可通过边界条件和伴随***方程反向积分得到其他各时刻的协态变量值λ(t)。
考虑到实际飞行过程中可通过导航***测得的精确变量为阻力加速度和高度变化率,航程,而高度和飞行路径角较难测得,因此需要将高度和飞行路径角的反馈量进行转化。根据和可推导:
而以速度为自变量时有δV=0,因此可获得
整理可得
进一步考虑利用控制补偿量来抵消由于状态偏差引起的航程偏差,因此有
求解λu(t)可根据:当控制量摄动量δu为常值时,小扰动线性化方程有解如下
式中Φ(tf,t)为状态转移矩阵,上式左右两边同时乘以有
因此有
显然λu(tf)=0,则可求得λu(t)。
因此整理可得:
λs(t)=1
对比以下的公式
可得:
本发明未详细说明部分属于本领域技术人员公知常识。
Claims (9)
1.一种以开伞高度为控制目标的大气进入制导方法,其特征在于:
(1)完成标称轨迹设计,获得标称制导律uref,标称纵程sref,标称高度变化率标称阻力加速度Dref,标称升力加速度Lref,标称待飞高度Htogo_ref,标称飞行路径角γref;
(2)根据当前飞行纵程s,阻力D和高度变化率相对标称量sref,Dref,的偏差,以及当前速度对应的标称待飞高度Htogo_ref,预测当前的待飞高度Htogo_p;
(3)根据预测的待飞高度Htogo_p,求解控制补偿量Δu,以消除预测的待飞高度与参考待飞高度的偏差;
(4)利用制导律补偿量Δu以及步骤(1)中获得的标称制导律uref确定最终的制导律uc;
(5)在大气进入点至开伞前,实时获取着陆器的纵程s、高度变化率阻力加速度D,生成制导律uc,发送至着陆巡视器进行闭环控制。
2.根据权利要求1所述的方法,其特征在于:步骤(2)中预测待飞高度Htogo_p通过如下计算公式计算:
为待飞高度相对纵程、高度和阻力加速度的偏导数,表征高度受以上3个状态量影响的灵敏度。
3.根据权利要求1所述的方法,其特征在于:步骤(3)中的制导律补偿量Δu通过下述公式计算:
其中,K为过控系数,为高度对制导律的偏导数;制导律形式定义为D为阻力加速度,L/D为升阻比,σ为倾侧角。
4.根据权利要求3所述的方法,其特征在于:所述的过控系数K>1且在着陆巡视器升力控制能力范围内越大越好。
5.根据权利要求1所述的方法,其特征在于:制导律uc表达形式如下:
6.根据权利要求5所述的方法,其特征在于:制导指令通过下述方式进行描述:
其中,V为当前地速;Kld_R为升阻比估计修正系数,F1(V),F2(V),F3(V),F4(V)均为偏差反馈增益系数。
7.根据权利要求6所述的方法,其特征在于:所述的偏差反馈增益系数通过下述方式进行确定:
1)简化得到纵向平面内的质心动力学方程;
2)将步骤1)简化的质心动力学方程在参考轨迹附近进行线性化处理,得到线性时变***方程;
3)获得上述线性时变***方程的伴随***方程;
4)通过边界条件和伴随***方程反向积分得到其他各时刻的协态变量值λ(t),利用协态变量值计算偏差反馈增益系数。
8.根据权利要求6或7所述的方法,其特征在于:偏差反馈增益系数计算公式如下:
λh(V),λγ(V),λs(V),λu(V)为当前速度下的协态变量,即伴随方程的状态变量。
9.根据权利要求6所述的方法,其特征在于:升阻比估计修正系数Kld_R通过先计算实际升阻比与参考升阻比的比值,再经过一阶滤波得到。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810205370.7A CN108548541B (zh) | 2018-03-13 | 2018-03-13 | 一种以开伞高度为控制目标的大气进入制导方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810205370.7A CN108548541B (zh) | 2018-03-13 | 2018-03-13 | 一种以开伞高度为控制目标的大气进入制导方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108548541A true CN108548541A (zh) | 2018-09-18 |
CN108548541B CN108548541B (zh) | 2020-09-18 |
Family
ID=63516261
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810205370.7A Active CN108548541B (zh) | 2018-03-13 | 2018-03-13 | 一种以开伞高度为控制目标的大气进入制导方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108548541B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110015446A (zh) * | 2019-03-05 | 2019-07-16 | 上海卫星工程研究所 | 一种半解析的火星进入制导方法 |
CN110442117A (zh) * | 2019-08-26 | 2019-11-12 | 北京理工大学 | 一种火星探测器大底气动耦合分离过程安全性分析方法 |
CN110764432A (zh) * | 2019-10-14 | 2020-02-07 | 北京空间机电研究所 | 一种动态开伞控制*** |
CN114019792A (zh) * | 2021-10-08 | 2022-02-08 | 北京控制工程研究所 | 一种火星大气进入过程升力制导误差分析方法和*** |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101186539B1 (ko) * | 2011-09-19 | 2012-10-08 | 국방과학연구소 | Gps 유도킷트 탑재용 gps/ins 통합 항법 시스템 |
CN103488814A (zh) * | 2013-08-16 | 2014-01-01 | 北京航空航天大学 | 一种适用于再入飞行器姿态控制的闭环仿真*** |
CN104035335A (zh) * | 2014-05-27 | 2014-09-10 | 北京航空航天大学 | 基于高精度纵、横程解析预测方法的平稳滑翔再入制导律 |
CN105867402A (zh) * | 2016-05-10 | 2016-08-17 | 北京航空航天大学 | 一种火星着陆器大气进入段抗干扰复合在线制导方法 |
CN106292701A (zh) * | 2016-08-16 | 2017-01-04 | 北京控制工程研究所 | 一种基于扰动补偿思想的rlv进场着陆段制导律获取方法 |
-
2018
- 2018-03-13 CN CN201810205370.7A patent/CN108548541B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101186539B1 (ko) * | 2011-09-19 | 2012-10-08 | 국방과학연구소 | Gps 유도킷트 탑재용 gps/ins 통합 항법 시스템 |
CN103488814A (zh) * | 2013-08-16 | 2014-01-01 | 北京航空航天大学 | 一种适用于再入飞行器姿态控制的闭环仿真*** |
CN104035335A (zh) * | 2014-05-27 | 2014-09-10 | 北京航空航天大学 | 基于高精度纵、横程解析预测方法的平稳滑翔再入制导律 |
CN105867402A (zh) * | 2016-05-10 | 2016-08-17 | 北京航空航天大学 | 一种火星着陆器大气进入段抗干扰复合在线制导方法 |
CN106292701A (zh) * | 2016-08-16 | 2017-01-04 | 北京控制工程研究所 | 一种基于扰动补偿思想的rlv进场着陆段制导律获取方法 |
Non-Patent Citations (2)
Title |
---|
曾亮 等: ""探月飞船跳跃式再入组合制导方法"", 《国防科技大学学报》 * |
郭敏文 等: ""非一致终端约束下火星大气进入段制导律设计"", 《深空探测学报》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110015446A (zh) * | 2019-03-05 | 2019-07-16 | 上海卫星工程研究所 | 一种半解析的火星进入制导方法 |
CN110442117A (zh) * | 2019-08-26 | 2019-11-12 | 北京理工大学 | 一种火星探测器大底气动耦合分离过程安全性分析方法 |
CN110764432A (zh) * | 2019-10-14 | 2020-02-07 | 北京空间机电研究所 | 一种动态开伞控制*** |
CN114019792A (zh) * | 2021-10-08 | 2022-02-08 | 北京控制工程研究所 | 一种火星大气进入过程升力制导误差分析方法和*** |
CN114019792B (zh) * | 2021-10-08 | 2023-08-01 | 北京控制工程研究所 | 一种火星大气进入过程升力制导误差分析方法和*** |
Also Published As
Publication number | Publication date |
---|---|
CN108548541B (zh) | 2020-09-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108548541A (zh) | 一种以开伞高度为控制目标的大气进入制导方法 | |
CN105867402B (zh) | 一种火星着陆器大气进入段抗干扰复合在线制导方法 | |
Akos et al. | Thermal soaring flight of birds and unmanned aerial vehicles | |
Kahveci et al. | Adaptive LQ control with anti-windup augmentation to optimize UAV performance in autonomous soaring applications | |
Shue et al. | Design of automatic landing systems using mixed h/h control | |
EP2224306B1 (en) | Automatic pilot pitch angle compensation | |
CN103466084A (zh) | 起飞/着陆的触地降落保护管理*** | |
CN104635488B (zh) | 一种火星大气进入段鲁棒预测制导方法 | |
CN102762451B (zh) | 带有流动影响装置结构的飞机 | |
CN108153323A (zh) | 一种高空无人飞行器高精度再入制导方法 | |
CN108873929A (zh) | 一种固定翼飞机自主着舰方法及*** | |
Bergeron et al. | Accuglide: Precision airdrop guidance and control via glide slope control | |
Abdulrahim et al. | Dynamic sensitivity to atmospheric turbulence of unmanned air vehicles with varying configuration | |
CN111989265A (zh) | 超低轨道卫星轨道自主维持方法 | |
CN109703769B (zh) | 一种基于预瞄策略的空中加油对接控制方法 | |
CN108534785B (zh) | 一种大气进入制导轨迹自适应规划方法 | |
CN104163244A (zh) | 一种无人机伞降方法 | |
Chen et al. | A virtual structure formation guidance strategy for multi-parafoil systems | |
CN104932266B (zh) | 一种基于前馈补偿的着陆器进入段精确控制方法 | |
Jie et al. | Flight controller design of transport airdrop | |
CN108562293B (zh) | 基于干扰观测器的行星着陆有限时间控制方法 | |
Culpepper et al. | Adaptive control of damaged parafoils | |
El Tin et al. | Exploitation of thermals in powered and unpowered flight of autonomous gliders | |
CN112278325B (zh) | 一种基于法向过载的总攻角控制方法 | |
Zheng et al. | Improvements to entry terminal point controller for Mars atmospheric entry |
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 |