CN107133380B - 运载火箭发动机耗尽/关机段的一种制导程序角处理方法 - Google Patents
运载火箭发动机耗尽/关机段的一种制导程序角处理方法 Download PDFInfo
- Publication number
- CN107133380B CN107133380B CN201710208653.2A CN201710208653A CN107133380B CN 107133380 B CN107133380 B CN 107133380B CN 201710208653 A CN201710208653 A CN 201710208653A CN 107133380 B CN107133380 B CN 107133380B
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- program angle
- guidance
- mtd
- 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.)
- Active
Links
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/10—Geometric CAD
- G06F30/15—Vehicle, aircraft or watercraft design
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Geometry (AREA)
- General Physics & Mathematics (AREA)
- Computer Hardware Design (AREA)
- General Engineering & Computer Science (AREA)
- Evolutionary Computation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Pure & Applied Mathematics (AREA)
- Mathematical Optimization (AREA)
- Mathematical Analysis (AREA)
- Computational Mathematics (AREA)
- Automation & Control Theory (AREA)
- Combined Controls Of Internal Combustion Engines (AREA)
Abstract
本发明公开了运载火箭发动机耗尽/关机段的一种制导程序角处理方法,该方法包括:在到达制导系统设定的定轴起始时刻tdz=0时,记录相对于前一计算时刻的程序角增量Δαcx=αcx‑αcx,‑1;设定程序角增量Δαcx线性收敛至零的时间Δtto_dz;计算程序角增量变化率后续各个时刻程序角,程序角增量递减至零其中,αcx为当前计算时刻程序角,αcx,‑1为前一计算周期程序角,tdz为定轴起始时刻。本发明的有益效果:不仅考虑角度的稳定还考虑了角速度的影响,提高了运载火箭耗尽或关机阶段推力下降过程中的姿态控制稳定性。
Description
技术领域
本发明涉及运载火箭发动机耗尽或关机阶段制导系统程序角的处理方法。
背景技术
运载火箭发动机耗尽或关机前,制导系统计算的参数会出现分母接近零等奇异现象,导致制导系统给出的程序角出现大幅波动,进而影响控制的稳定性。现有的处理方式是设置一定的参数门限,达到参数门限后程序角保持固定值不再变化。但是这种方式仅考虑了角度的稳定,但是忽略了角速度的影响。
针对相关技术中的问题,目前尚未提出有效的解决方案。
发明内容
针对相关技术中的上述技术问题,本发明提出了运载火箭发动机耗尽/关机段的一种制导程序角处理方法,不仅考虑角度的稳定还综合考虑了角速度的影响。
为实现上述技术目的,本发明的技术方案是这样实现的:
运载火箭发动机耗尽/关机段的一种制导程序角处理方法,包括:
S1计算当前时刻制导程序角αcx;
S2判断是否到达制导系统设定的定轴,如果到达制导系统设定的定轴起始时刻tdz=0时,记录相对于前一计算时刻的程序角增量Δαcx=αcx-αcx,-1;
S3设定程序角增量Δαcx线性收敛至零的时间Δtto_dz;
S4计算程序角增量变化率
其中,αcx为当前计算时刻程序角。
进一步的,包括:
S5计算后续各个时刻程序角,程序角增量递减至零
其中,为前一计算周期程序角,tdz为定轴起始时刻。
进一步的,在所述S2中,如果没有到达制导系统设定的定轴,则退出计算。
进一步的,判别是否进入定轴由运载火箭制导方法确定。
本发明的有益效果:不仅考虑角度的稳定还考虑了角速度的影响,提高了运载火箭耗尽或关机阶段推力下降过程中的姿态控制稳定性。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1是根据本发明实施例所述的运载火箭发动机耗尽/关机段的一种制导程序角处理方法的具体实现步骤。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员所获得的所有其他实施例,都属于本发明保护的范围。
如图1所示,根据本发明实施例所述的运载火箭发动机耗尽/关机段的一种制导程序角处理方法,包括如下步骤:
S1计算当前时刻制导程序角αcx;
S2判断是否到达制导系统设定的定轴,如果到达制导系统设定的定轴起始时刻tdz=0时,记录相对于前一计算时刻的程序角增量Δαcx=αcx-αcx,-1;
S3设定程序角增量Δαcx线性收敛至零的时间Δtto_dz;
S4计算程序角增量变化率
其中,αcx为当前计算时刻程序角。
进一步的,包括:
S5计算后续各个时刻程序角,程序角增量递减至零
其中,αcx,-1为前一计算周期程序角,tdz为定轴起始时刻。
进一步的,在所述S2中,如果没有到达制导系统设定的定轴,则退出计算。
进一步的,判别是否进入定轴由运载火箭制导方法确定。
综上所述,借助于本发明的上述技术方案,考虑了运载火箭发动机耗尽或关机阶段程序角变化速率的影响,使程序角平滑稳定地收敛至恒定值。当制导系统参数达到设定的门限时刻,记录当前计算时刻的程序角增量,在后续的控制过程中,将后续各个计算周期的程序角增量线性递减至零。当程序角增量为零以后,程序角不再变化。
因此,本发明不仅考虑角度的稳定还考虑了角速度的影响,提高了运载火箭耗尽或关机阶段推力下降过程中的姿态控制稳定性。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (3)
1.一种运载火箭发动机耗尽/关机段的制导程序角处理方法,其特征在于,包括如下步骤:
S1计算当前时刻制导程序角αcx;
S2判断是否到达制导系统设定的定轴,如果到达制导系统设定的定轴起始时刻tdz=0时,记录相对于前一计算时刻的程序角增量Δαcx=αcx-αcx,-1;
S3设定程序角增量Δαcx线性收敛至零的时间Δtto_dz;
S4计算程序角增量变化率
其中,αcx为当前计算时刻程序角;
S5计算后续各个时刻程序角,程序角增量递减至零
<mrow>
<msub>
<mi>&alpha;</mi>
<mrow>
<mi>c</mi>
<mi>x</mi>
</mrow>
</msub>
<mo>=</mo>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&alpha;</mi>
<mrow>
<mi>c</mi>
<mi>x</mi>
<mo>,</mo>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>&Delta;&alpha;</mi>
<mrow>
<mi>c</mi>
<mi>x</mi>
</mrow>
</msub>
<mo>-</mo>
<mi>&Delta;</mi>
<msub>
<mover>
<mi>&alpha;</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>c</mi>
<mi>x</mi>
<mo>_</mo>
<mi>d</mi>
<mi>z</mi>
</mrow>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mi>t</mi>
<mrow>
<mi>d</mi>
<mi>z</mi>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>t</mi>
<mrow>
<mi>d</mi>
<mi>z</mi>
</mrow>
</msub>
<mo><</mo>
<msub>
<mi>&Delta;t</mi>
<mrow>
<mi>t</mi>
<mi>o</mi>
<mo>_</mo>
<mi>d</mi>
<mi>z</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>&alpha;</mi>
<mrow>
<mi>c</mi>
<mi>x</mi>
<mo>,</mo>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
</mtd>
<mtd>
<mrow>
<msub>
<mi>t</mi>
<mrow>
<mi>d</mi>
<mi>z</mi>
</mrow>
</msub>
<mo>&GreaterEqual;</mo>
<msub>
<mi>&Delta;t</mi>
<mrow>
<mi>t</mi>
<mi>o</mi>
<mo>_</mo>
<mi>d</mi>
<mi>z</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
其中,αcx,-1为前一计算周期程序角,tdz为定轴起始时刻。
2.根据权利要求1所述的一种运载火箭发动机耗尽/关机段的制导程序角处理方法,其特征在于,在所述S2中,如果没有到达制导系统设定的定轴,则退出计算。
3.根据权利要求1所述的一种运载火箭发动机耗尽/关机段的制导程序角处理方法,其特征在于,在所述S2中,是否进入定轴由运载火箭制导方法确定。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710208653.2A CN107133380B (zh) | 2017-03-31 | 2017-03-31 | 运载火箭发动机耗尽/关机段的一种制导程序角处理方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710208653.2A CN107133380B (zh) | 2017-03-31 | 2017-03-31 | 运载火箭发动机耗尽/关机段的一种制导程序角处理方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107133380A CN107133380A (zh) | 2017-09-05 |
CN107133380B true CN107133380B (zh) | 2018-05-22 |
Family
ID=59716306
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710208653.2A Active CN107133380B (zh) | 2017-03-31 | 2017-03-31 | 运载火箭发动机耗尽/关机段的一种制导程序角处理方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107133380B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107933965B (zh) * | 2017-11-09 | 2019-09-06 | 北京航天自动控制研究所 | 一种运载火箭伺服机构线性平滑归零方法 |
CN110979737B (zh) * | 2019-10-29 | 2020-08-04 | 北京星际荣耀空间科技有限公司 | 确定运载火箭关机时机的方法、装置及运载火箭 |
CN111142458B (zh) * | 2019-12-05 | 2020-09-08 | 北京星际荣耀空间科技有限公司 | 一种固体运载火箭发动机耗尽判别方法、装置及设备 |
CN112325710B (zh) * | 2020-09-24 | 2023-03-31 | 北京航天自动控制研究所 | 一种运载火箭大推力直接入轨高精度姿态控制方法和系统 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101694364A (zh) * | 2009-09-30 | 2010-04-14 | 北京航天自动控制研究所 | 摄动制导与迭代制导的快速转换方法 |
CN102930164A (zh) * | 2012-10-31 | 2013-02-13 | 北京航天自动控制研究所 | 一种飞行器控制数据的转换方法 |
CN105501467A (zh) * | 2015-12-11 | 2016-04-20 | 周沁心 | 一种基于零射程线的运载火箭耗尽关机控制方法 |
-
2017
- 2017-03-31 CN CN201710208653.2A patent/CN107133380B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101694364A (zh) * | 2009-09-30 | 2010-04-14 | 北京航天自动控制研究所 | 摄动制导与迭代制导的快速转换方法 |
CN102930164A (zh) * | 2012-10-31 | 2013-02-13 | 北京航天自动控制研究所 | 一种飞行器控制数据的转换方法 |
CN105501467A (zh) * | 2015-12-11 | 2016-04-20 | 周沁心 | 一种基于零射程线的运载火箭耗尽关机控制方法 |
Non-Patent Citations (2)
Title |
---|
固体火箭的鲁棒自适应耗尽关机制导方法研究;周军 等;《航天控制》;20130630;第31卷(第3期);第34-39页 * |
姿态角单次调整的固体运载火箭耗尽关机能量管理方法;姚党鼐 等;《国防科技大学学报》;20130228;第35卷(第1期);第39-42页 * |
Also Published As
Publication number | Publication date |
---|---|
CN107133380A (zh) | 2017-09-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107133380B (zh) | 运载火箭发动机耗尽/关机段的一种制导程序角处理方法 | |
CN107941087A (zh) | 一种基于阻力剖面的高升阻比高超平稳滑翔再入制导方法 | |
US9550526B2 (en) | Lane keeping control system and method | |
CN110006419B (zh) | 一种基于预瞄的车辆轨迹跟踪点确定方法 | |
CN110703749A (zh) | 一种控制车辆运动的方法及装置 | |
CN106184819B (zh) | 一种姿态机动自适应轨迹规划方法 | |
CN110716566B (zh) | 一种欠驱动无人艇的有限时间轨迹跟踪控制方法 | |
CN109398763B (zh) | 一种基于有限推力有限工作时间情况下的航天器精确入轨控制方法 | |
CN112445234B (zh) | 一种航天器的姿态控制方法和装置 | |
JP2010195392A5 (zh) | ||
CN105388902B (zh) | 一种基于指令力矩矢量调节的控制力矩陀螺奇异规避方法 | |
CN103466100B (zh) | 一种着陆器软着陆姿态控制方法 | |
JP2014512504A (ja) | ミサイルの針路変更を最小化する誘導システムおよび方法 | |
CN110244556B (zh) | 基于期望航向修正的欠驱动船舶航向控制方法 | |
CN107289938B (zh) | 一种地面无人平台局部路径规划方法 | |
CN107844058A (zh) | 一种运动曲线离散动态规划方法 | |
CN107807522A (zh) | 水下机器人轨迹跟踪反步控制方法 | |
CN105159311A (zh) | 一种用于捷联导引头的自动驾驶仪的设计方法 | |
CN104978489A (zh) | 一种适用于滑翔飞行器的最小铰链力矩下压弹道计算方法 | |
CN106598051A (zh) | 一种基于动力矢量的航迹控制方法 | |
CN105563483A (zh) | 一种用于蛇形仿生机器人转弯运动的组合控制方法 | |
CN109857108B (zh) | 基于内模控制算法的移动机器人轨迹跟踪方法及系统 | |
CN107515533A (zh) | 一种用于列车ato系统的鲁棒非奇异终端滑模控制方法 | |
AU2017427609A1 (en) | Gbias for rate based autopilot | |
CN109992003A (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 | ||
CP03 | Change of name, title or address |
Address after: 100176 Floor 1, Building 1, No. 9, 13 Ronghua South Road, Daxing Economic and Technological Development Zone, Beijing Patentee after: Blue Arrow Space Technology Co., Ltd. Address before: 100085 02B-492, information block C, seat 28 (two level), Haidian District, Beijing. Patentee before: Beijing blue arrow InterSpace Technology Ltd |
|
CP03 | Change of name, title or address |