CN105629987B - 一种火星着陆器抗干扰容错控制方法 - Google Patents
一种火星着陆器抗干扰容错控制方法 Download PDFInfo
- Publication number
- CN105629987B CN105629987B CN201610195807.4A CN201610195807A CN105629987B CN 105629987 B CN105629987 B CN 105629987B CN 201610195807 A CN201610195807 A CN 201610195807A CN 105629987 B CN105629987 B CN 105629987B
- Authority
- CN
- China
- Prior art keywords
- mars
- failure
- actuator
- lander
- gust
- 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
- 238000000034 method Methods 0.000 title claims abstract description 19
- 230000007246 mechanism Effects 0.000 claims description 25
- 239000002131 composite material Substances 0.000 claims description 10
- 238000006066 Comins reaction Methods 0.000 claims description 3
- 150000001875 compounds Chemical class 0.000 claims description 3
- 230000008878 coupling Effects 0.000 claims description 3
- 238000010168 coupling process Methods 0.000 claims description 3
- 238000005859 coupling reaction Methods 0.000 claims description 3
- 238000013329 compounding Methods 0.000 claims description 2
- 238000010276 construction Methods 0.000 abstract 1
- 241000282414 Homo sapiens Species 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000007547 defect Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000010304 firing Methods 0.000 description 1
- 238000002347 injection Methods 0.000 description 1
- 239000007924 injection Substances 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 239000000243 solution Substances 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0891—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for land vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Aerodynamic Tests, Hydrodynamic Tests, Wind Tunnels, And Water Tanks (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
本发明涉及一种火星着陆器抗干扰容错控制方法;首先,搭建火星着陆器的姿态运动学与动力学模型;其次,针对动力下降段火星表面阵风带来的影响,设计风扰估计器对作用在火星着陆器上的阵风影响进行估计,进而通过前馈通道进行补偿;再次,设计执行机构部分失效观测器估计火星着陆器执行机构部分失效值并予以补偿;最后,将风扰估计器、执行机构部分失效观测器和PD姿态控制器相复合,构造阵风影响下的火星着陆器执行机构部分失效的容错控制器。本发明具有强抗干扰性和高可靠性的特点,相对于传统的火星着陆器控制方法工程实用价值更高。
Description
技术领域
本发明涉及一种火星着陆器抗干扰容错控制方法,针对在阵风影响环境下火星着陆器控制***存在执行机构部分失效的情况,采用抗干扰容错控制的思路,与传统的控制器相比提高了控制***的可靠性,增强了工程应用价值。
背景技术
自人类开始空间探测以来,火星的探索就从未停止脚步。人类以找寻生命栖息的第二地球为目标,对火星进行了环绕观测、接近观察、着陆采样等一系列任务,试图在火星上寻找到生命的迹象。终于在2015年9月,美国NASA在火星上找到了水存在的可能性证据,这也标志着火星任务的又一历史性时刻。在火星任务如火如荼的进行过程中,着陆器作为执行任务的主体,能否以高精度成功抵达预定地点保证后续任务的顺利完成是整个任务的关键。而着陆器的执行机构精度及可靠性与整个着陆任务的质量息息相关。在经过了长时间的巡游过程以后,火星着陆器的执行机构容易因部分失效导致精度降低。同时,火星复杂多变的环境,给着陆器完成指令信号带来了极大影响。对于以上火星着陆器执行机构精度降低以及着陆器抗干扰能力不足两方面问题,现在的研究都有了一定的进展,但是并不能很好的解决两方面问题同时发生的情况。特别是在火星表面阵风普遍存在的情况下,着陆器需要增加喷气的推力以抵消环境的影响,此时执行机构的部分失效将会给着陆器对指令的执行带来更大的影响,最终造成着陆器偏离航线导致任务失败。
发明内容
本发明的技术解决问题是:在阵风影响环境下,针对火星着陆器控制***存在的执行机构部分失效情况,克服现有技术的不足,提供一种具有容错性能的部分失效控制方法,解决阵风影响下的控制***容错控制问题,提高***的容错能力以及抗干扰能力。
本发明的技术解决方案为:一种火星着陆器抗干扰容错控制方法,包括以下步骤:首先,搭建火星着陆器的姿态运动学与动力学模型;其次,针对动力下降段火星表面阵风带来的影响,设计风扰估计器对作用在火星着陆器上的阵风影响进行估计,进而通过前馈通道进行补偿;再次,设计执行机构部分失效观测器估计火星着陆器执行机构部分失效值并予以补偿;最后,将风扰估计器、执行机构部分失效观测器和PD姿态控制器相复合,构造阵风影响下的火星着陆器执行机构部分失效的容错控制器;具体步骤如下:
第一步,搭建火星着陆器的姿态运动学与动力学模型
搭建火星大气密度不确定性影响下的火星着陆器大气进入段运动学与动力学模型如下:
其中,F=G(σ)-1,J*=FTJF,u*=FTu,d*=FTd,σ表示火星着陆器的倾侧角,J代表火星着陆器的转动惯量,Jxx、Jyy、Jzz是着陆器三轴转动惯量值,Jxy、Jxz、Jyx、Jyz、Jzx、Jzy是三轴转动惯量耦合值,ω=[ωx,ωy,ωz]T是三轴角速度,u表示火星着陆器的三轴控制力矩,d为阵风引起的三轴干扰力矩;
在这里,我们定义eσ=σ-σd,可以得到:
这里:
其中Kp,Kd为待定控制增益;
考虑到控制输入通道中会发生喷气执行机构的部分失效情况,***可重新描述为:
其中执行机构部分失效值为E,可以表示为E=-βu,β代表执行机构失效程度,阵风引起的三轴干扰力矩d由如下***描述:
其中w(t)为***的状态变量,W,V为已知的***矩阵;δ(t)为模型摄动,可以当作能量范数有界干扰来处理;
第二步,构造风扰估计器
针对火星动力下降段阵风引起的三轴干扰力矩d,设计风扰估计器进行估计并补偿,风扰估计器结构如下:
其中,v为辅助的状态变量,L2为待定的风扰估计器增益阵,为d的估计值;
第三步,设计执行机构部分失效观测器
针对火星着陆器的执行机构部分失效设计执行机构部分失效观测器估计火星着陆器执行机构部分失效值并予以补偿,执行机构部分失效观测器结构如下:
其中,z为辅助的状态变量,L1为待定的执行机构部分失效观测器增益阵,为E的估计值。
第四步,基于风扰估计器、执行机构部分失效观测器构造复合容错控制器,设计复合容错控制器,对火星着陆器受到的阵风引起的三轴干扰力矩d和执行机构部分失效E影响估计并抵消,复合容错控制器形式如下:
其中ucom为复合容错控制量,为第三步中的执行机构部分失效估计值,为第二步中的阵风影响估计值。
本发明与现有技术相比的优点在于:本发明的阵风影响下火星着陆器执行机构部分失效的容错控制器采用了复合容错控制器的方法,控制器包括阵风干扰估计、执行机构部分失效观测补偿和姿态指令跟踪三个部分:阵风干扰估计部分由风扰估计器组成,用于估计阵风干扰对着陆器造成的影响,并通过前馈通道予以抵消;执行机构部分失效观测补偿部分由执行机构部分失效观测器构成,用于估计执行机构部分失效值并予以补偿;姿态指令跟踪部分由PD姿态控制器组成,用于消除对指令跟踪的误差;相对于现有的火星着陆器姿态控制方法,本发明设计的阵风影响下的容错控制器在抗干扰性以及可靠性方面有极大的改善;
附图说明
图1为本发明所述的火星着陆器抗干扰容错控制方法流程图。
具体实施方式
如图1所示,本发明具体实现步骤如下(以下以火星着陆器的姿态控制***为例来说明方法的具体实现):
1、搭建火星着陆器的姿态运动学与动力学模型
搭建火星大气密度不确定性影响下的火星着陆器大气进入段运动学与动力学模型如下:
其中,F=G(σ)-1,J*=FTJF,u*=FTu,d*=FTd,σ表示火星着陆器的倾侧角,J代表火星着陆器的转动惯量,Jxx、Jyy、Jzz是着陆器三轴转动惯量值,Jxy、Jxz、Jyx、Jyz、Jzx、Jzy是三轴转动惯量耦合值,ω=[ωx,ωy,ωz]T是三轴角速度,u表示火星着陆器的三轴控制力矩,d为阵风引起的三轴干扰力矩;
在这里,我们定义eσ=σ-σd,可以得到:
这里:
其中u为PD控制量,Kp,Kd为待定控制增益;
考虑到控制输入通道中会发生喷气执行机构的部分失效情况,***可重新描述为:
其中执行机构部分失效值为E,可以表示为E=-βu,β代表执行机构失效程度,阵风引起的三轴干扰力矩d由如下***描述:
其中w为***的状态变量,W,V为已知的***矩阵;δ为模型摄动,可以当作能量范数有界干扰来处理;
2、构造风扰估计器
针对火星动力下降段阵风引起的三轴干扰力矩d,设计风扰估计器进行估计并补偿。结构如下:
其中,v为辅助的状态变量,L2为待定的风扰估计器增益阵,为d的估计值。根据火星表面的环境特点,这里考虑的干扰为0~50m/s的阵风影响。
3、设计执行机构部分失效观测器
针对火星着陆器的执行机构部分失效设计执行机构部分失效观测器估计火星着陆器执行机构部分失效值并予以补偿。结构如下:
其中,z为辅助的状态变量,L1为待定的执行机构部分失效观测器增益阵,为E的估计值。其中在经过了长时间的巡游以及在恶劣环境的飞行,喷气执行机构在很大程度上面临着出现部分失效的状况,在这里考虑的是E取值范围0~30%,代表执行机构失效0~30%的情况。
4、基于风扰估计器、执行机构部分失效观测器构造复合容错控制器,设计复合容错控制器,对火星着陆器受到的阵风引起的三轴干扰力矩d和执行机构部分失效E影响估计并抵消,复合容错控制器形式如下:
其中ucom为复合容错控制量,为步骤3中的执行机构部分失效估计值,为步骤2中的阵风影响估计值。
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
Claims (1)
1.一种火星着陆器抗干扰容错控制方法,其特征在于包括以下步骤:首先,搭建火星着陆器的姿态运动学与动力学模型;其次,针对动力下降段火星表面阵风带来的影响,设计风扰估计器对作用在火星着陆器上的阵风影响进行估计,进而通过前馈通道进行补偿;再次,设计执行机构部分失效观测器估计火星着陆器执行机构部分失效值并予以补偿;最后,将风扰估计器、执行机构部分失效观测器和PD姿态控制器相复合,构造阵风影响下的火星着陆器执行机构部分失效的容错控制器;具体步骤如下:
第一步,搭建火星着陆器的姿态运动学与动力学模型
对于火星着陆器的姿态控制***,搭建火星大气密度不确定性影响下的火星着陆器大气进入段运动学与动力学模型如下:
其中,F=G(σ)-1,J*=FTJF,u*=FTu,d*=FTd,σ表示火星着陆器的倾侧角,J代表火星着陆器的转动惯量,Jxx、Jyy、Jzz是着陆器三轴转动惯量值,Jxy、Jxz、Jyx、Jyz、Jzx、Jzy是三轴转动惯量耦合值,ω=[ωx,ωy,ωz]T是三轴角速度,u表示火星着陆器的三轴控制力矩,d为阵风引起的三轴干扰力矩;
在这里,我们定义eσ=σ-σd,可以得到:
这里:
其中Kp,Kd为待定控制增益;
考虑到控制输入通道中会发生喷气执行机构的部分失效情况,***可重新描述为:
其中执行机构部分失效值为E,可以表示为E=-βu,β代表执行机构失效程度,在这里考虑的是E取值范围0~30%,代表执行机构失效0~30%的情况,阵风引起的三轴干扰力矩d由如下***描述:
其中w(t)为***的状态变量,W,V为已知的***矩阵;δ(t)为模型摄动,可以当作能量范数有界干扰来处理;
第二步,构造风扰估计器
针对火星动力下降段阵风引起的三轴干扰力矩d,设计风扰估计器进行估计并补偿,得到阵风影响估计值,风扰估计器结构如下:
其中,v为辅助的状态变量,L2为待定的风扰估计器增益阵,为d的估计值;
第三步,设计执行机构部分失效观测器
针对火星着陆器的执行机构部分失效设计执行机构部分失效观测器估计火星着陆器执行机构部分失效值并予以补偿,得到执行机构部分失效估计值,执行机构部分失效观测器结构如下:
其中,z为辅助的状态变量,L1为待定的执行机构部分失效观测器增益阵,为E的估计值;执行机构部分失效观测补偿部分由执行机构部分失效观测器构成,用于估计执行机构部分失效值并予以补偿;
第四步,基于风扰估计器、执行机构部分失效观测器构造复合容错控制器,设计复合容错控制器,对火星着陆器受到的阵风引起的三轴干扰力矩d和执行机构部分失效E影响估计并抵消,复合容错控制器形式如下:
其中ucom为复合容错控制量,为第三步中的执行机构部分失效估计值,为第二步中的阵风影响估计值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610195807.4A CN105629987B (zh) | 2016-03-31 | 2016-03-31 | 一种火星着陆器抗干扰容错控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610195807.4A CN105629987B (zh) | 2016-03-31 | 2016-03-31 | 一种火星着陆器抗干扰容错控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105629987A CN105629987A (zh) | 2016-06-01 |
CN105629987B true CN105629987B (zh) | 2017-07-18 |
Family
ID=56045041
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610195807.4A Active CN105629987B (zh) | 2016-03-31 | 2016-03-31 | 一种火星着陆器抗干扰容错控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105629987B (zh) |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2012029052A1 (en) * | 2010-09-04 | 2012-03-08 | Cgs S.P.A. Compagnia Generale Per Lo Spazio | Device and method to estimate the state of a moving vehicle |
CN103303495B (zh) * | 2013-04-11 | 2015-07-08 | 北京控制工程研究所 | 一种动力下降过程干扰力矩的估计方法 |
CN105371853A (zh) * | 2014-08-06 | 2016-03-02 | 北京理工大学 | 基于tds与轨道器的火星动力下降段导航方法 |
CN104932266B (zh) * | 2015-06-05 | 2016-04-27 | 北京航空航天大学 | 一种基于前馈补偿的着陆器进入段精确控制方法 |
-
2016
- 2016-03-31 CN CN201610195807.4A patent/CN105629987B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN105629987A (zh) | 2016-06-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Hu et al. | Robust fault-tolerant tracking control for spacecraft proximity operations using time-varying sliding mode | |
CN106292681B (zh) | 一种基于观测器和在线控制分配的卫星主动容错控制方法 | |
CN108803649B (zh) | 一种垂直起降重复使用运载器自抗扰滑模控制方法 | |
Sun et al. | Adaptive backstepping control of spacecraft rendezvous and proximity operations with input saturation and full-state constraint | |
Jiang et al. | Fixed-time rendezvous control of spacecraft with a tumbling target under loss of actuator effectiveness | |
CN103116357B (zh) | 一种具有抗干扰容错性能的滑模控制方法 | |
CN102749852B (zh) | 多源干扰***的容错抗干扰控制方法 | |
Li et al. | Adaptive multivariable integral TSMC of a hypersonic gliding vehicle with actuator faults and model uncertainties | |
Xia et al. | Robust adaptive backstepping neural networks control for spacecraft rendezvous and docking with input saturation | |
CN104155990B (zh) | 考虑攻角约束的高超声速飞行器俯仰通道姿态控制方法 | |
Zhao et al. | Finite-time super-twisting sliding mode control for Mars entry trajectory tracking | |
CN101708780A (zh) | 用于目标姿态跟踪的刚性航天器的控制方法 | |
Wang et al. | Experiments study on attitude coupling control method for flexible spacecraft | |
CN113361013B (zh) | 一种基于时间同步稳定的航天器姿态鲁棒控制方法 | |
Hu et al. | Fault tolerant control with H∞ performance for attitude tracking of flexible spacecraft | |
Zhang et al. | Integrated translational and rotational control for the terminal landing phase of a lunar module | |
Zhang et al. | Output-feedback super-twisting control for line-of-sight angles tracking of non-cooperative target spacecraft | |
CN105929840B (zh) | 一种组合体航天器复合分层抗干扰姿态稳定控制方法 | |
Zhu et al. | Adaptive sliding mode disturbance observer-based control for rendezvous with non-cooperative spacecraft | |
Xia et al. | Adaptive control for spacecraft rendezvous subject to actuator faults and saturations | |
CN103863578B (zh) | 火星着陆器喷气推力器和控制力矩陀螺复合控制*** | |
Zhang et al. | Ascent control of heavy-lift launch vehicle with guaranteed predefined performance | |
Sheng et al. | Nonsingular finite-time second order sliding mode attitude control for reentry vehicle | |
Li et al. | Dynamics and control for contactless interaction between spacecraft and tumbling debris | |
CN105843238B (zh) | 一种未知频率谐波干扰下的火星着陆器抗干扰控制器 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |