CN107340715A - 一种返回式飞行器离轨制动期间的轨控容错控制方法 - Google Patents
一种返回式飞行器离轨制动期间的轨控容错控制方法 Download PDFInfo
- Publication number
- CN107340715A CN107340715A CN201710500774.4A CN201710500774A CN107340715A CN 107340715 A CN107340715 A CN 107340715A CN 201710500774 A CN201710500774 A CN 201710500774A CN 107340715 A CN107340715 A CN 107340715A
- Authority
- CN
- China
- Prior art keywords
- sustainer
- speed
- fault tolerant
- control method
- failure
- 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
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Software Systems (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Health & Medical Sciences (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Combined Controls Of Internal Combustion Engines (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Regulating Braking Force (AREA)
Abstract
本发明公开一种返回式飞行器离轨制动期间的轨控容错控制方法,所述方法包括:S1:在离轨制动期间,实时计算指令速度;S2:根据所述指令速度和导航速度,计算飞行器的需要速度;S3:根据需要速度变化进行主发动机故障判断;S4:在主发动机故障情况下进行应急处理,本发明利用需要速度持续增大来判断轨控故障,算法可行,可靠性强,具有明显的优势。
Description
技术领域
本发明涉及飞行器控制领域。更具体地,涉及一种返回式飞行器离轨制动期间的轨控容错控制方法。
背景技术
空间飞行器的离轨制动是通过轨控发动机提供制动力,进行速度修正,降低飞行器的速度实现的。变轨发动机的可靠性直接影响了离轨制动效果。目前国内外大多数返回式飞行器在发动机布局上就不具备轨控冗余的功能,只在飞行器的尾部提供一个主发动机,这是基于变轨发动机的高可靠性以及降低系统复杂度的考虑。然而,对于动力系统属于研制、可靠性较低的返回式飞行器,为了提高系统的任务可靠性,除了主发动机,还需要令若干姿控发动机具备变轨功能,在主发动机故障时,可以紧急启用姿控发动机离轨制动。这涉及到发动机故障判断问题和切机策略问题。传统的方法是利用地面人员对发动机的推力室压、喷管的温度进行综合判断,在确定故障后,由地面人员选择备份发动机,并上注给飞行器,这种方法一方面判断复杂,另一方面耗时较长,不适用与离轨制动期间。还有一种方法是利用飞行器安装在X轴的加速度计输出,以及飞行器的质量,利用动力学方程计算发动机推力,若推力较小,则认为发动机故障。这种方法相对比较简单,但是在有些情况下,轨控发动机需要脉冲开机,有时候可能出现推力较小的情况,但并不意味着发动机故障,另外,加速度计的噪声或者故障也可能引起对主发动机工作状态的误判,存在一定的风险。
因此,需要提供一种能够快速、准确地进行主发动机故障判断的轨控容错控制方法,提高飞行器的工作可靠性。
发明内容
本发明的一个目的在于提供一种返回式飞行器离轨制动期间的轨控容错控制方法,根据需要速度变化情况判断主发动机工作状态,快速、准确地判断主发动机是否存在故障,进而进行应急处理,提高发动机的工作可靠性。
为达到上述目的,本发明采用下述技术方案:
本发明公开了一种返回式飞行器离轨制动期间的轨控容错控制方法,所述方法包括:
S1:在离轨制动期间,实时计算指令速度;
S2:根据所述指令速度和导航速度,计算飞行器的需要速度;
S3:根据需要速度变化进行主发动机故障判断;
S4:在主发动机故障情况下进行应急处理。
优选地,所述指令速度为
其中,
其中,为J2000坐标系中飞行器当前的位置矢量,为J2000坐标系中再入点的位置矢量,为与的叉乘的Z轴分量,γT为再入角,fM为地球引力常数与地球质量之乘积,Vxr、Vyr、Vzr为指令速度在赤道惯性坐标系三轴的分量。
优选地,所述需要速度为
dvx=Vxr-Vxi
dvy=Vxr-Vxi
dvz=Vzr-Vzi
其中,Vxi、Vyi、Vzi为导航速度在赤道惯性坐标系三轴的分量,由飞行器导航设备提供,dvx、dvy、dvz为需要速度在赤道惯性坐标系三轴的分量,DV为需要速度大小,Vxr、Vyr、Vzr为指令速度在赤道惯性坐标系三轴的分量。
优选地,所述S3包括:用flag_ErrThrustG来表示故发动机故障,其为1
表明有故障,0表明正常:
优选地,所述S4在主发动机故障情况下,关闭主发动机,打开轴向发动机。
优选地,所述S4主发动机故障应急处理过程为
其中,Rg为主发动机控制命令,1表示主发动机开机,0表示主发动机关机,flag_ErrThrustG为主发动机故障情况,1表示主发动机故障,0表示主发动机正常。
优选地,所述轴向发动机为姿控发动机。
本发明的有益效果如下:
本发明的轨控容错控制方法利用需要速度持续增大来判断轨控故障,算法可行,可靠性强,具有明显的优势。本发明的方法通过对需要速度实时计算和监控,能够快速、准确地进行主发动机故障判断,当出现主发动机故障时进行应急处理,计算方法简单、快速且能避免传统方法产生的误差情况发生,具有很强的可操作性,提高飞行器发动机的工作可靠性。
附图说明
下面结合附图对本发明的具体实施方式作进一步详细的说明。
图1示出本发明一种返回式飞行器离轨制动期间的轨控容错控制方法具体实施例的流程图。
图2示出本发明一种返回式飞行器离轨制动期间的轨控容错控制方法具体实施例飞行器发动机布局的示意图。
图3示出本发明一种返回式飞行器离轨制动期间的轨控容错控制方法具体实施例与现有方法的发动机开机序列和轨控故障标志的对比图。
图4示出本发明一种返回式飞行器离轨制动期间的轨控容错控制方法具体实施例与现有方法的X向加表输出的对比图。
图5示出本发明一种返回式飞行器离轨制动期间的轨控容错控制方法具体实施例与现有方法的速度减量的对比图。
具体实施方式
为了更清楚地说明本发明,下面结合优选实施例和附图对本发明做进一步的说明。附图中相似的部件以相同的附图标记进行表示。本领域技术人员应当理解,下面所具体描述的内容是说明性的而非限制性的,不应以此限制本发明的保护范围。
如图1所示,本发明公开的一种返回式飞行器离轨制动期间的轨控容错控制方法,包括:
S1:在离轨制动期间,实时计算指令速度。
所述指令速度为
其中,
其中,为J2000坐标系中飞行器当前的位置矢量,为J2000坐标系中再入点的位置矢量,为与的叉乘的Z轴分量,γT为再入角,fM为地球引力常数与地球质量之乘积,Vxr、Vyr、Vzr为指令速度在赤道惯性坐标系三轴的分量。
S2:根据所述指令速度和导航速度,计算飞行器的需要速度。
所述需要速度为
dvx=Vxr-Vxi
dvy=Vxr-Vxi
dvz=Vzr-Vzi
其中,Vxi、Vyi、Vzi为导航速度在赤道惯性坐标系三轴的分量,由飞行器导航设备提供,dvx、dvy、dvz为需要速度在赤道惯性坐标系三轴的分量,DV为需要速度大小,Vxr、Vyr、Vzr为指令速度在赤道惯性坐标系三轴的分量。
S3:根据需要速度变化进行主发动机故障判断。可以用速度增量的变化来判断主发动机故障。在主发动机正常工作的情况下,速度增量会逐渐减少至零,反之,速度增量会逐渐增大。根据此原理,若速度增量在一定时间内不断增大,则可以断定主发动机故障。具体的,用flag_ErrThrustG来表示故发动机故障,其为1表明有故障,0表明正常。
其中,所述帧数优选采用10帧。
S4:在主发动机故障情况下进行应急处理。在主发动机故障情况下,立即关闭主发动机,打开轴向发动机,从而完成变轨机动期间轨控容错控制。所述S4主发动机故障应急处理过程为
其中,IRVE_Rg为主发动机控制命令,1表示主发动机开机,0表示主发动机关机,flag_ErrThrustG为主发动机故障情况,1表示主发动机故障,0表示主发动机正常。
如图2所示,为本发明一个具体实施中具有轨控容错能力的姿轨控发动机布局。具有轨控容错能力的姿轨控发动机布局方案,应包含1个主发动机和12个姿控发动机。主发动机用于离轨制动期间提供制动力,其应安装在返回式飞行器的尾部,喷管沿着返回式飞行器的轴向,指向返回式飞行器的-X方向,姿控发动机的布局应具有轨控容错能力,即确保在主发动机故障情况下,可以由若干个姿控发动机提供制动力,为了确保制动力最大,提供制动力的姿控发动机一般对称地布置在返回式飞行器的尾部,与主发动机平行,指向返回式飞行器的-X方向。由于这些姿控发动机均与主发动机平行,沿轴向布局,称其为轴向发动机。
定义返回式飞行器本体坐标系OXYZ:本体坐标系OXYZ与返回式飞行器固联,定义坐标原点O为返回式飞行器质心;OX轴沿飞行器轴向,指向前方,OZ轴沿返回式飞行器径向,指向Ⅳ象限线,返回式飞行器对地三轴稳定时指向地球方向,OY与OX和OZ轴呈右手定则。
12台姿控发动机(序号1,2,3,4,5,6,7,8,9,10,11,12)分成4组,每组3台,采用三机组合,呈“T”型布置,其中1、2、3与7、8、9在Y轴方向相对平面XOZ对称安装在器箭对接面附近的姿控支架上,4、5、6与10、11、12在Z轴方向相对平面XOY对称安装在器箭对接面附近的姿控支架上。
假设离轨制动时刻时,
再入角为-1.9°,则计算得到
则有
dvx=71.6m/s
dvy=26.4m/s
dvz=-42.0m/s
DV=87m/s
考虑这样一种情形,假设在启动离轨制动的50s后,主发动机出现故障,无法提供推力,采用本专利的方法与传统的方法进行比较,结果如图3~图5所示。
由图可知,两种方法在开始时均开启主发动机进行制动,即都令主发动机开机指令IRVE_Rg=1。然而,在50s主发动机失效的情况下,不采用本专利方法在X方向上的加表输出迅速由0.09g跌落到0附近,表明无法提供制动力,在没有容错控制的情况下,飞行器无法识别轨控故障,未采取任何措施,需要速度减量也无法进一步下降,轨控失败。而本专利方法,在50s发现轨控发动机失效后,立刻关闭主发动机,即令主发动机开机指令IRVE_Rg=0,利用2、5、8、11四个姿控发动机同时开机产生推力进行轨道控制,而利用1、3、4、6、7、9、10、12八个姿控发动机进行姿态控制,在X方向上依旧能够产生大概0.04g的加表输出,制动力虽然弱于主发动机正常的情形,但是速度减量仍然持续下降,表明不影响制动效果,实现了在轨控发动机故障情况下的正常离轨制动。
由此可见,采用本专利方法,利用需要速度持续增大来判断轨控故障,算法可行,可靠性强,具有明显的优势。
显然,本发明的上述实施例仅仅是为清楚地说明本发明所作的举例,而并非是对本发明的实施方式的限定,对于所属领域的普通技术人员来说,在上述说明的基础上还可以做出其它不同形式的变化或变动,这里无法对所有的实施方式予以穷举,凡是属于本发明的技术方案所引伸出的显而易见的变化或变动仍处于本发明的保护范围之列。
Claims (7)
1.一种返回式飞行器离轨制动期间的轨控容错控制方法,其特征在于,所述方法包括:
S1:在离轨制动期间,实时计算指令速度;
S2:根据所述指令速度和导航速度,计算飞行器的需要速度;
S3:根据需要速度变化进行主发动机故障判断;
S4:在主发动机故障情况下进行应急处理。
2.根据权利要求1所述的轨控容错控制方法,其特征在于,所述指令速度为
其中,
其中,为J2000坐标系中飞行器当前的位置矢量,为J2000坐标系中再入点的位置矢量,为与的叉乘的Z轴分量,γT为再入角,fM为地球引力常数与地球质量之乘积,Vxr、Vyr、Vzr为指令速度在赤道惯性坐标系三轴的分量。
3.根据权利要求1所述的轨控容错控制方法,其特征在于,所述需要速度为
dvx=Vxr-Vxi
dvy=Vxr-Vxi
dvz=Vzr-Vzi
其中,Vxi、Vyi、Vzi为导航速度在赤道惯性坐标系三轴的分量,由飞行器导航设备提供,dvx、dvy、dvz为需要速度在赤道惯性坐标系三轴的分量,DV为需要速度大小,Vxr、Vyr、Vzr为指令速度在赤道惯性坐标系三轴的分量。
4.根据权利要求1所述的轨控容错控制方法,其特征在于,所述S3包括:用flag_ErrThrustG来表示故发动机故障,其为1表明有故障,0表明正常:
。
5.根据权利要求1所述的轨控容错控制方法法,其特征在于,所述S4在主发动机故障情况下,关闭主发动机,打开轴向发动机。
6.根据权利要求5所述的轨控容错控制方法,其特征在于,所述S4主发动机故障应急处理过程为
其中,Rg为主发动机控制命令,1表示主发动机开机,0表示主发动机关机,flag_ErrThrustG为主发动机故障情况,1表示主发动机故障,0表示主发动机正常。
7.根据权利要求5所述的轨控容错控制方法,其特征在于,所述轴向发动机为姿控发动机。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710500774.4A CN107340715B (zh) | 2017-06-27 | 2017-06-27 | 一种返回式飞行器离轨制动期间的轨控容错控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710500774.4A CN107340715B (zh) | 2017-06-27 | 2017-06-27 | 一种返回式飞行器离轨制动期间的轨控容错控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107340715A true CN107340715A (zh) | 2017-11-10 |
CN107340715B CN107340715B (zh) | 2020-08-25 |
Family
ID=60220969
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710500774.4A Active CN107340715B (zh) | 2017-06-27 | 2017-06-27 | 一种返回式飞行器离轨制动期间的轨控容错控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107340715B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108803316A (zh) * | 2018-03-09 | 2018-11-13 | 南京航空航天大学 | 针对多智能体系统执行器故障的主动容错控制方法 |
CN116902227A (zh) * | 2023-09-14 | 2023-10-20 | 北京控制工程研究所 | 姿控欠能力下的离轨制动控制方法、装置、设备及介质 |
CN117022680A (zh) * | 2023-10-09 | 2023-11-10 | 北京控制工程研究所 | 轨控发动机故障下的自主离轨制动控制方法和装置 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0881146A2 (en) * | 1997-05-29 | 1998-12-02 | TRW Inc. | In situ method and system for autonomous fault detection, isolation and recovery in spacecraft |
JP2000272600A (ja) * | 1999-03-23 | 2000-10-03 | Toshiba Corp | 軌道上保守対応宇宙機システム |
US6702234B1 (en) * | 2002-03-29 | 2004-03-09 | Lockheed Martin Corporation | Fault tolerant attitude control system for zero momentum spacecraft |
WO2005044664A2 (de) * | 2003-11-05 | 2005-05-19 | Eads Space Transportation Gmbh | Träger für den transport einer nutzlast und verfahren zum ändern der umlaufbahn eines trägers |
CN101214859A (zh) * | 2007-12-26 | 2008-07-09 | 北京控制工程研究所 | 一种变轨期间自主故障检测恢复控制的方法 |
CN101508347A (zh) * | 2009-03-06 | 2009-08-19 | 上海微小卫星工程中心 | 航天器推进系统在轨自主关机控制方法 |
CN103253382A (zh) * | 2013-05-24 | 2013-08-21 | 北京控制工程研究所 | 一种高精度发动机联合变轨方法 |
CN104864875A (zh) * | 2015-04-03 | 2015-08-26 | 北京控制工程研究所 | 一种基于非线性h∞滤波的航天器自主定位方法 |
CN106742067A (zh) * | 2016-12-02 | 2017-05-31 | 上海航天控制技术研究所 | 基于参考模型的姿控发动机在轨故障诊断处理系统与方法 |
-
2017
- 2017-06-27 CN CN201710500774.4A patent/CN107340715B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0881146A2 (en) * | 1997-05-29 | 1998-12-02 | TRW Inc. | In situ method and system for autonomous fault detection, isolation and recovery in spacecraft |
JP2000272600A (ja) * | 1999-03-23 | 2000-10-03 | Toshiba Corp | 軌道上保守対応宇宙機システム |
US6702234B1 (en) * | 2002-03-29 | 2004-03-09 | Lockheed Martin Corporation | Fault tolerant attitude control system for zero momentum spacecraft |
WO2005044664A2 (de) * | 2003-11-05 | 2005-05-19 | Eads Space Transportation Gmbh | Träger für den transport einer nutzlast und verfahren zum ändern der umlaufbahn eines trägers |
CN101214859A (zh) * | 2007-12-26 | 2008-07-09 | 北京控制工程研究所 | 一种变轨期间自主故障检测恢复控制的方法 |
CN100491916C (zh) * | 2007-12-26 | 2009-05-27 | 北京控制工程研究所 | 一种变轨期间自主故障检测恢复控制的方法 |
CN101508347A (zh) * | 2009-03-06 | 2009-08-19 | 上海微小卫星工程中心 | 航天器推进系统在轨自主关机控制方法 |
CN103253382A (zh) * | 2013-05-24 | 2013-08-21 | 北京控制工程研究所 | 一种高精度发动机联合变轨方法 |
CN104864875A (zh) * | 2015-04-03 | 2015-08-26 | 北京控制工程研究所 | 一种基于非线性h∞滤波的航天器自主定位方法 |
CN106742067A (zh) * | 2016-12-02 | 2017-05-31 | 上海航天控制技术研究所 | 基于参考模型的姿控发动机在轨故障诊断处理系统与方法 |
Non-Patent Citations (5)
Title |
---|
唐军刚: "天基再入飞行器全程机动制导方法研究", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 * |
孙竹: "航空发动机故障诊断与容错控制", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 * |
戴居峰等: "高精度再入返回轨道控制技术", 《中国科学:技术科学》 * |
石凯宇等: "一种姿控发动机推力优化方法", 《现代防御技术》 * |
谭勇等: "从X-37B成功着陆看空天飞机导航飞控系统", 《现代军事》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108803316A (zh) * | 2018-03-09 | 2018-11-13 | 南京航空航天大学 | 针对多智能体系统执行器故障的主动容错控制方法 |
CN108803316B (zh) * | 2018-03-09 | 2020-12-15 | 南京航空航天大学 | 针对多智能体系统执行器故障的主动容错控制方法 |
CN116902227A (zh) * | 2023-09-14 | 2023-10-20 | 北京控制工程研究所 | 姿控欠能力下的离轨制动控制方法、装置、设备及介质 |
CN116902227B (zh) * | 2023-09-14 | 2023-12-08 | 北京控制工程研究所 | 姿控欠能力下的离轨制动控制方法、装置、设备及介质 |
CN117022680A (zh) * | 2023-10-09 | 2023-11-10 | 北京控制工程研究所 | 轨控发动机故障下的自主离轨制动控制方法和装置 |
CN117022680B (zh) * | 2023-10-09 | 2023-12-05 | 北京控制工程研究所 | 轨控发动机故障下的自主离轨制动控制方法和装置 |
Also Published As
Publication number | Publication date |
---|---|
CN107340715B (zh) | 2020-08-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107340715A (zh) | 一种返回式飞行器离轨制动期间的轨控容错控制方法 | |
CN105159308B (zh) | 一种可重复使用飞行器着陆段制导与控制律一体化耦合设计方法 | |
CN106742067B (zh) | 基于参考模型的姿控发动机在轨故障诊断处理系统与方法 | |
CN106915475A (zh) | 一种具有姿控和轨控冗余设计的返回式飞行器 | |
CN113568419B (zh) | 一种变载四旋翼无人机容错控制方法 | |
CN103926837A (zh) | 多种耦合作用下飞行器综合解耦方法 | |
CN107521669A (zh) | 利用推力差修整控制飞行器 | |
CN111319799B (zh) | 一种火星探测环绕器分离安全自主推力系统及方法 | |
US6289270B1 (en) | Method for generating connecting paths which can be used for guiding a vehicle to a predetermined target path | |
JP3867315B2 (ja) | 自動衝突回避装置 | |
CN104764464B (zh) | 一种利用全量信息进行飞行器冗余诊断的方法 | |
CN116045744A (zh) | 一种固体运载火箭分离体残骸落区的控制方法和装置 | |
CN110750837B (zh) | 一种飞机剩余操纵能力评估方法 | |
CN106502256B (zh) | 一种避免星敏感器受地气光影响的离轨姿态控制方法 | |
CN111319794B (zh) | 一种适用于火星探测制动捕获期间推进自主故障处理方法 | |
CN105799949B (zh) | 一种亚轨道卫星的压心设计方法、姿态控制方法和系统 | |
CN104898635B (zh) | 一种大推力液体火箭故障重构控制方法 | |
CN104898678B (zh) | 一种运载火箭飞行控制的冗余诊断方法 | |
CN104229161A (zh) | 一种基于制导脉冲的交会对接轨迹安全带确定方法 | |
Ariff et al. | Direct yaw moment control of independent-wheel-drive electric vehicle (IWD-EV) via composite nonlinear feedback controller | |
Yuan | Composite adaptive control of constrained robots | |
CN111017265B (zh) | 运载器能量管理段fads故障判断与控制方法、运载器及存储介质 | |
CN107167128A (zh) | 一种基于双阈值的飞行器离轨制动速度修正方法 | |
CN113761670A (zh) | 一种运载火箭的平衡飞行理论及在线入轨能力评估方法 | |
CN109212969B (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 |