CN109711010A - 一种垂直起降火箭在线轨迹规划的发动机特性处理方法 - Google Patents
一种垂直起降火箭在线轨迹规划的发动机特性处理方法 Download PDFInfo
- Publication number
- CN109711010A CN109711010A CN201811528443.2A CN201811528443A CN109711010A CN 109711010 A CN109711010 A CN 109711010A CN 201811528443 A CN201811528443 A CN 201811528443A CN 109711010 A CN109711010 A CN 109711010A
- Authority
- CN
- China
- Prior art keywords
- rocket
- trajectory planning
- engine characteristics
- engine
- processing method
- 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
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
- Management, Administration, Business Operations System, And Electronic Commerce (AREA)
Abstract
本发明涉及一种垂直起降火箭在线轨迹规划的发动机特性处理方法,将离线测得的火箭的发动机特性添加到在线轨迹规划动力学微分方程中,解决真实飞行过程中主控机给的控制指令发动机无法及时响应的技术难题,最终使火箭按照既定的规划轨迹去完成飞行任务。本发明通过直接限制发动机指令值的大小,进而约束了火箭竖直方向加速度的范围,保证了火箭飞行过程中的稳定性。当飞行接近结束时,可以直接限制发动机指令值等于g/k,保证火箭的真实推力产生的加速度值等于g,实现软着陆。
Description
技术领域
本发明涉及一种垂直起降火箭在线轨迹规划的发动机特性处理方法,火箭的轨迹在线规划技术领域。
背景技术
在线轨迹规划技术是一项运载器飞行过程中实时规划一条运载器运动轨迹满足各种等式及不等式约束条件的技术。在垂直起降重复使用火箭下落段中的飞行控制中,在线轨迹规划技术的引入可以解决火箭开始下落位置的不确定性难题。现有轨迹规划问题描述中动力学等式约束描述了一般只是考虑了飞行过程中位置、速度、加速度及控制量之间的关系,并没有将发动机特性描述引入其中,导致制导精度差。而真实的火箭在飞行试验中,发动机特性会从根本上影响火箭的运动状况,主控机给的控制指令发动机无法及时响应,即使规划出了一条可行的飞行轨迹,也不能按照既定的规划去完成飞行任务。
如何在发动机在线轨迹规划中引入发动机稳态特性和发动机调节特性,是本领域亟待解决的技术问题。
发明内容
本发明的目的在于克服现有技术的不足,提供一种垂直起降火箭在线轨迹规划的发动机特性处理方法,将发动机特性引入在线轨迹规划动力学等式约束描述中,引入量包含发动机稳态特性和发动机调节特性,以解决真实飞行过程中主控机给的控制指令发动机无法及时响应的问题,最终使火箭按照既定的规划轨迹去完成飞行任务。
本发明目的通过如下技术方案予以实现:
提供一种垂直起降火箭在线轨迹规划的发动机特性处理方法,包括如下步骤:
(1)构建火箭在线轨迹规划动力学微分方程;
(2)构建发动机特性等效模型;
(3)获取发动机特性等效模型的动力学微分方程形式,并补入动力学微分方程;
(4)在微分方程中补加火箭竖直方向加速度ay的微分方程;
(5)构建包含发动机特性的在线轨迹规划动力学等式约束方程;
(6)实时获取状态量X,通过线轨迹规划动力学等式约束方程实时求解控制量U;
(7)获取水平面内横纵方向所产生的推力加速度指令ux,uz,计算发动机推力指令,按照推力指令控制发动机。
优选的,在线轨迹规划动力学微分方程为:
其中y为火箭竖直方向的位移,ay为火箭竖直方向产生的加速度,vy为火箭竖直方向产生的速度。
优选的,发动机特性等效二阶模型如下:
其中uy为竖直方向所产生的推力加速度指令,k为等效稳态增益,w为等效频率,ξ为等效阻尼系数,s为变换算子。
优选的,测量发动机的真实增益作为k值,真实相应频率作为w,真实阻尼系数作为ξ值。
优选的,进行火箭半实物仿真,根据发动机推力响应偏差,调整k、w、ξ的值,减小发动机推力响应偏差。
优选的,动力学微分方程根据实际精度要求,发动机特性等效模型采用一阶、二阶或三阶等效模型。
优选的,等效模型的动力学微分方程形式如下:
优选的,补入的火箭竖直方向加速度ay的微分方程范围
优选的,在线轨迹规划动力学等式约束方程如下:
其中状态量和控制量U=[uy]′A和B分别为状态量和控制量前的系数。
优选的,
优选的,计算发动机推力指令T的公式如下:
其中M为火箭质量,g为重力加速度。
本发明与现有技术相比具有如下优点:
(1)本发明将离线测得的火箭的发动机特性添加到在线轨迹规划动力学微分方程中,解决真实飞行过程中主控机给的控制指令发动机无法及时响应的技术难题,最终使火箭按照既定的规划轨迹去完成飞行任务。
(2)本发明通过直接限制发动机指令值的大小,进而约束了火箭竖直方向加速度的范围,保证了火箭飞行过程中的稳定性。
(3)当接近飞行结束时,可以直接限制发动机指令值等于g/k,保证火箭的真实推力产生的加速度值等于g,实现软着陆。
附图说明
图1为垂直起降火箭在线轨迹规划的发动机特性处理方法方案示意图。
具体实施方式
本发明的技术方案是在已有的在线轨迹规划动力学等式约束描述中添加发动机特性部分,将发动机特性描述改为动力学微分方程形式引入在线轨迹规划动力学等式微分方程中即可,如图1所示。
具体实现步骤如下:
1)构建火箭在线轨迹规划动力学微分方程
按照发射惯性坐标系原点在发射点o,ox轴在发射点水平面内,指向发射瞄准方向;oy轴垂直于发射点水平面,指向上方,oz轴垂直于xoy面,构成右手坐标系。
设火箭竖直方向的位移为y,竖直方向产生的速度vy,竖直方向产生的加速度为ay。则可构建动力学方程如下:
2)构建发动机特性等效二阶模型
设竖直方向所产生的推力指令为uy,为使推导方便,在此将推力指令uy定义为加速度形式。本发明选用的发动机模型为二阶模型,其中发动机稳态增益为k,频率为w,阻尼系数为ξ,则发动机的等效二阶模型如下:
3)获取发动机特性等效模型的动力学微分方程形式,并补入动力学微分方程:
上式等效模型二阶形式,根据实际精度要求选择等效模型的形式,也可采用一阶、三阶等形式。
4)在微分方程中补加ay的微分方程
5)构建包含发动机特性的在线轨迹规划动力学等式约束方程
设状态量X和控制量U分别为:
则可得到包含发动机特性的在线轨迹规划动力学微分方程如下,其中A和B分别为状态量和控制量前的系数。
可以设置每个状态量和控制量的约束,进而保证了火箭在飞行过程中发动机控制指令不会超出发动机本身的能力范围。
6)实时获取状态量X,通过线轨迹规划动力学等式约束方程实时求解控制量U。
7)获取水平面内横纵方向所产生的推力加速度指令ux,uz,计算发动机推力指令
M为火箭质量,g为重力加速度。
按照推力指令控制发动机。ux,uz姿态控制回路中计算获得,在发动机特性回路中直接使用这两个参数。
以上所述,仅为本发明最佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。
本发明说明书中未作详细描述的内容属于本领域专业技术人员的公知技术。
Claims (11)
1.一种垂直起降火箭在线轨迹规划的发动机特性处理方法,其特征在于,包括如下步骤:
(1)构建火箭在线轨迹规划动力学微分方程;
(2)构建发动机特性等效模型;
(3)获取发动机特性等效模型的动力学微分方程形式,并补入动力学微分方程;
(4)在微分方程中补加火箭竖直方向加速度ay的微分方程;
(5)构建包含发动机特性的在线轨迹规划动力学等式约束方程;
(6)实时获取状态量X,通过线轨迹规划动力学等式约束方程实时求解控制量U;
(7)获取水平面内横纵方向所产生的推力加速度指令ux,uz,计算发动机推力指令,按照推力指令控制发动机。
2.如权利要求1所述的垂直起降火箭在线轨迹规划的发动机特性处理方法,其特征在于,在线轨迹规划动力学微分方程为:
其中y为火箭竖直方向的位移,ay为火箭竖直方向产生的加速度,vy为火箭竖直方向产生的速度。
3.如权利要求2所述的垂直起降火箭在线轨迹规划的发动机特性处理方法,其特征在于,发动机特性等效二阶模型如下:
其中uy为竖直方向所产生的推力加速度指令,k为等效稳态增益,w为等效频率,ξ为等效阻尼系数,s为变换算子。
4.如权利要求3所述的垂直起降火箭在线轨迹规划的发动机特性处理方法,其特征在于,测量发动机的真实增益作为k值,真实相应频率作为w,真实阻尼系数作为ξ值。
5.如权利要求4所述的垂直起降火箭在线轨迹规划的发动机特性处理方法,其特征在于,进行火箭半实物仿真,根据发动机推力响应偏差,调整k、w、ξ的值,减小发动机推力响应偏差。
6.如权利要求3所述的垂直起降火箭在线轨迹规划的发动机特性处理方法,其特征在于,动力学微分方程根据实际精度要求,发动机特性等效模型采用一阶、二阶或三阶等效模型。
7.如权利要求6所述的垂直起降火箭在线轨迹规划的发动机特性处理方法,其特征在于,等效模型的动力学微分方程形式如下:
8.如权利要求7所述的垂直起降火箭在线轨迹规划的发动机特性处理方法,其特征在于,补入的火箭竖直方向加速度ay的微分方程范围
9.如权利要求8所述的垂直起降火箭在线轨迹规划的发动机特性处理方法,其特征在于,在线轨迹规划动力学等式约束方程如下:
其中状态量和控制量U=[uy]′A和B分别为状态量和控制量前的系数。
10.如权利要求9所述的垂直起降火箭在线轨迹规划的发动机特性处理方法,其特征在于,
11.如权利要求9所述的垂直起降火箭在线轨迹规划的发动机特性处理方法,其特征在于,计算发动机推力指令T的公式如下:
其中M为火箭质量,g为重力加速度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811528443.2A CN109711010B (zh) | 2018-12-13 | 2018-12-13 | 一种垂直起降火箭在线轨迹规划的发动机特性处理方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811528443.2A CN109711010B (zh) | 2018-12-13 | 2018-12-13 | 一种垂直起降火箭在线轨迹规划的发动机特性处理方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109711010A true CN109711010A (zh) | 2019-05-03 |
CN109711010B CN109711010B (zh) | 2023-05-12 |
Family
ID=66256385
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811528443.2A Active CN109711010B (zh) | 2018-12-13 | 2018-12-13 | 一种垂直起降火箭在线轨迹规划的发动机特性处理方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109711010B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112507461A (zh) * | 2020-12-15 | 2021-03-16 | 北京航天自动控制研究所 | 一种运载火箭动力软着陆段发动机开机方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015030334A (ja) * | 2013-08-01 | 2015-02-16 | 三菱スペース・ソフトウエア株式会社 | 推力方向算出装置、推力方向算出プログラム、推力方向算出方法、飛翔体および飛翔体誘導方法 |
CN106021628A (zh) * | 2015-07-03 | 2016-10-12 | 中国运载火箭技术研究院 | 一种运载火箭垂直返回弹道设计方法 |
CN106126777A (zh) * | 2016-06-13 | 2016-11-16 | 北京航空航天大学 | 一种双级四滑块柔性单轨火箭橇垂向动力学响应计算方法 |
WO2017018903A1 (ru) * | 2015-07-28 | 2017-02-02 | Общество С Ограниченной Ответственностью "Космокурс" Ооо "Космокурс" | Способ выведения на орбиту полезной нагрузки ракетой-носителем |
CN107966156A (zh) * | 2017-11-24 | 2018-04-27 | 北京宇航系统工程研究所 | 一种适用于运载火箭垂直回收段的制导律设计方法 |
-
2018
- 2018-12-13 CN CN201811528443.2A patent/CN109711010B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015030334A (ja) * | 2013-08-01 | 2015-02-16 | 三菱スペース・ソフトウエア株式会社 | 推力方向算出装置、推力方向算出プログラム、推力方向算出方法、飛翔体および飛翔体誘導方法 |
CN106021628A (zh) * | 2015-07-03 | 2016-10-12 | 中国运载火箭技术研究院 | 一种运载火箭垂直返回弹道设计方法 |
WO2017018903A1 (ru) * | 2015-07-28 | 2017-02-02 | Общество С Ограниченной Ответственностью "Космокурс" Ооо "Космокурс" | Способ выведения на орбиту полезной нагрузки ракетой-носителем |
CN106126777A (zh) * | 2016-06-13 | 2016-11-16 | 北京航空航天大学 | 一种双级四滑块柔性单轨火箭橇垂向动力学响应计算方法 |
CN107966156A (zh) * | 2017-11-24 | 2018-04-27 | 北京宇航系统工程研究所 | 一种适用于运载火箭垂直回收段的制导律设计方法 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112507461A (zh) * | 2020-12-15 | 2021-03-16 | 北京航天自动控制研究所 | 一种运载火箭动力软着陆段发动机开机方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109711010B (zh) | 2023-05-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107992074B (zh) | 一种基于飞行路径角规划的再入轨迹设计方法 | |
Lupashin et al. | A simple learning strategy for high-speed quadrocopter multi-flips | |
CN111306989B (zh) | 一种基于平稳滑翔弹道解析解的高超声速再入制导方法 | |
CN107966156B (zh) | 一种适用于运载火箭垂直回收段的制导律设计方法 | |
CN106681348B (zh) | 考虑全捷联导引头视场约束的制导控制一体化设计方法 | |
CN110008502A (zh) | 考虑全捷联导引头视场约束的三维制导控制一体化设计方法 | |
CN106292294B (zh) | 基于模型参考自适应控制的舰载无人机自动着舰控制装置 | |
CN104199303B (zh) | 一种基于矢量场制导的平流层卫星平面路径跟踪控制方法 | |
CN109597303A (zh) | 一种复合式旋翼飞行器全模式飞行控制方法 | |
CN111258216B (zh) | 一种适用于四旋翼飞行器的滑模重复控制器 | |
CN103869817A (zh) | 一种倾转四旋翼无人机垂直起降控制方法 | |
Yang et al. | Self-tuning PID control design for quadrotor UAV based on adaptive pole placement control | |
CN106114910B (zh) | 一种航天器飞行轨道滚动时域控制方法 | |
CN103592946B (zh) | 一种基于视加速度测量的主动段程序自适应纵向制导方法 | |
CN110119089A (zh) | 一种基于积分滑模的浸入不变流型自适应四旋翼控制方法 | |
CN105425812A (zh) | 一种基于双模型下的无人机自动着舰轨迹控制方法 | |
CN105116914B (zh) | 一种平流层飞艇解析模型预测路径跟踪控制方法 | |
CN109703768B (zh) | 一种基于姿态/轨迹复合控制的软式空中加油对接方法 | |
CN108873929A (zh) | 一种固定翼飞机自主着舰方法及系统 | |
CN105739513A (zh) | 一种四旋翼飞行机器人非线性轨迹跟踪控制器及其跟踪控制方法 | |
CN110531776A (zh) | 基于自抗扰控制技术的四旋翼飞行器位置控制方法和系统 | |
CN105652880B (zh) | 用于飞行器大空域飞行的非线性抗饱和高度指令生成方法 | |
CN106444822A (zh) | 一种基于空间矢量场制导的平流层飞艇路径跟踪控制方法 | |
CN104483977A (zh) | 一种舵机云台的无速度反馈动态面控制方法 | |
CN109407688A (zh) | 一种垂直起降火箭在线轨迹规划的质心运动解耦方法 |
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 |