CN112666959A - 一种运载火箭姿态失稳状态下的姿态稳定控制方法 - Google Patents
一种运载火箭姿态失稳状态下的姿态稳定控制方法 Download PDFInfo
- Publication number
- CN112666959A CN112666959A CN202011378125.XA CN202011378125A CN112666959A CN 112666959 A CN112666959 A CN 112666959A CN 202011378125 A CN202011378125 A CN 202011378125A CN 112666959 A CN112666959 A CN 112666959A
- Authority
- CN
- China
- Prior art keywords
- attitude
- rocket
- control
- control system
- correction network
- 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
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提供了一种运载火箭姿态失稳状态下的姿态稳定控制方法,所述的运载火箭为轴对称外形,描述俯仰平面的姿态失稳状态下的姿态稳定控制方法,包括步骤:对俯仰角失稳状态进行判断;当判断姿态失稳后,进行控制策略切换,将“姿态控制系统校正网络”切换到“姿态控制系统失稳状态校正网络”上;当火箭姿态失稳状态消失后,将“姿态控制系统失稳状态下的校正网络”恢复到“姿态控制系统校正网络”上,将“姿态控制系统校正网络”计算的控制指令nc2作为火箭伺服机构控制信号nc,即nc=nc2。本发明的方法鲁棒性较高,可将姿态控制偏差约束在可接受的误差范围内,防止由于姿态角误差持续增大或急速增大而使火箭姿态角失稳,超过火箭的修偏能力而使发射任务失败。
Description
技术领域
本发明属于运载火箭姿态控制技术领域,具体涉及一种运载火箭姿态失稳状态下的姿态稳定控制方法。
背景技术
运载火箭在在飞行过程中,当运载火箭设计中使用的结构参数、气动误差参数等与实际参数之间误差超出设计允许的误差范围,或者高空切变风大小超过设计值,或者出现分离扰动等情况时,有可能会使运载火箭的实际姿态角与飞行控制的程序姿态角之间误差角超出允许范围,甚至误差急速增大而发散,引起发射任务失败,尤其是在大气层内飞行和运载火箭首飞过程中,出现姿态角误差超范围的概率较大。
亟待提出一种适应能力强、具有工程易实现的基于姿态失稳下的姿态稳定控制方案,能够在姿态失稳情况下控制姿态发散趋势,在降低跟踪精度的情况下保障火箭的稳定飞行,具有较高的工程应用价值。
发明内容
本发明的目的就在于为了解决上述问题,提出一种运载火箭姿态失稳状态下的姿态稳定控制方法,所述的运载火箭为轴对称外形,利用伺服机构控制火箭发动机摆动喷管的摆角控制姿态,俯仰和偏航平面控制方案相同,以下描述俯仰平面的姿态失稳状态下的姿态稳定控制方法,偏航平面的姿态失稳状态下的姿态稳定控制方法是相同的,其特征在于包括如下步骤:
S2、当判断姿态失稳后,如图2所示,进行控制策略切换,将“姿态控制系统校正网络”切换到“姿态控制系统失稳状态校正网络”上;
S3、当火箭姿态失稳状态消失后,将“姿态控制系统失稳状态下的校正网络”恢复到“姿态控制系统校正网络”上,将“姿态控制系统校正网络”计算的控制指令nc2作为火箭发动机伺服机构摆角控制指令nc,即nc=nc2。
当运载火箭的实际俯仰角与飞行控制的程序俯仰角之间的角偏差绝对值大于设计指标即且俯仰角速度ωz绝对值大于设计指标ωzbz的k倍,即|ωz|>k×ωzbz,且ωz极性为使绝对值增大的方向,即则判定为俯仰角失稳。
进一步地,所述步骤S2中“姿态控制系统失稳状态下的校正网络”设计方法如下:
定义nc1是用“姿态控制系统失稳状态下的校正网络”计算出的发动机伺服机构摆角控制指令,
nc1=k1α+k2ωz
c1为运载火箭动力系数,b2气动稳定力矩系数,b3控制力矩系数,α为导航计算的攻角;
系数c的取值主要影响姿态恢复的快速性,其取值不小于1,为1-5,具体值可结合运载火箭的姿态控制力矩大小和六自由度数学仿真优化确认,将nc1作为火箭发动机伺服机构摆角控制指令nc,即nc=nc1。
进一步地,所述步骤S3中判断火箭姿态失稳状态是否消失的方法如下:在连续5-10个指令周期内,角偏差绝对值小于设计指标的k3倍,且ωz绝对值小于设计指标ωzbz的k3倍,K3取值为1.5-3,K3值具体值可结合运载火箭的姿态控制力矩大小和六自由度数学仿真优化确认。
进一步地,所述k3结合运载火箭的姿态控制力矩大小和六自由度数学仿真优化确认的具体方法为:利用运载火箭六自由度数学仿真,考虑切换后“姿态控制系统校正网络”能够保障火箭姿态角稳定,且“姿态控制系统失稳状态下的校正网络”切换到“姿态控制系统校正网络”的时刻相对较早的情况,确认K3的值。
优选地,所述步骤S3中,为降低火箭伺服机构摆角控制指令切换带来的指令突变,还包括步骤S31:
对伺服机构摆角控制指令切换进行平滑处理,
上式中,t为当前飞行时刻值,tqh为火箭姿态失稳状态消失后的伺服机构摆角控制指令切换时刻值,ΔT为平滑过渡时间;
ΔT取值为姿态控制回路阶跃响应上升时间的2-4倍,具体时间可依据运载火箭六自由度数学仿真优化确认。
本发明所构思的以上技术方案与现有技术相比,能够取得下列有益效果:
本发明的方法当判断姿态失稳后,进行控制策略切换,将“姿态控制系统校正网络”切换到“姿态控制系统失稳状态校正网络”上进行姿态稳定控制,虽然姿态控制精度低于常规线性方法设计的“姿态控制系统校正网络”控制下的姿态控制精度,但是本发明的方法鲁棒性较高,可将姿态控制偏差约束在可接受的误差范围内,防止由于姿态角误差持续增大或急速增大而使火箭姿态角失稳,从而飞离理论弹道要求的位置过大,超过火箭的修偏能力而使发射任务失败。
附图说明
图1为运载火箭常规姿态控制技术方案流程示意图;
图2为本发明的技术方案流程示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,均属于本发明保护的范围。
实施例1
一种运载火箭姿态失稳状态下的姿态稳定控制方法,所述的运载火箭为轴对称外形,俯仰和偏航平面控制方案相同,利用伺服机构控制火箭发动机摆动喷管摆角控制姿态,以下描述俯仰平面的姿态失稳状态下的姿态稳定控制方法,偏航平面的姿态失稳状态下的姿态稳定控制方法是相同的,其特征在于包括如下步骤:
S2、当判断姿态失稳后,如图2所示,进行控制策略切换,将“姿态控制系统校正网络”切换到“姿态控制系统失稳状态校正网络”上;S3、当火箭姿态失稳状态消失后,将“姿态控制系统失稳状态下的校正网络”恢复到“姿态控制系统校正网络”上,将“姿态控制系统校正网络”计算的控制指令nc2作为火箭发动机伺服机构摆角控制指令nc,即nc=nc2。即将nc2作为火箭发动机伺服机构摆角控制指令赋值给nc进行正常火箭控制。
当运载火箭的实际俯仰角与飞行控制的程序俯仰角之间的角偏差绝对值大于设计指标即且俯仰角速度ωz绝对值大于设计指标ωzbz的k倍,即|ωz|>k×ωzbz,且ωz极性为使绝对值增大的方向,即ωz和极性相同,都为正或都为负,才能保证两者相乘大于0,则判定为俯仰角失稳。
进一步地,所述步骤S2中“姿态控制系统失稳状态下的校正网络”设计方法如下:
定义nc1是用“姿态控制系统失稳状态下的校正网络”计算出的发动机伺服机构摆角控制指令,
nc1=k1α+k2ωz
c1为运载火箭动力系数,b2气动稳定力矩系数,b3控制力矩系数,α为导航计算的攻角;
系数c的取值主要影响姿态恢复的快速性,其取值不小于1,为1-5,具体值可结合运载火箭的姿态控制力矩大小和六自由度数学仿真优化确认,将nc1作为火箭发动机伺服机构摆角控制指令nc,即nc=nc1,即将nc1作为火箭发动机伺服机构摆角控制指令赋值给nc对火箭进行控制,使火箭姿态恢复正常。本实施例中c取值1,另一个实施例中c取值3,另一个实施例中c取值5。
所述步骤S3中判断火箭姿态失稳状态是否消失的方法如下:在连续5-10个指令周期内,角偏差绝对值小于设计指标的k3倍,且ωz绝对值小于设计指标ωzbz的k3倍,K3取值为1.5-3,K3值具体值可结合运载火箭的姿态控制力矩大小和六自由度数学仿真优化确认。本实施例中在连续5个指令周期内,另一个实施例在连续8个指令周期内,另一个实施例在连续10个指令周期内。本实施例中K3取值为1.5,另一个实施例中K3取值为2。另一个实施例中K3取值为3。
所述k3结合运载火箭的姿态控制力矩大小和六自由度数学仿真优化确认的具体方法为:利用运载火箭六自由度数学仿真,考虑切换后“姿态控制系统校正网络”能够保障火箭姿态角稳定,且“姿态控制系统失稳状态下的校正网络”切换到“姿态控制系统校正网络”的时刻相对较早的情况,确认K3的值。
实施例2
本实施例与实施例1的不同之处在于:
所述步骤S3中,为降低火箭伺服机构指令切换带来的指令突变,还包括步骤S31:
对指令切换进行平滑处理,
上式中,t为当前飞行时刻值(以火箭起飞时刻为时间0点值),tqh为火箭姿态失稳状态消失后的伺服机构摆角控制指令切换时刻值,ΔT为平滑过渡时间;
ΔT取值为姿态控制回路阶跃响应上升时间的2-4倍,具体时间可依据运载火箭六自由度数学仿真优化确认。本实施例中取2倍,为0.1s。另一个实施例中本实施例中取3倍,为0.5s。另一个实施例中本实施例中取4倍,为1s。
其余内容同实施例1。
Claims (7)
1.一种运载火箭姿态失稳状态下的姿态稳定控制方法,所述的运载火箭为轴对称外形,俯仰和偏航平面控制方案相同,利用伺服机构控制火箭发动机摆动喷管摆角控制姿态,以下描述俯仰平面的姿态失稳状态下的姿态稳定控制方法,偏航平面的姿态失稳状态下的姿态稳定控制方法是相同的,其特征在于包括如下步骤:
S2、当判断姿态失稳后,如图2所示,进行控制策略切换,将“姿态控制系统校正网络”切换到“姿态控制系统失稳状态校正网络”上;
S3、当火箭姿态失稳状态消失后,将“姿态控制系统失稳状态下的校正网络”恢复到“姿态控制系统校正网络”上,将“姿态控制系统校正网络”计算的控制指令nc2作为火箭伺服机构控制信号nc,即nc=nc2。
6.根据权利要求5所述的运载火箭姿态失稳状态下的姿态稳定控制方法,其特征在于所述k3结合运载火箭的姿态控制力矩大小和六自由度数学仿真优化确认的具体方法为:利用运载火箭六自由度数学仿真,考虑切换后“姿态控制系统校正网络”能够保障火箭姿态角稳定,且“姿态控制系统失稳状态下的校正网络”切换到“姿态控制系统校正网络”的时刻相对较早的情况,确认K3的值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011378125.XA CN112666959B (zh) | 2020-11-30 | 2020-11-30 | 一种运载火箭姿态失稳状态下的姿态稳定控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011378125.XA CN112666959B (zh) | 2020-11-30 | 2020-11-30 | 一种运载火箭姿态失稳状态下的姿态稳定控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112666959A true CN112666959A (zh) | 2021-04-16 |
CN112666959B CN112666959B (zh) | 2022-11-15 |
Family
ID=75403106
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011378125.XA Active CN112666959B (zh) | 2020-11-30 | 2020-11-30 | 一种运载火箭姿态失稳状态下的姿态稳定控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112666959B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114036780A (zh) * | 2021-12-06 | 2022-02-11 | 航天科工火箭技术有限公司 | 一种受天基测控约束的火箭姿态角设计方法 |
CN114253282A (zh) * | 2021-12-21 | 2022-03-29 | 航天科工火箭技术有限公司 | 运载火箭的姿态控制方法、装置、设备及存储介质 |
CN114442647A (zh) * | 2021-12-08 | 2022-05-06 | 航天科工火箭技术有限公司 | 基于模糊隶属度函数的火箭末级姿态分时控制方法及装置 |
CN114460956A (zh) * | 2021-08-06 | 2022-05-10 | 北京天兵科技有限公司 | 一种液体火箭伺服机构摆角的控制网络设计方法及系统 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20130320133A1 (en) * | 2011-02-17 | 2013-12-05 | Georgia Tech Research Corporation | Hovering and gliding multi-wing flapping micro aerial vehicle |
CN103925917A (zh) * | 2014-05-05 | 2014-07-16 | 上海新跃仪表厂 | 一种运载火箭姿态角速率信号的测量系统及方法 |
CN106742067A (zh) * | 2016-12-02 | 2017-05-31 | 上海航天控制技术研究所 | 基于参考模型的姿控发动机在轨故障诊断处理系统与方法 |
CN107885221A (zh) * | 2017-10-11 | 2018-04-06 | 北京控制工程研究所 | 一种航天器姿态机动与稳态控制的平稳切换方法 |
CN109059935A (zh) * | 2018-06-26 | 2018-12-21 | 上海卫星工程研究所 | 火星捕获接近段地面导航与器上自主导航切换方法 |
CN109085847A (zh) * | 2018-09-03 | 2018-12-25 | 中国运载火箭技术研究院 | 一种大静不稳定度飞行器弹性稳定控制系统及控制方法 |
CN110531777A (zh) * | 2019-08-13 | 2019-12-03 | 北京理工大学 | 基于自抗扰控制技术的四旋翼飞行器姿态控制方法和系统 |
CN110794863A (zh) * | 2019-11-20 | 2020-02-14 | 中山大学 | 一种控制性能指标可定制的重型运载火箭姿态控制方法 |
CN111319796A (zh) * | 2020-02-28 | 2020-06-23 | 上海航天控制技术研究所 | 一种基于电推轨道转移的姿态控制方法及系统 |
-
2020
- 2020-11-30 CN CN202011378125.XA patent/CN112666959B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20130320133A1 (en) * | 2011-02-17 | 2013-12-05 | Georgia Tech Research Corporation | Hovering and gliding multi-wing flapping micro aerial vehicle |
CN103925917A (zh) * | 2014-05-05 | 2014-07-16 | 上海新跃仪表厂 | 一种运载火箭姿态角速率信号的测量系统及方法 |
CN106742067A (zh) * | 2016-12-02 | 2017-05-31 | 上海航天控制技术研究所 | 基于参考模型的姿控发动机在轨故障诊断处理系统与方法 |
CN107885221A (zh) * | 2017-10-11 | 2018-04-06 | 北京控制工程研究所 | 一种航天器姿态机动与稳态控制的平稳切换方法 |
CN109059935A (zh) * | 2018-06-26 | 2018-12-21 | 上海卫星工程研究所 | 火星捕获接近段地面导航与器上自主导航切换方法 |
CN109085847A (zh) * | 2018-09-03 | 2018-12-25 | 中国运载火箭技术研究院 | 一种大静不稳定度飞行器弹性稳定控制系统及控制方法 |
CN110531777A (zh) * | 2019-08-13 | 2019-12-03 | 北京理工大学 | 基于自抗扰控制技术的四旋翼飞行器姿态控制方法和系统 |
CN110794863A (zh) * | 2019-11-20 | 2020-02-14 | 中山大学 | 一种控制性能指标可定制的重型运载火箭姿态控制方法 |
CN111319796A (zh) * | 2020-02-28 | 2020-06-23 | 上海航天控制技术研究所 | 一种基于电推轨道转移的姿态控制方法及系统 |
Non-Patent Citations (5)
Title |
---|
RUTH BARS: "Theory, algorithms and technology in the design of control systems", 《ANNUAL REVIEWS IN CONTROL》 * |
孟洲: "发动机伺服机构故障下大型捆绑火箭容错控制", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 * |
李文清; 王俊峰; 张志国; 陈宇; 秦旭东: "火箭适应发动机推力下降故障的弹道制导策略优化分析", 《导弹与航天运载技术》 * |
杨春宁;方家为;李春;葛晖: "基于稳定性判据的高超声速复合控制方法", 《浙江大学学报(工学版)》 * |
韩雪颖; 马英; 程兴; 马忠辉: "运载火箭推力故障下的弹道重构策略研究", 《导弹与航天运载技术 》 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114460956A (zh) * | 2021-08-06 | 2022-05-10 | 北京天兵科技有限公司 | 一种液体火箭伺服机构摆角的控制网络设计方法及系统 |
CN114460956B (zh) * | 2021-08-06 | 2023-10-31 | 北京天兵科技有限公司 | 一种液体火箭伺服机构摆角的控制网络设计方法及系统 |
CN114036780A (zh) * | 2021-12-06 | 2022-02-11 | 航天科工火箭技术有限公司 | 一种受天基测控约束的火箭姿态角设计方法 |
CN114442647A (zh) * | 2021-12-08 | 2022-05-06 | 航天科工火箭技术有限公司 | 基于模糊隶属度函数的火箭末级姿态分时控制方法及装置 |
CN114442647B (zh) * | 2021-12-08 | 2024-04-26 | 航天科工火箭技术有限公司 | 基于模糊隶属度函数的火箭末级姿态分时控制方法及装置 |
CN114253282A (zh) * | 2021-12-21 | 2022-03-29 | 航天科工火箭技术有限公司 | 运载火箭的姿态控制方法、装置、设备及存储介质 |
CN114253282B (zh) * | 2021-12-21 | 2023-09-22 | 航天科工火箭技术有限公司 | 运载火箭的姿态控制方法、装置、设备及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN112666959B (zh) | 2022-11-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112666959B (zh) | 一种运载火箭姿态失稳状态下的姿态稳定控制方法 | |
CN112486193B (zh) | 一种基于自适应增广控制理论的飞翼无人机三轴全权限控制方法 | |
CN106444822A (zh) | 一种基于空间矢量场制导的平流层飞艇路径跟踪控制方法 | |
CN111045440B (zh) | 一种高超声速飞行器俯冲段快速滚转控制方法 | |
CN110456816B (zh) | 一种基于连续终端滑模的四旋翼轨迹跟踪控制方法 | |
CN114265419B (zh) | 运载火箭姿态控制方法、装置、电子设备及存储介质 | |
CN112987771B (zh) | 基于多端口输出误差触发机制的机帆船路径跟踪控制方法 | |
CN114942649B (zh) | 一种基于反步法的飞机俯仰姿态与航迹角解耦控制方法 | |
CN113703320A (zh) | 一种抗干扰和饱和特性的飞行机械臂位姿控制方法 | |
CN113110539A (zh) | 一种基于鸭舵的弹/箭三通道控制方法及控制装置 | |
CN116045744A (zh) | 一种固体运载火箭分离体残骸落区的控制方法和装置 | |
CN110597281A (zh) | 一种自动着舰纵向飞行控制系统参数获取方法 | |
CN110032199B (zh) | 火箭发动机机架变形角的预偏角线性补偿方法和装置 | |
CN116643482A (zh) | 一种运载火箭侧喷流姿态冗余控制方法 | |
CN114995517A (zh) | 一种基于弹道偏角纠偏的亚音速飞行器轨迹规划方法 | |
CN112629339B (zh) | 一种基于直接法的火箭软着陆轨迹规划方法 | |
CN115344056A (zh) | 一种复杂操纵面飞机的智能飞行控制方法及应用 | |
CN109212969B (zh) | 一种考虑四旋翼飞行器执行器故障的积分反步滑模姿态控制方法 | |
CN110673616A (zh) | 基于自适应滑模的固定翼无人机有限时间容错控制方法 | |
CN114019793B (zh) | 一种火星edl过程鲁棒姿态控制方法 | |
CN116974303B (zh) | 靶标的滚转控制方法、装置及靶标 | |
CN116382335B (zh) | 一种无人机半滚倒转机动控制方法 | |
CN116909307B (zh) | 一种飞行器高机动运动控制方法 | |
CN117555227B (zh) | 一种运载火箭的控制方法、计算设备及存储介质 | |
Cheng et al. | Path-Following Control for an Under-actuated Airship Based on Serret-Frenet Frame |
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 |