CN103699131B - 一种卫星控制系统离散积分滑模容错控制方法 - Google Patents
一种卫星控制系统离散积分滑模容错控制方法 Download PDFInfo
- Publication number
- CN103699131B CN103699131B CN201310738851.1A CN201310738851A CN103699131B CN 103699131 B CN103699131 B CN 103699131B CN 201310738851 A CN201310738851 A CN 201310738851A CN 103699131 B CN103699131 B CN 103699131B
- Authority
- CN
- China
- Prior art keywords
- satellite
- matrix
- control
- executing agency
- discrete
- 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
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种卫星控制系统离散积分滑模容错控制方法,基于卫星的离散线性系统模型设计离散积分滑模控制器,控制器的虚拟控制律为<maths num="0001"></maths>,通过故障诊断和参数辨识获得执行机构健康因子W;根据控制量vk和执行机构健康因子W采用基于力矩可达集的直接分配方法获得每个执行机构的控制力矩uk;所述基于力矩可达集的直接分配方法将可达集表面按照表面法向量和目标向量之间的夹角由小到大的顺序排列。本发明方法能够有效的在线处理含健康因子不准确、多故障和多种不确定性同时存在的卫星姿态控制问题。
Description
技术领域
本发明涉及含匹配和不匹配不确定性的卫星控制系统离散积分滑模容错控制方法。
背景技术
为了保证卫星控制系统在运行过程中的高可靠性,一般要对关键部件设计足够的冗余,使系统发生故障后,经过诊断隔离和重构,可以利用健康的执行机构和相应的控制算法进行姿态控制。当某些执行机构未发生完全故障,其故障只是影响了输出效率,在没有其他的可用资源时,此时采用恰当的控制算法可以利用这些故障的执行机构实现卫星的姿态控制。另外由于干扰,建模不确定性等多种未知因素的影响,航天器控制算法应该设计充分的鲁棒性。因此,对于航天器系统,研究处理多种故障(比例故障、完全故障)和多种不确定性同时存在的姿态控制算法至关重要。
积分滑模控制方法对于不确定性具有比较强的鲁棒性,已有学者设计了连续积分滑模容错控制方法,对多故障取得了很好的容错控制效果。但是卫星控制系统是含多种不确定性的采样控制系统,需要设计能使闭环系统稳定的、同时处理故障和多种不确定性离散控制律。
发明内容
本发明所要解决的技术问题是设计一种基于离散积分滑模容错控制、健康因子的在线辨识和控制分配的卫星容错控制方法,该方法能够有效的在线处理含健康因子不准确、多故障和多种不确定性同时存在的卫星姿态控制问题。
一种卫星控制系统离散积分滑模容错控制方法,包括如下步骤:
(1)根据卫星的离散线性系统模型设计离散积分滑模控制器,具体包括如下步骤:
(1.1)设计不含故障和不确定性的卫星的线性系统模型为参考模型;所述参考模型为x0,k+1=Φx0,k+Γv0,k;其中,v0,k=-K0x0,k,x0,k为已知的第k步的参考状态,x0,k+1为第k+1步的参考状态;K0为控制系数;Φ为状态转移矩阵,Φ=I+AT,A为系统矩阵,T为采样时间;Γ为卫星的离散线性系统虚拟控制律的系数矩阵,Γ=BT,B为卫星的连续线性系统虚拟控制律的效率矩阵;I为单位矩阵;
(1.2)根据公式ek=xk-x0,k计算残差ek;其中,xk为通过测量得到的第k步的状态;
(1.3)根据公式σk=G(xk-x0)+εk计算滑模面变量σk;其中,εk=εk-1+Exk-1,E=-G(Φ-I-ΓK0),G为系数矩阵,xk为第k步测量的状态;x0为初始状态;xk-1为通过测量得到的第k-1步的状态;
(1.4)估计匹配的不确定性和不匹配的不确定性其中 B⊥为B的补空间矩阵,B⊥+为B⊥的伪逆矩阵,B+是B的伪逆矩阵;vk-1为第k-1步的控制量;
(1.5)根据公式 计算第k步的控制量vk;
(2)通过故障诊断和参数辨识获得执行机构健康因子W;
(3)根据控制量vk和执行机构健康因子W采用基于力矩可达集的直接分配方法获得每个执行机构的控制力矩uk;所述基于力矩可达集的直接分配方法将可达集表面按照表面法向量和目标向量之间的夹角由小到大的顺序排列。
本发明与现有技术相比的优点在于:
(1)提出了离散积分滑模容错控制方法,该方法可以有效处理存在多故障(比例故障、完全故障)、健康因子不准确及多种不确定性时的容错控制问题。
(2)改进了健康因子不准确性的描述方式,用不确定性的方式处理健康因子不准确问题;改进了直接方法控制分配寻找相交面的过程,使得计算速度明显提高。
附图说明
图1为卫星姿态容错控制系统的结构框图;
图2为CaseI状态变量的时间历程图;
图3为CaseII状态变量的时间历程图;
图4为CaseIII第一种情况状态变量的时间历程图;
图5为CaseIII第二种情况状态变量(左)的时间历程图。
具体实施方式
如图1所示,对于在轨运行的卫星,容错控制方法主要由三部分组成,即控制器的控制算法,控制分配算法和故障诊断参数辨识算法。控制器的控制算法能够根据量测输出z利用虚拟控制律产生控制信号v。控制分配算法实现控制器设计的虚拟控制律向执行机构的分配,各个执行机构提供的作用效果之和就可以得到卫星控制需要的控制效果。控制分配算法能够根据控制信号v和故障诊断参数辨识获得的健康因子W获得每个执行机构输出的信号u。故障诊断参数辨识算法是主动容错算法重要的环节,故障诊断参数辨识算法根据量测输出z和执行机构输出的信号u控制进行故障诊断参数辨识获得健康因子W。执行机构控制卫星系统产生状态信号x;通过系统量测获得量测输出z。
本发明对卫星姿态动力学模型采用欧拉离散化方法离散得到离散线性系统模型。
含动量轮的卫星姿态动力学模型为:
其中,Ix,Iy,Iz分别是x轴,y轴,z轴的转动惯量。φ,θ,为三个欧拉角。h(t)表示飞轮角动量向量,hx(t)、hy(t)和hz(t)为动量轮总的角动量在x轴、y轴、z轴的分量。
写成状态方程为:
其中,
A1=diag([1Ix1Iy1Iz])
A=A1 -1A2
B=A1 -1B1
ξ0(t)=A1 -1ξ1(t)+A1 -1ΔAx(t)
ξ1(t)=[0ω0hz(t)000-ω0hx(t)]T
ω0是轨道角速度。
在(2)中添加匹配/不匹配的不确定性和健康因子,得到
其中,v(t)=B0W(t)u(t)+η(t),ξ(t)=Bξm(t)+ξu(t),η(t)=B+ξ0(t)。B0是安装矩阵,B+是B的伪逆矩阵,ξm(t)是匹配的不确定性,ξu(t)是不匹配的不确定性。W(t)为健康因子,W(t)=diag([w1,w2,…,wp]),p为执行机构的个数。
将(3)按照欧拉离散方法离散化,得到,
xk+1=Φxk+Γvk+dk(4)
=Φxk+Γ(vk+ξm,k)+Tξu,k
其中,
Φ=eAT=I+AT
Γ=BT
dk=Bdm,k+du,k=(Bξm,k+ξu,kI)T,
T为采样周期。
对于存在不确定性的系统,不能得到不确定性的导数,所以公式(4)采用欧拉离散方法而没有采用更高阶的泰勒离散方法。
在线辨识的健康因子用表示, 为在线辨识出的第i个执行机构的健康因子。健康因子辨识值的不准确程度用δ(t)表示,δ(t)=diag([δ1,δ2,…,δp]),δi表示第i个执行机构健康因子辨识值的不准确程度。现有的研究一般假设健康因子的实际值W和健康因子的辨识值之间的关系为
按照(5),当时,不论δi取何值,此时(5)不够准确。本发明提出实际健康因子与健康因子辨识值之间的关系为
其中,δ(t)表示健康因子的辨识误差。
将(6)带入到(3)中,可得
其中,为辨识的健康因子矩阵,
ξ′(t)=ξ(t)-BB0δ(t)u(t)+Bη(t)。公式(7)和公式(3)有着一致的形式,所以下面并没有专门讨论健康因子的不确定性问题,而是将其视为匹配的不确定项处理。
(1)基于卫星的离散线性系统模型设计离散积分滑模控制器
算法设计步骤可以简要归纳为以下几步:
(2.1)定义参考模型
设计不含故障和不确定性的系统模型为参考模型,如式(8)所示。
x0,k+1=Φx0,k+Γv0,k(8)
其中根据极点配置或者最优控制原理得到控制律v0,k=-K0x0,k。x0,k为第k步的参考状态。K0为控制系数,根据极点配置或者最优控制原理得到。初始状态为x0,0,x0,0=x0,x0为系统初始状态。Φ为状态转移矩阵,Φ=I+AT,A为系统矩阵,T为采样时间;Γ为卫星的离散线性系统虚拟控制律的系数矩阵,Γ=BT,B为卫星的连续线性系统虚拟控制律的效率矩阵。
(2.2)计算残差
当发生故障或者存在不确定性时,ek=xk-x0,k≠0,其中xk为公式(4)中第k步的状态,可以通过测量得到。此时需要设计控制器使得实际系统跟踪上参考模型(8)。
ek+1=Φek+Γv1,k+dk(9)
其中v1,k=vk-v0,k。
(2.3)定义滑模面
离散积分滑模面定义如下,
σk=G(xk-x0)+εk(10)
εk=εk-1+Exk-1
其中,G为系数矩阵,取为BT,E=-G(Φ-I-ΓK),ε0=0。
(2.4)辨识匹配的不确定性和不匹配的不确定性
不确定性的辨识对于增强系统对故障和多种未知不确定性的鲁棒性非常重要,
其中,B⊥为B的补空间矩阵。
(2.5)计算控制律
根据等价控制方法,通过推导可得系统的控制律
上述公式(12)为控制器内的虚拟控制律。
(2)在线辨识执行器健康因子
执行机构健康因子W的在线辨识,是本文算法重要组成部分,是主动容错控制中控制分配所依赖的基础。但是本文并没有专门研究在线辨识算法,而是直接应用现有的算法和结论。相应的算法很多,比如可以采用卡尔曼滤波观测器和积分滑模观测器等。
(3)控制分配方法
控制分配是求解公式
vk=B0Wuk(13)
中的每个执行机构的控制力矩uk的值。控制分配算法采用了基于力矩可达集(AMS)的直接分配方法。为了提高相交面的搜索速度,在求解的过程中,本文提出将可达集表面按照表面法向量和目标向量之间的夹角由小到大的顺序排列,
可达集排序指标为
其中,ni为每个可达集表面的法向量,Angi表示目标向量vk和可达集表面法向量ni之间的夹角的余弦,按照Angi从小到大排序,可以快速的定位相交表面,从而可以快速求解(13)。
Simulink仿真
本文的仿真以一个六动量轮的航天器为实例,Ix=200kgm2,Iy=100kgm2,Iz=180kgm2,ω0=2π/3600Torbit,Torbit=10h,T=0.01。六个飞轮安装在正六棱锥的六个棱上,安装角为35.26°,安装矩阵为,
c=cos35.26,s=sin35.26。
仿真几种情况:
1)CaseI:存在健康因子不精确和故障。其中δ=diag([0.200.1000]),当t>20s,x0=[0.200000],u0=[000000]。仿真结果如图2所示,其中纵坐标x1~x6依次表示状态变量的各个值。如图2所示,本发明可以有效处理健康因子不精确的容错控制问题,系统渐进稳定。
2)CaseII:存在健康因子不精确、故障和匹配的不确定性。其中δ=diag([0.200.1000]),ξm,k=[0.05sin0.2πt00],当t>20s,x0=[0.200000],u0=[000000]。仿真结果如图3所示,本发明能够有效处理健康因子不精确和匹配不确定性存在时的容错控制问题,系统渐进稳定。
3)CaseIII:存在健康因子不精确、故障和两种不匹配的不确定性;
δ=diag([0.200.1000]),当t>20s,
x0=[0.200000],u0=[000000]。
第一种不匹配不确定性ξu∈L2∩L∞=[0.05e-0.2πt00000],仿真结果如图4所示,控制算法可以有效的处理含有此种不匹配不确定性的多种故障情况下的容错控制问题,系统渐进稳定。第二种不匹配不确定性ξu∈L∞=[0.05sin2πt00000],仿真结果如图5所示,系统有界稳定。
由此可见,本发明实现对多故障,匹配的不确定性和不匹配的不确定性存在时的离散线性系统的容错控制,得到满意的系统运行状态。
本发明未详细介绍的内容属于本领域公知常识。
Claims (1)
1.一种卫星控制系统离散积分滑模容错控制方法,包括如下步骤:
(1)根据卫星的离散线性系统模型设计离散积分滑模控制器,具体包括如下步骤:
(1.1)设计不含故障和不确定性的卫星的线性系统模型为参考模型;所述参考模型为x0,k+1=Φx0,k+Γv0,k;其中,v0,k=-K0x0,k,x0,k为已知的第k步的参考状态,x0,k+1为第k+1步的参考状态;K0为控制系数;Φ为状态转移矩阵,Φ=I+AT,A为系统矩阵,T为采样时间;Γ为卫星的离散线性系统虚拟控制律的系数矩阵,Γ=BT,B为卫星的连续线性系统虚拟控制律的效率矩阵;I为单位矩阵;
(1.2)根据公式ek=xk-x0,k计算残差ek;其中,xk为通过测量得到的第k步的状态;
(1.3)根据公式σk=G(xk-x0)+εk计算滑模面变量σk;其中,εk=εk-1+Exk-1,ε0=0,E=-G(Φ-I-ΓK0),G为系数矩阵,xk为第k步测量的状态;x0为初始状态;xk-1为通过测量得到的第k-1步的状态;
(1.4)估计匹配的不确定性和不匹配的不确定性其中 B⊥为B的补空间矩阵,B⊥+为B⊥的伪逆矩阵,B+是B的伪逆矩阵;vk-1为第k-1步的控制量;
(1.5)根据公式 计算第k步的控制量vk;
(2)通过故障诊断和参数辨识获得执行机构健康因子W;
(3)根据控制量vk和执行机构健康因子W采用基于力矩可达集的直接分配方法获得每个执行机构的控制力矩uk;所述基于力矩可达集的直接分配方法将可达集表面按照表面法向量和目标向量之间的夹角由小到大的顺序排列。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310738851.1A CN103699131B (zh) | 2013-12-26 | 2013-12-26 | 一种卫星控制系统离散积分滑模容错控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310738851.1A CN103699131B (zh) | 2013-12-26 | 2013-12-26 | 一种卫星控制系统离散积分滑模容错控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103699131A CN103699131A (zh) | 2014-04-02 |
CN103699131B true CN103699131B (zh) | 2016-05-04 |
Family
ID=50360695
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310738851.1A Active CN103699131B (zh) | 2013-12-26 | 2013-12-26 | 一种卫星控制系统离散积分滑模容错控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103699131B (zh) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104483973B (zh) * | 2014-11-20 | 2017-05-03 | 哈尔滨工业大学 | 基于滑模观测器的低轨挠性卫星姿态跟踪控制方法 |
CN104503233B (zh) * | 2014-11-27 | 2017-04-12 | 哈尔滨工业大学 | 适用于卫星姿态控制的干扰力矩辨识方法 |
CN105404304B (zh) * | 2015-08-21 | 2018-05-25 | 北京理工大学 | 基于归一化神经网络的航天器容错姿态协同跟踪控制方法 |
CN105843240B (zh) * | 2016-04-08 | 2019-01-22 | 北京航空航天大学 | 一种考虑执行器故障的航天器姿态积分滑模容错控制方法 |
CN106026794A (zh) * | 2016-08-03 | 2016-10-12 | 北京机械设备研究所 | 一种用于飞轮控制的滑模方法 |
CN107703742B (zh) * | 2017-09-06 | 2020-09-01 | 南京邮电大学 | 一种柔性航天器传感器故障调节方法 |
CN109917428B (zh) * | 2017-12-12 | 2021-02-05 | 北京自动化控制设备研究所 | 一种高动态卫星信号跟踪方法 |
CN108445783B (zh) * | 2018-02-09 | 2020-07-14 | 北京理工大学 | 一种基于启发式搜索的过驱系统控制方法 |
CN108415239B (zh) * | 2018-02-09 | 2020-08-11 | 北京理工大学 | 一种基于动态构建可达集的直接控制分配方法 |
CN110442110B (zh) * | 2018-05-04 | 2020-06-30 | 中国科学院沈阳自动化研究所 | 一种基于二阶滑模观测器的航天器故障诊断方法 |
CN109445448B (zh) * | 2018-10-31 | 2021-08-17 | 中国人民解放军战略支援部队航天工程大学 | 一种轮控小卫星自适应积分滑模姿态控制器 |
CN111562794B (zh) * | 2020-04-08 | 2021-09-14 | 中南大学 | 执行器故障和输入量化的航天器姿态控制方法 |
CN112769367B (zh) * | 2021-01-07 | 2022-08-26 | 山东交通学院 | 永磁直线电机数据驱动离散迭代积分滑模控制方法及系统 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0251808A3 (en) * | 1986-07-04 | 1988-07-27 | The Marconi Company Limited | Satellite attitude control |
CN102862686A (zh) * | 2012-09-28 | 2013-01-09 | 北京理工大学 | 再入飞行器的最优积分滑模姿态控制方法及控制器 |
CN103116357A (zh) * | 2013-03-14 | 2013-05-22 | 郭雷 | 一种具有抗干扰容错性能的滑模控制方法 |
CN103324202A (zh) * | 2013-07-12 | 2013-09-25 | 无锡华航电子科技有限责任公司 | 基于舵面故障的容错飞行控制系统和方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11129997A (ja) * | 1997-11-04 | 1999-05-18 | Mitsubishi Electric Corp | 人工衛星の姿勢制御装置 |
-
2013
- 2013-12-26 CN CN201310738851.1A patent/CN103699131B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0251808A3 (en) * | 1986-07-04 | 1988-07-27 | The Marconi Company Limited | Satellite attitude control |
CN102862686A (zh) * | 2012-09-28 | 2013-01-09 | 北京理工大学 | 再入飞行器的最优积分滑模姿态控制方法及控制器 |
CN103116357A (zh) * | 2013-03-14 | 2013-05-22 | 郭雷 | 一种具有抗干扰容错性能的滑模控制方法 |
CN103324202A (zh) * | 2013-07-12 | 2013-09-25 | 无锡华航电子科技有限责任公司 | 基于舵面故障的容错飞行控制系统和方法 |
Non-Patent Citations (2)
Title |
---|
林常青等.临近空间飞行器的自适应积分滑模容错控制.《装备指挥技术学院学报》.2012,第23卷(第1期),全文. * |
鲍额尔敦等.过驱动飞行器积分滑模容错控制方法.《飞行力学》.2012,第30卷(第1期),全文. * |
Also Published As
Publication number | Publication date |
---|---|
CN103699131A (zh) | 2014-04-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103699131B (zh) | 一种卫星控制系统离散积分滑模容错控制方法 | |
Chen et al. | Observer-based fault diagnosis of satellite systems subject to time-varying thruster faults | |
de Oca et al. | Fault-tolerant control strategy for actuator faults using LPV techniques: Application to a two degree of freedom helicopter | |
CN103365296B (zh) | 一种四旋翼无人飞行器非线性输出反馈飞行控制方法 | |
Hu et al. | Adaptive control for hypersonic vehicles with time-varying faults | |
Han et al. | Adaptive fault-tolerant control of spacecraft attitude dynamics with actuator failures | |
Jiang et al. | Adaptive neural observer‐based backstepping fault tolerant control for near space vehicle under control effector damage | |
CN103116357B (zh) | 一种具有抗干扰容错性能的滑模控制方法 | |
Xu et al. | Decentralized asymptotic fault tolerant control of near space vehicle with high order actuator dynamics | |
CN103676918B (zh) | 一种基于未知输入观测器的卫星执行机构故障诊断方法 | |
Lu et al. | Nonlinear aircraft sensor fault reconstruction in the presence of disturbances validated by real flight data | |
Zhang et al. | Robust H∞ adaptive descriptor observer design for fault estimation of uncertain nonlinear systems | |
CN104020774A (zh) | 基于动态控制重新分配的飞行器姿态容错控制方法 | |
Skriver et al. | Adaptive extended Kalman filter for actuator fault diagnosis | |
CN104020670A (zh) | 基于支持向量机的三自由度直升机容错控制装置及方法 | |
Chang et al. | Adaptive second-order sliding mode observer for quadrotor attitude estimation | |
Wu et al. | Relative dynamics and control for satellite formation: accommodating J 2 perturbation | |
Naveen et al. | Momentum model-based minimal parameter identification of a space robot | |
Touati et al. | Fault detection and isolation in presence of input and output uncertainties using bond graph approach | |
Jing et al. | Adaptive sliding mode backstepping control for near space vehicles considering engine faults | |
Bole et al. | SIL/HIL replication of electric aircraft powertrain dynamics and inner-loop control for V&V of system health management routines | |
Yu et al. | Fault‐tolerant attitude tracking control with practical finite time convergence for unmanned aerial vehicles under actuation faults | |
Shaqura et al. | A hybrid system approach to airspeed, angle of attack and sideslip estimation in unmanned aerial vehicles | |
Chang et al. | Design of sliding mode observers for quadrotor pitch/roll angle estimation via IMU measurements | |
Lan et al. | Fault-tolerant tracking control for a 3-DOF helicopter with actuator faults and saturation |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |