[发明专利]一种火星着陆器抗干扰容错控制方法

说明书

技术领域

本发明涉及一种火星着陆器抗干扰容错控制方法，针对在阵风影响环境下火星着陆器控制系统存在执行机构部分失效的情况，采用抗干扰容错控制的思路，与传统的控制器相比提高了控制系统的可靠性，增强了工程应用价值。

背景技术

自人类开始空间探测以来，火星的探索就从未停止脚步。人类以找寻生命栖息的第二地球为目标，对火星进行了环绕观测、接近观察、着陆采样等一系列任务，试图在火星上寻找到生命的迹象。终于在2015年9月，美国NASA在火星上找到了水存在的可能性证据，这也标志着火星任务的又一历史性时刻。在火星任务如火如荼的进行过程中，着陆器作为执行任务的主体，能否以高精度成功抵达预定地点保证后续任务的顺利完成是整个任务的关键。而着陆器的执行机构精度及可靠性与整个着陆任务的质量息息相关。在经过了长时间的巡游过程以后，火星着陆器的执行机构容易因部分失效导致精度降低。同时，火星复杂多变的环境，给着陆器完成指令信号带来了极大影响。对于以上火星着陆器执行机构精度降低以及着陆器抗干扰能力不足两方面问题，现在的研究都有了一定的进展，但是并不能很好的解决两方面问题同时发生的情况。特别是在火星表面阵风普遍存在的情况下，着陆器需要增加喷气的推力以抵消环境的影响，此时执行机构的部分失效将会给着陆器对指令的执行带来更大的影响，最终造成着陆器偏离航线导致任务失败。

发明内容

本发明的技术解决问题是：在阵风影响环境下，针对火星着陆器控制系统存在的执行机构部分失效情况，克服现有技术的不足，提供一种具有容错性能的部分失效控制方法，解决阵风影响下的控制系统容错控制问题，提高系统的容错能力以及抗干扰能力。

本发明的技术解决方案为：一种火星着陆器抗干扰容错控制方法，包括以下步骤：首先，搭建火星着陆器的姿态运动学与动力学模型；其次，针对动力下降段火星表面阵风带来的影响，设计风扰估计器对作用在火星着陆器上的阵风影响进行估计，进而通过前馈通道进行补偿；再次，设计执行机构部分失效观测器估计火星着陆器执行机构部分失效值并予以补偿；最后，将风扰估计器、执行机构部分失效观测器和PD姿态控制器相复合，构造阵风影响下的火星着陆器执行机构部分失效的容错控制器；具体步骤如下：

第一步，搭建火星着陆器的姿态运动学与动力学模型

搭建火星大气密度不确定性影响下的火星着陆器大气进入段运动学与动力学模型如下：

其中，F＝G(σ)^-1，J^*＝F^TJF，u^*＝F^Tu，d^*＝F^Td，σ表示火星着陆器的倾侧角，J代表火星着陆器的转动惯量，J_xx、J_yy、J_zz是着陆器三轴转动惯量值，J_xy、J_xz、J_yx、J_yz、J_zx、J_zy是三轴转动惯量耦合值，ω＝[ω_x,ω_y,ω_z]^T是三轴角速度，u表示火星着陆器的三轴控制力矩，d为阵风引起的三轴干扰力矩；

在这里，我们定义e_σ＝σ-σ_d，可以得到：

这里：

其中K_p，K_d为待定控制增益；

考虑到控制输入通道中会发生喷气执行机构的部分失效情况，系统可重新描述为：

其中执行机构部分失效值为E，可以表示为E＝-βu，β代表执行机构失效程度，阵风引起的三轴干扰力矩d由如下系统描述：

其中w(t)为系统的状态变量，W，V为已知的系统矩阵；δ(t)为模型摄动，可以当作能量范数有界干扰来处理；

第二步，构造风扰估计器

针对火星动力下降段阵风引起的三轴干扰力矩d，设计风扰估计器进行估计并补偿，风扰估计器结构如下：

其中，v为辅助的状态变量，L₂为待定的风扰估计器增益阵，为d的估计值；

第三步，设计执行机构部分失效观测器