CN107804487B - 一种基于自适应偏差控制的跳跃式再入返回落点预报方法 - Google Patents
一种基于自适应偏差控制的跳跃式再入返回落点预报方法 Download PDFInfo
- Publication number
- CN107804487B CN107804487B CN201710957033.9A CN201710957033A CN107804487B CN 107804487 B CN107804487 B CN 107804487B CN 201710957033 A CN201710957033 A CN 201710957033A CN 107804487 B CN107804487 B CN 107804487B
- Authority
- CN
- China
- Prior art keywords
- sigma
- roll angle
- point
- drop point
- deviation
- 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
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/22—Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
- B64G1/24—Guiding or controlling apparatus, e.g. for attitude control
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Aerodynamic Tests, Hydrodynamic Tests, Wind Tunnels, And Water Tanks (AREA)
Abstract
本发明提供了一种基于自适应偏差控制的跳跃式再入返回落点预报方法,首先接收返回器的实时状态量,读取初始制导律与返回器空气动力学系数,然后将初始制导律代入弹道积分方程,计算首次落点偏差,比较落点偏差与预定落点偏差并计算倾侧角的一次调整量,继续计算二次落点与一次落点的偏差,计算二次倾侧角修正量,最终更新倾侧角并第三次计算落点。本发明能够自适应再入返回过程中的各项测量偏差,高精度地预报落点,为嫦娥返回器等飞行器的再入返回提供技术支撑。
Description
技术领域
本发明属于航天测量与控制领域,涉及航天器采用跳跃式再入返回行星地表的落点预报方法。
背景技术
航天器再入大气层返回有弹道式、升力式与跳跃式三种方式。跳跃式返回主要用于探月航天器的返回着陆与回收,具有进入大气层速度高、升力控制复杂、误差源多、落点散布范围广等特点。
航天器的返回制导一般有两种方法,一种是标称弹道法,即将航天器当前弹道与预先设计的标称弹道进行比较,控制弹道偏差,是航天器飞行过程中不断向标称弹道调整,另一种是预测校正制导法,航天器读取当前弹道状态,不断计算落点,将计算落点与设计落点的偏差作为反馈,通过调整落点偏差实现制导。
我国从嫦娥五号(含试验飞行器)开始,实施月球探测器的返回回收任务,探测器均采用跳跃式再入返回技术,星上制导控制均采用预测校正的方式。再入返回落点预报过程中包含了返回器的气动系数误差、大气密度误差和位置速度误差,嫦娥五号试验飞行器任务中,实际再入点的位置与理论弹道再入点的位置相差上百公里,传统的基于标称弹道偏差制导落点预报法由于对各项偏差的适应能力较差,已不能满足跳跃式再入返回航天器的落点预报需求。需要根据各种再入过程误差源设计新的基于自适应偏差控制的跳跃式再入返回落点预报方法。
发明内容
为了克服现有技术的不足,本发明提供一种航天器跳跃式再入返回过程中预测校正式的落点预报方法,能够自适应再入返回过程中的各项测量偏差,高精度地预报落点,为嫦娥返回器等飞行器的再入返回提供技术支撑。
本发明解决其技术问题所采用的技术方案包括如下步骤:
步骤一,接收返回器的实时状态量,包括时间t、位置X、速度V以及相对于再入点的时间间隔Δt;
步骤二,读取初始制导律与返回器空气动力学系数;定义地心至返回器质心的矢量为R,R与速度V所在的平面为RV平面,则倾侧角σ定义为返回器所受气动力中升力矢量L与RV平面的夹角,面向速度方向右手方向为正;依据Δt读取t时刻及以后的制导律;
步骤三,将初始制导律代入弹道积分方程,进行动力学积分;
步骤五,比较落点偏差S10与预定落点偏差S0,若S10<S0,则记落点为S1,并转到步骤六,否则调整[t t+Δt]区间的倾侧角值ΔT并转至步骤三,其中ΔT为预设的制导律调节区间倾侧角的调整值;
步骤六,读取反馈系数K=dσ/dS,其中dσ为倾侧角数值的调整量,dS为调整量dσ带来的落点偏差;计算倾侧角σ的一次调整量Δσ1=K·S10,依据Δσ1更新倾侧角,更新后的倾侧角σ'=σ+Δσ1;
步骤七,依据更新后的倾侧角σ'积分弹道至预定高度,并计算二次落点S2,比较二次落点S2与落点S1的偏差,记为S21;
步骤八,计算二次倾侧角修正量Δσ2=Δσ1/S21·S10;
步骤九,更新倾侧角σ”=σ+Δσ2;依据更新后的倾侧角σ”,第三次计算落点S3,输出S3并返回步骤一。
所述步骤三中的弹道积分方程为:
其中,r、θ、分别为航天器在行星固定坐标系的地心距、经度、纬度,V、γ、ψ分别为航天器在行星固定坐标系的速度矢量、速度俯仰角、飞行路径角,m为航天器质量,D、L分别为航天器的阻力和升力;σ为返回器的倾侧角,返回器的倾侧角是时间的函数,以数据表的形式存储,积分过程中不断查询t时刻的倾侧角,并对积分公式中的σ重新赋值;μ为地球引力常数,RE为赤道半径,J为引力场球谐函数中J2项系数的1.5倍,ω为地球自转角速度。
所述的预定高度是指返回器减速伞开伞点高度。
本发明的有益效果是:可以完成航天器在跳跃式返回过程中的落点预报,解决了航天器再入过程中在再入点、再入角、气动力模型、大气环境等各类偏差因素存在的情况下的自适应偏差落点预报问题,能够适应月地返回、火星探测器返回等任务的要求,在航天器的测量控制领域具有广泛的应用前景。
附图说明
图1是一种航天器跳跃式再入返回落点预报方法总体流程图;
图2是预测与实测弹道高度随时间变化关系。
具体实施方式
下面结合附图和实施例对本发明进一步说明,本发明包括但不仅限于下述实施例。
本发明提供的基于自适应偏差控制的跳跃式再入返回落点预报方法,其总体流程如图1所示,包括如下步骤:
步骤一:接收返回器的实时状态量,包括:时间t、位置X、速度V、相对于再入点的时间间隔Δt。再入点定义为返回飞控程序规定的再入飞行开始的高度点,定义再入点的时刻为t0,则Δt定义为
Δt=t-t0 (1)
步骤二:读取初始制导律与返回器空气动力学系数。制导律为一组返回器的倾侧角序列,规定了不同时刻返回器倾侧角值。初始制导律主要由专家通过多次的数值实验设计产生。定义地心至返回器质心的矢量为R,地心矢量R与速度矢量V所在的平面为RV平面,则倾侧角σ定义为返回器所受气动力中升力矢量L与RV平面的夹角,面向速度方向右手方向为正。依据相对时Δt,读取t时刻及以后的制导律;
步骤三:将读取初始的制导律,代入弹道积分方程,进行动力学积分。其中动力学积分中引力加速度考虑行星的非球形引力摄动项(主要是J2项),大气密度模型采用标准大气模型SA76,SA76大气模型是美国公布的适用于大气层以下高度的标准静态大气模型。积分方法采用8阶龙格-库塔法,动力学方程的表达式为:
其中,r、θ、分别为航天器在行星固定坐标系的地心距、经度、纬度,V、γ、ψ分别为航天器在行星固定坐标系的速度矢量、速度俯仰角、飞行路径角,m为航天器质量,D、L分别为航天器的阻力和升力,σ为返回器的倾侧角,返回器的倾侧角是时间的函数,以数据表的形式存储在内存中,积分过程中不断查询t时刻的倾侧角,并对积分公式中的σ重新赋值。μ为地球引力常数(通常取为3.986004418×1014m3s-2),RE为赤道半径,J为引力场球谐函数中J2项系数的1.5倍,ω为地球自转角速度。其中计算升力和阻力需要用到大气模型以及航天器的当前高度、飞行速度,主要通过返回器前期的风洞试验获取。
步骤四:积分至预定高度(一般为返回器减速伞开伞点),返回落点的纬度、经度、高度,分别为BLH(1)、BLH(2)、BLH(3)。设理论落点的纬度、经度分别为BLH0(1)、BLH0(2)按照下式与理论落点BLH0比较,计算首次落点偏差S10
步骤五:比较落点偏差S10与预定落点偏差S0,若S10<S0,则记落点为S1,并转到步骤六,否则调整[t t+ΔT]区间的倾侧角值,其中ΔT不同于Δt,Δt为航天器当前时刻点相对于再入点经历的时间间隔,ΔT为预设的制导律调节区间倾侧角的调整值,主要取决于航程偏差,调整幅度取决于预先的多次数值实验,即通过多次打靶试验,获取能使返回器准确返回落区的一组分段线性函数值,如倾侧角增加5°航程增加500km,若当前航程小于预计航程300km,则倾侧角增加3°。并转至步骤三;
步骤六:读取反馈系数K。反馈系数定义为反映落点偏差与当前倾侧角值的关系的参数,预先通过多次的弹道打靶实验设计并存储于文件,其主要的计算方法是微小地调整倾侧角数值,设调整量为dσ,计算落点偏差dS,则反馈系数为K=dσ/dS,即倾侧角相对落点偏差的导数。Δ依据落点偏差S10与反馈系数K计算倾侧角σ的一次调整量Δσ1(Δσ1=K·S10),依据Δσ1更新倾侧角,更新后的倾侧角为:
σ'=σ+Δσ1 (4)
步骤七:依据更新后的倾侧角σ'积分弹道至预定高度,并计算二次落点S2,比较二次落点S2与首次落点S1的偏差,记为S21。
步骤八:依据S21、S10以及一次倾侧角调整量Δσ1,计算二次倾侧角修正量Δσ2,计算公式如下:
Δσ2=Δσ1/S21·S10 (5)
步骤九:依据二次倾侧角修正量Δσ2,更新倾侧角,更新后的倾侧角为
σ”=σ+Δσ2 (6)
依据更新后的倾侧角σ”,第三次计算落点S3,返回S3,并等待接收下一次实时状态量的初值,再转至步骤一。
本发明采用嫦娥五号T1任务再入返回实测数据为例,进行计算验证:
步骤一:接收返回器的实时状态量,包括:时间t、位置X、速度V、相对于再入点的时间间隔Δt;
步骤二:读取初始制导律与返回器空气动力学系数;
步骤三:将读取初始的制导律,代入弹道积分方程,准备动力学积分。包括如下子步骤:
子步骤一:根据位置X计算返回器高度h,若高度大于预定高度,则根据高度h代入标准大气模型计算空气密度ρ以及高度h对应的声速VS,否则转至步骤四。
子步骤二:根据速度V计算返回器的马赫数Ma=V/VS,结合返回器的空气动力学系数计算升力L与阻力D。
子步骤三:将升力L、阻力D、初始倾侧角σ代入动力学微分方程,进行数值积分。
子步骤四:积分单步长后,更新状态矢量X、V,转至子步骤一。
步骤四:返回落点的纬度、经度、高度,分别为BLH(1)、BLH(2)、BLH(3)。设理论落点的纬度、经度分别为BLH0(1)、BLH0(2)按照式(2)与理论落点BLH0比较,计算首次落点偏差S10;
步骤五:比较落点偏差S10与预定落点偏差S0,比较落点偏差S10与预定落点偏差S0,若S10<S0,则记落点为S1,并转到步骤六,否则调整[t t+ΔT]区间的倾侧角值,其并转至步骤三;
步骤六:读取反馈系数K。依据落点偏差S10与反馈系数K计算倾侧角σ的一次调整量Δσ1,依据Δσ1更新倾侧角,更新后的倾侧角为
σ'=σ+Δσ1 (7)
步骤七:依据更新后的倾侧角σ'积分弹道至预定高度,并计算二次落点S2,比较二次落点S2与首次落点S1的偏差,记为S21。
步骤八:依据S21、S10以及一次倾侧角调整量Δσ1,计算二次倾侧角修正量Δσ2,计算公式如下
Δσ2=Δσ1/S21·S10 (8)
步骤九:依据二次倾侧角修正量Δσ2,更新倾侧角,更新后的倾侧角为
σ”=σ+Δσ2 (9)
依据更新后的倾侧角σ”,第三次计算落点S3,返回S3。
利用再入返回过程中实测的舱器分离点数据计算弹道与落点,预报与实测弹道的比较如图2所示,预测落点与实际落点经度差-0.001277°,纬度差-0.00177°,位置偏差0.223m,落地时间偏差-10s。预报弹道与实测弹道趋势一致,预报落点与实际落点时刻与位置非常接近,验证了该落点预报方法的有效性和精度。
Claims (3)
1.一种基于自适应偏差控制的跳跃式再入返回落点预报方法,其特征在于包括下述步骤:
步骤一,接收返回器的实时状态量,包括时间t、位置X、速度V以及相对于再入点的时间间隔Δt;
步骤二,读取初始制导律与返回器空气动力学系数;定义地心至返回器质心的矢量为R,R与速度V所在的平面为RV平面,则倾侧角σ定义为返回器所受气动力中升力矢量L与RV平面的夹角,面向速度方向右手方向为正;依据Δt读取t时刻及以后的制导律;
步骤三,将初始制导律代入弹道积分方程,进行动力学积分;
步骤四,积分至预定高度,返回落点的纬度、经度、高度,分别为BLH(1)、BLH(2)、BLH(3);设理论落点的纬度、经度分别为BLH0(1)、BLH0(2),计算首次落点偏差
步骤五,比较落点偏差S10与预定落点偏差S0,若S10<S0,则记落点为S1,并转到步骤六,否则调整[t,t+Δt]区间的倾侧角值ΔT并转至步骤三,其中ΔT为预设的制导律调节区间倾侧角的调整值;
步骤六,读取反馈系数K=dσ/dS,其中dσ为倾侧角数值的调整量,dS为调整量dσ带来的落点偏差;计算倾侧角σ的一次调整量Δσ1=K·S10,依据Δσ1更新倾侧角,更新后的倾侧角σ'=σ+Δσ1;
步骤七,依据更新后的倾侧角σ'积分弹道至预定高度,并计算二次落点S2,比较二次落点S2与落点S1的偏差,记为S21;
步骤八,计算二次倾侧角修正量Δσ2=Δσ1/S21·S10;
步骤九,更新倾侧角σ”=σ+Δσ2;依据更新后的倾侧角σ”,第三次计算落点S3,输出S3并返回步骤一。
3.根据权利要求1所述的基于自适应偏差控制的跳跃式再入返回落点预报方法,其特征在于:所述的预定高度是指返回器减速伞开伞点高度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710957033.9A CN107804487B (zh) | 2017-10-16 | 2017-10-16 | 一种基于自适应偏差控制的跳跃式再入返回落点预报方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710957033.9A CN107804487B (zh) | 2017-10-16 | 2017-10-16 | 一种基于自适应偏差控制的跳跃式再入返回落点预报方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107804487A CN107804487A (zh) | 2018-03-16 |
CN107804487B true CN107804487B (zh) | 2020-09-01 |
Family
ID=61584971
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710957033.9A Expired - Fee Related CN107804487B (zh) | 2017-10-16 | 2017-10-16 | 一种基于自适应偏差控制的跳跃式再入返回落点预报方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107804487B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109159927B (zh) * | 2018-06-26 | 2021-04-23 | 中国人民解放军63921部队 | 一种再入段对返回器可见测站区域确定的方法 |
CN115560638B (zh) * | 2022-09-02 | 2023-05-09 | 北京理工大学 | 基于修正量与控制时间关系的抗卫星失效弹道控制方法 |
CN116702439B (zh) * | 2023-05-19 | 2024-02-13 | 北京理工大学 | 基于再入落点预测模型的仿真用飞行器再入落点预测方法 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2819597B1 (fr) * | 2001-01-15 | 2003-04-11 | Cit Alcatel | Procede de guidage d'un systeme d'actionneurs gyrospcopiques |
CN103863579B (zh) * | 2014-03-31 | 2015-11-25 | 北京控制工程研究所 | 一种深空探测返回过程的预测校正制导方法 |
CN104843197B (zh) * | 2014-12-19 | 2016-01-13 | 北京控制工程研究所 | 一种跳跃式再入的双环制导方法 |
CN105115512B (zh) * | 2015-09-23 | 2017-10-10 | 北京理工大学 | 一种火星大气进入段侧向预测校正制导方法 |
-
2017
- 2017-10-16 CN CN201710957033.9A patent/CN107804487B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN107804487A (zh) | 2018-03-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107966156B (zh) | 一种适用于运载火箭垂直回收段的制导律设计方法 | |
CN107804487B (zh) | 一种基于自适应偏差控制的跳跃式再入返回落点预报方法 | |
US20190121369A1 (en) | Airplane Climb Thrust Optimization | |
CN107121929B (zh) | 基于线性协方差模型预测控制的鲁棒再入制导方法 | |
CN107844128B (zh) | 一种基于复合比例导引的高超声速飞行器巡航段制导方法 | |
CN110015446B (zh) | 一种半解析的火星进入制导方法 | |
CN107021237A (zh) | 合成空气数据输出生成 | |
CN109446582B (zh) | 一种考虑地球自转的高精度降阶平稳滑翔动力学建模方法 | |
CN108388135A (zh) | 一种基于凸优化的火星着陆轨迹优化控制方法 | |
CN107861517A (zh) | 基于线性伪谱的跳跃式再入飞行器在线弹道规划制导方法 | |
CN110908407B (zh) | 一种rlv再入热流率跟踪的改进预测制导方法 | |
CN107367941B (zh) | 高超声速飞行器攻角观测方法 | |
CN113758383B (zh) | 一种用于验证垂直起降技术的可重复使用火箭及验证方法 | |
CN110059285B (zh) | 考虑j2项影响的导弹自由段弹道偏差解析预报方法 | |
Zhang et al. | Dynamics analysis and simulation of six DOF parafoil system | |
CN107796401B (zh) | 跳跃式再入飞行器线性伪谱参数修正横向制导方法 | |
CN110826189B (zh) | 一种飞行器缩比模型实验系统的确定方法 | |
Shen et al. | A 6DOF mathematical model of parachute in Mars EDL | |
Chang | Fuzzy Logic‐Based Aerodynamic Modeling with Continuous Differentiability | |
CN114104339B (zh) | 基于降落伞落点离线分析的火星着陆器降落伞规避方法 | |
CN107942673B (zh) | 一种开伞点高度跟踪的火星大气进入段解析制导方法 | |
Curry et al. | Ground-effect characteristics of the Tu-144 supersonic transport airplane | |
Dobrescu et al. | Parachute systems for the atmospheric reentry of launcher upper stages | |
Wickramasinghe et al. | A study on modeling techniques for fuel burn estimation based on flight simulator experiment data | |
Hathaway et al. | Development of a microgravity generating flight mode for UAS |
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: 20200901 Termination date: 20211016 |