CN108153322B - 一种考虑时变的转动惯量的航天器姿态跟踪自适应容错控制方法 - Google Patents
一种考虑时变的转动惯量的航天器姿态跟踪自适应容错控制方法 Download PDFInfo
- Publication number
- CN108153322B CN108153322B CN201711276018.4A CN201711276018A CN108153322B CN 108153322 B CN108153322 B CN 108153322B CN 201711276018 A CN201711276018 A CN 201711276018A CN 108153322 B CN108153322 B CN 108153322B
- Authority
- CN
- China
- Prior art keywords
- spacecraft
- actuator
- varying
- matrix
- moment
- 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 25
- 230000003044 adaptive effect Effects 0.000 title claims abstract description 24
- 238000013461 design Methods 0.000 claims abstract description 25
- 230000006641 stabilisation Effects 0.000 claims abstract description 4
- 238000011105 stabilization Methods 0.000 claims abstract description 4
- 239000011159 matrix material Substances 0.000 claims description 40
- 239000000446 fuel Substances 0.000 claims description 14
- 239000013598 vector Substances 0.000 claims description 12
- 230000005484 gravity Effects 0.000 claims description 3
- 230000005855 radiation Effects 0.000 claims description 3
- 230000017105 transposition Effects 0.000 claims description 3
- 230000004888 barrier function Effects 0.000 claims description 2
- 238000006243 chemical reaction Methods 0.000 claims description 2
- 239000002828 fuel tank Substances 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 230000006835 compression Effects 0.000 description 2
- 238000007906 compression Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012360 testing method Methods 0.000 description 2
- PEDCQBHIVMGVHV-UHFFFAOYSA-N Glycerine Chemical compound OCC(O)CO PEDCQBHIVMGVHV-UHFFFAOYSA-N 0.000 description 1
- 238000005299 abrasion Methods 0.000 description 1
- 230000006978 adaptation Effects 0.000 description 1
- 230000015556 catabolic process Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000003745 diagnosis Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 235000013399 edible fruits Nutrition 0.000 description 1
- 238000009415 formwork Methods 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000006855 networking Effects 0.000 description 1
- 239000003380 propellant Substances 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
- 238000005303 weighing Methods 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/22—Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
- B64G1/24—Guiding or controlling apparatus, e.g. for attitude control
- B64G1/244—Spacecraft control systems
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种考虑时变的转动惯量的航天器姿态跟踪自适应容错控制方法,包括建立不考虑执行器故障,但含有外部扰动以及时变转动惯量的航天器姿态跟踪动力学模型,以及建立时变的转动惯量模型;基于航天器姿态跟踪动力学模型,设计标称控制器以及相应的自适应律,保证无故障时系统的稳定以及跟踪误差的收敛;在航天器姿态跟踪动力学模型中加入执行器故障,基于标称控制器设计辅助控制器,解决了航天器在轨工作时执行器发生故障且存在时变转动惯量及受到外部扰动力矩影响的问题,保证了系统的容错能力和鲁棒性。
Description
技术领域
本发明涉及航天器控制技术领域,具体涉及一种考虑时变的转动惯量的航天器姿态跟踪自适应容错控制方法。
背景技术
航天事业的大力发展对国民经济、社会发展等方面起到了不可忽视的作用,越来越受到国家及社会各界的广泛重视,2017年上半年,“天舟一号”货运飞船顺利发射并成功完成与天宫二号的首次推进剂在轨补加试验,我国首颗高轨道高通量通信卫星“实践十三号”顺利发射升空,2017年下半年预计发射2组“北斗三号”全球组网卫星,计划发射“嫦娥五号”月球探测器,以及多载荷、高精度地震监测试验卫星“张衡一号”。为了进行轨道维持、自身姿态调整等目的,这些人造卫星都会携带一定量的燃料,而卫星自身携带燃料的消耗会造成转动惯量的变化以及卫星质心的变化,质心的变化又会引起转动惯量的进一步变化。例如2017年发射的“中星9A”广播电视直播卫星,由于火箭工作异常未达到预定轨道,后卫星通过轨道调整成功到达预定轨道,这一过程会消耗大量燃料,会引起卫星质心以及转动惯量的变化,影响卫星控制系统的精度,因此控制器设计过程中将由于燃料消耗而引起的时变的转动惯量考虑在内可有效提高控制精度。此外,航天器姿态控制系统是航天器最为关键的分系统之一,具有一定的容错能力和鲁棒性能十分重要。航天器在轨运行过程中,恶劣的航天环境、航天器执行机构长期暴露在失重、低温、强辐射的环境中,加上自身部件的老化磨损致使执行机构出现故障,这可能会在很短时间内导致航天器翻滚、姿态丢失,甚至导致航天器完全失控,从而造成航天任务完全失败,因此设计具有容错能力的控制器,使得航天器在轨运行中能应对多种可能发生的故障,可有效提高控制系统的可靠性。另外,航天器还会受到来自空间的各种扰动力矩的影响,因此,提高系统的鲁棒性也是卫星姿态控制系统的重要任务。
针对航天器姿态跟踪问题,专利CN201410668391.4首先定义模态振动状态从而将挠性卫星姿态动力学方程改写为状态空间表达式,然后采用滑模观测器观测得到模态振动位移和模态振动状态的实时信息,最后根据测量得到的卫星姿态四元数、姿态角速度信息与估计的模态量值对误差姿态跟踪模型采用滑模控制率进行跟踪控制,然而,此方法没有考虑到执行器故障的可能性,因此不具备容错能力;专利CN201510232385.9设计一个三轴力矩有效性故障因子观测器,然后基于观测器获得的有效性故障因子估计值设计一种自适应控制方法以实现在执行机构出现故障情况下的航天器机动控制,但是其中没有考虑执行器完全失效以及加性故障的情况,因此对可能故障类型的考虑不够完备;专利CN201210559209.2设计一个线性扩张状态观测器,并利用观测器估计出来的状态和广义扰动设计鲁棒容错控制律,但是在航天器动力学模型的建立过程中并未考虑转动惯量的时变特性;因此,现有的航天器姿态跟踪控制方法较少的具备容错能力,而现有的航天器容错控制方法较少将多种可能的故障类型同时考虑在内,并且忽略了转动惯量的时变特性。
发明内容
由于航天器姿态跟踪过程中会同时受到空间环境扰动力,燃料消耗也会造成的转动惯量的变化,以及可能出现执行器发生故障的问题,本发明的目的在于克服现有技术的不足,提供一种考虑时变的转动惯量的航天器姿态跟踪自适应容错控制方法,主要应用于卫星在轨工作时发生执行器故障且受到来自空间的外部扰动力矩以及由于燃料消耗而产生的时变的转动惯量的姿态跟踪控制系统,解决了航天器在轨工作时执行器发生故障且存在时变转动惯量及受到外部扰动力矩影响的问题,保证了系统的容错能力和鲁棒性。
本发明提供了一种考虑时变的转动惯量的航天器姿态跟踪自适应容错控制方法,包括如下步骤:
(1)建立不考虑执行器故障,但含有外部扰动以及时变转动惯量的航天器姿态跟踪动力学模型,以及建立时变的转动惯量模型;
(2)基于航天器姿态跟踪动力学模型,设计标称控制器以及相应的自适应律,保证无故障时系统的稳定以及跟踪误差的收敛;
(3)在航天器姿态跟踪动力学模型中加入执行器故障,基于标称控制器设计辅助控制器,实现对执行器故障、外部扰动以及时变转动惯量特性的鲁棒性。
所述步骤(1)中不考虑执行器故障,但含有外部扰动以及时变转动惯量的航天器姿态跟踪动力学模型如下:
ωe=ω-C(qe)ωr
其中,ω=[ω1,ω2,ω3]T为航天器在本体坐标系下相对于惯性坐标系的姿态角速度,ω1,ω2,ω3分别为在本体坐标系的x轴、y轴和z轴上的角速度分量;ωr=[ωr1,ωr2,ωr3]T为航天器本体坐标系相对于惯性坐标系的期望角速度;ωe=[ωe1,ωe2,ωe3]T为航天器期望角速度与本体角速度的差;qe=[qe0,qev]T=[qe0,qe1,qe2,qe3]T为航天器姿态跟踪误差,表达式为qev=qr0qv-qrv×qv-q0qrv,且满足其中(·)×(·)表示向量叉乘,q=[q0,qv]T=[q0,q1,q2,q3]T为航天器的姿态单位四元数,其中为与绕欧拉轴旋转的角度有关的标量,α表示绕着欧拉轴转过的一个角度,qv=[q1,q2,q3]T为与欧拉轴方向有关的含有三个元素的列向量,ex,ey,ez代表欧拉轴三个方向上的旋转轴,且满足q0 2+qv Tqv=1,qr=[qr0,qrv]T=[qr0,qr1,qr2,qr3]T为期望的单位四元数,且也满足J为航天器的转动惯量矩阵,且是3×3的正定对称矩阵;u=[u1,u2,u3]T为航天器执行机构输出的控制力矩;d为航天器所受实际环境扰动力矩,虽然其值未知但是有界,可以表示为||d||≤dm,dm定义为外部扰动的上界值,是一个正的常数;S(ωe)为斜对称矩阵,其形式为 为运动学方程中与姿态四元数有关的矩阵,其中I为3×3的单位矩阵,C(qe)∈R3×3为航天器期望姿态到航天器实际姿态的转换矩阵,其表达式为:C(qe)=C(q)(C(qr))T,其中 记
进一步地,外部扰动包括重力梯度力矩、气动力矩和/或太阳辐射压力矩。
进一步地,所述步骤(1)中,建立时变的转动惯量模型如下:
J(t)=J0+J1Ψ(t)
其中,为转动惯量矩阵中未知的不随时间变化的部分;J1Ψ(t)为转动惯量矩阵中时变的部分,其中m(t)为t时刻剩余的燃料质量;rf为燃料箱与航天器初始质心之间的距离;r(t)为t时刻航天器瞬时质心与航天器初始质心之间的距离;c为体现燃料质量消耗与控制力矩之间关系的参数,是一个正的常数;||u||为控制力矩的范数。
进一步地,所述步骤(2)中设计标称控制器以及相应的自适应律如下:
s=ωe+kqe
其中,s为用于设计控制器所选取的滑模面;k>0为待选取的控制参数;θ=[J011,J022,J033]T为包含转动惯量未知部分J0所有特征参数的向量;为向量θ的估计值;γ为自适应律增益参数,且为正的常数;回归矩阵W满足:Wθ=-S(ω)J0ω+J0φ+kJ0Qωe,其中 控制器中的H定义为H=-S(ω)J1Ψω+J1Ψφ+kJ1ΨQωe,Ω定义为K为控制器增益参数,是正的常数,且满足K>dm;上式中的符号函数sgn(·)定义为
进一步地,所述步骤(3)具体为:
加入执行器故障后的航天器姿态跟踪动力学模型以及设计的辅助控制器如下:
u=DT(unom+uaux)
其中,航天器动力学方程中的W1θ定义为W1θ=-S(ω)J0ω+J0φ,H1定义为H1=-S(ω)J1Ψω+J1Ψφ;D为执行机构分配矩阵,且满足秩为rank(D)=3,使用多于三个的执行器冗余配置的方式,对各个轴向的执行器力矩进行分配;DT为矩阵D的转置;为执行器实际输出的控制力矩,其中,u=[u1,u2,...,un]T为对应的n个执行器的控制力矩信号,且n≥4,E(t)=diag(g1(t),g2(t),...,gn(t))为执行机构失效矩阵,是n×n的对角矩阵,gi(t),i=1,2,...,n为各个执行器的失效因子,且满足0≤gi(t)≤1,这里,如果gi(t)=1表示第i个执行器正常工作,如果0<gi(t)<1表示第i个执行器部分失效,如果gi(t)=0则表示第i个执行器完全失效,为执行器加性故障力矩,其值未知但是有界,且满足 其中f0和fm为两个正的常数;uaux为设计的辅助控制器;σmax和σmin定义为矩阵DEDT特征值的上界值与下界值;K*为控制器增益参数,是正的常数,且满足K*≥dm+fm。
本发明设计的考虑时变的转动惯量的航天器姿态跟踪自适应容错控制方法与现有技术相比的优点在于:
(1)本发明建立了将由于燃料消耗而引起的时变的转动惯量考虑在内的航天器姿态跟踪动力学模型,更加符合实际,能有效地提高控制精度;
(2)此外,建立了明确的基于单燃料箱航天器的时变转动惯量模型,且该模型同样适用于具有对称的多燃料箱的航天器,具有较好的工程实用性;
(3)对于适用的故障类型,本发明对执行器部分失效、全部失效以及执行器加性故障同时存在的情况具有很强的容错能力,能有效地提高航天器可靠性,并且在控制器设计过程中没有用到故障信息,因此不需要设计任何故障检测与诊断模块。
附图说明
图1为航天器姿态跟踪自适应容错控制方法的系统框图;
图2为航天器姿态跟踪自适应容错控制方法的航天器本体坐标系平面示意图;
图3为航天器姿态跟踪自适应容错控制方法的设计流程图。
具体实施方式
下面详细说明本发明的具体实施,有必要在此指出的是,以下实施只是用于本发明的进一步说明,不能理解为对本发明保护范围的限制,该领域技术熟练人员根据上述本发明内容对本发明做出的一些非本质的改进和调整,仍然属于本发明的保护范围。
本发明提供了一种考虑时变的转动惯量的航天器姿态跟踪自适应容错控制方法,步骤为:首先建立不考虑执行器故障但含有外部扰动和时变转动惯量的航天器姿态跟踪动力学模型,以及时变的转动惯量矩阵模型;然后基于航天器姿态跟踪系统模型设计标称控制器以及相应的自适应律,保证在无故障情况下系统的稳定以及跟踪误差的收敛;接着将故障信息引入到所建立的航天器姿态跟踪动力学模型中,并在标称控制器的基础上设计辅助控制器,实现系统的容错能力;具体步骤如下:
第一步,建立不考虑执行器故障但含有外部扰动和时变转动惯量的航天器姿态跟踪动力学模型为:
ωe=ω-C(qe)ωr
其中,ω=[ω1,ω2,ω3]T为航天器在本体坐标系下相对于惯性坐标系的姿态角速度,ω1,ω2,ω3分别为在本体坐标系的x轴、y轴和z轴上的角速度分量,角速度初值可选为ω(0)=[0.01,-0.01,0.01]T;ωr=[ωr1,ωr2,ωr3]T为航天器本体坐标系相对于惯性坐标系的期望角速度,可选ωr(t)=x(t)[1,1,1]T,ωe=[ωe1,ωe2,ωe3]T为航天器期望角速度与本体角速度的差,其值可由ω,ωr和C(qe)得到;qe=[qe0,qev]T=[qe0,qe1,qe2,qe3]T为航天器姿态跟踪误差,表达式为qev=qr0qv-qrv×qv-q0qrv,且满足其中(·)×(·)表示向量叉乘,q=[q0,qv]T=[q0,q1,q2,q3]T为航天器的姿态单位四元数,其中为标量,与绕欧拉轴旋转的角度有关,α表示绕着欧拉轴转过的一个角度,qv=[q1,q2,q3]T为含有三个元素的列向量,与欧拉轴方向有关,ex,ey,ez代表欧拉轴三个方向上的旋转轴,且满足q0 2+qv Tqv=1,其初始值选为qr=[qr0,qrv]T=[qr0,qr1,qr2,qr3]T为期望的单位四元数,且也满足其初始值为qr(0)=[1,0,0,0]T;J为航天器的转动惯量矩阵,且是3×3的正定对称矩阵;u=[u1,u2,u3]T为航天器执行机构输出的控制力矩;d为航天器所受实际环境扰动力矩,虽然其值未知但是有界,可以表示为||d||≤dm,dm定义为外部扰动的上界值,是一个正的常数,这里可取d=0.06[sin(0.8t)cos(0.5t)cos(0.3t)]T N·m;S(ωe)为斜对称矩阵,其形式为 为运动学方程中与姿态四元数有关的矩阵,其中I为3×3的单位矩阵,C(qe)∈R3×3为航天器期望姿态到航天器实际姿态的转换矩阵,其表达式为C(qe)=C(q)(C(qr))T,其中 其值可由q及qr得到。为书写简便,记
时变的转动惯量矩阵模型如下:
J(t)=J0+J1Ψ(t)
其中,转动惯量矩阵中为未知的不随时间变化的部分,,其值可选取为J1Ψ(t)为转动惯量矩阵中时变的部分,m(t)为t时刻剩余的燃料质量,其初值为m(0)=50kg;rf为燃料箱与航天器初始质心之间的距离,其值选择为rf=0.2m;r(t)为t时刻航天器瞬时质心与航天器初始质心之间的距离,其初始值为r(0)=0;c为体现燃料质量消耗与控制力矩之间关系的参数,是一个正的常数,在这里选择c=0.03;||u||为控制力矩的范数。
第二步,基于第一步建立的航天器姿态跟踪控制系统模型,设计标称控制器及相应的自适应律如下:
s=ωe+kqe
其中,s为选取的滑模面;k>0为待选取的控制参数,针对所选取的航天器模型参数,为了取得较好的控制效果,经过调参,其值可选为k=1;θ=[J011,J022,J033]T为包含转动惯量未知部分J0所有特征参数的向量;为向量θ的估计值,其初始值选为γ为自适应律增益参数,且为正的常数,经过调参,这里选取为γ=15;回归矩阵W满足Wθ=-S(ω)J0ω+J0φ+kJ0Qωe,控制器中的H定义为用于简化控制器表达式;Ω定义为K为控制器增益参数,是正的常数,且满足K>dm,这里可选取K=1.5;上式中的符号函数sgn(·)定义为
第三步,在航天器姿态跟踪动力学模型中加入执行器故障以及设计的辅助控制器如下:
u=DT(unom+uaux)
其中,航天器动力学方程中的W1θ定义为Wθ=-S(ω)J0ω+J0φ,H1定义为H1=-S(ω)J1Ψω+J1Ψφ;D为执行机构分配矩阵,且满足秩为rank(D)=3,这里引入执行器分配矩阵是因为考虑到由于执行器故障可能会引起的执行器输出力矩不足以达到控制目的的问题,为了从硬件角度提高卫星姿态跟踪控制系统的容错能力,考虑使用多于三个的执行器冗余配置的方式,因此需要对各个轴向的执行器力矩进行分配,这里采用6个对称安装的双侧推进器,分配矩阵选择为DT为矩阵D的转置;为执行器实际输出的控制力矩,其中,u=[u1,u2,...,un]T为对应的n个执行器的控制力矩信号,这里n=6,E(t)=diag(g1(t),g2(t),...,gn(t))为执行机构失效矩阵,是n×n的对角矩阵,gi(t),i=1,2,...,n为各个执行器的失效因子,且满足0≤gi(t)≤1,这里,如果gi(t)=1表示第i个执行器正常工作,如果0<gi(t)<1表示第i个执行器部分效能损失,如果gi(t)=0则表示第i个执行器完全失效,考虑执行器工作时可能出现的实际故障情况,将其表示为gi(t)=0.7=0.1rand(ti)+0.1sin(0.5t+iπ/3),ti=mod(t+Δti,T),i=1,2,...,6,其中为一个产生随机数的函数,Δti=2(i-1),取样时间T取为T=13s,并在11s,15s,19s时设置执行器2,4和6完全失效,为执行器加性故障力矩,其值未知但是有界,且满足其值选择为:
其中f0和fm为两个正的常数;uaux为设计的辅助控制器;σmax和σmin定义为矩阵DEDT特征值的上界值与下界值,可选取为σmax=1.2,σmin=0.3;K*为控制器增益参数,且满足K*≥dm+fm,这里选择K*=2。另外,滑模面中的增益参数k以及自适应律中的增益参数γ在这里分别取k=1.5,γ=8。
尽管为了说明的目的,已描述了本发明的示例性实施方式,但是本领域的技术人员将理解,不脱离所附权利要求中公开的发明的范围和精神的情况下,可以在形式和细节上进行各种修改、添加和替换等的改变,而所有这些改变都应属于本发明所附权利要求的保护范围,并且本发明要求保护的产品各个部门和方法中的各个步骤,可以以任意组合的形式组合在一起。因此,对本发明中所公开的实施方式的描述并非为了限制本发明的范围,而是用于描述本发明。相应地,本发明的范围不受以上实施方式的限制,而是由权利要求或其等同物进行限定。
Claims (5)
1.一种考虑时变的转动惯量的航天器姿态跟踪自适应容错控制方法,其特征在于,包括如下步骤:
(1)建立不考虑执行器故障,但含有外部扰动以及时变转动惯量的航天器姿态跟踪动力学模型,以及建立时变的转动惯量模型;
(2)基于航天器姿态跟踪动力学模型,设计标称控制器以及相应的自适应律,保证无故障时系统的稳定以及跟踪误差的收敛;
(3)在航天器姿态跟踪动力学模型中加入执行器故障,基于标称控制器设计辅助控制器,实现对执行器故障、外部扰动以及时变转动惯量特性的鲁棒性;
所述步骤(1)中不考虑执行器故障,但含有外部扰动以及时变转动惯量的航天器姿态跟踪动力学模型如下:
ωe=ω-C(qe)ωr
其中,ω=[ω1,ω2,ω3]T为航天器在本体坐标系下相对于惯性坐标系的姿态角速度,ω1,ω2,ω3分别为在本体坐标系的x轴、y轴和z轴上的角速度分量;
ωr=[ωr1,ωr2,ωr3]T为航天器本体坐标系相对于惯性坐标系的期望角速度;
ωe=[ωe1,ωe2,ωe3]T为航天器期望角速度与本体角速度的差;
qe=[qe0,qev]T=[qe0,qe1,qe2,qe3]T为航天器姿态跟踪误差,表达式为
qev=qr0qv-qrv×qv-q0qrv,且满足其中(·)×(·)表示向量叉乘,q=[q0,qv]T=[q0,q1,q2,q3]T为航天器的姿态单位四元数,其中为与绕欧拉轴旋转的角度有关的标量,α表示绕着欧拉轴转过的一个角度,qv=[q1,q2,q3]T为与欧拉轴方向有关的含有三个元素的列向量, ex,ey,ez代表欧拉轴三个方向上的旋转轴,且满足q0 2+qv Tqv=1,qr=[qr0,qrv]T=[qr0,qr1,qr2,qr3]T为期望的单位四元数,且也满足J为航天器的转动惯量矩阵,且是3×3的正定对称矩阵;u=[u1,u2,u3]T为航天器执行机构输出的控制力矩;d为航天器所受实际环境扰动力矩,虽然其值未知但是有界,可以表示为||d||≤dm,dm定义为外部扰动的上界值,是一个正的常数;S(ωe)为斜对称矩阵,其形式为 为运动学方程中与姿态四元数有关的矩阵,其中I为3×3的单位矩阵,C(qe)∈R3×3为航天器期望姿态到航天器实际姿态的转换矩阵,其表达式为:C(qe)=C(q)(C(qr))T,其中 记
2.根据权利要求1所述的控制方法,其特征在于:外部扰动包括重力梯度力矩、气动力矩和/或太阳辐射压力矩。
3.根据权利要求1所述的控制方法,其特征在于:所述步骤(1)中,建立时变的转动惯量模型如下:
J(t)=J0+J1Ψ(t)
其中,为转动惯量矩阵中未知的不随时间变化的部分;J1Ψ(t)为转动惯量矩阵中时变的部分,其中m(t)为t时刻剩余的燃料质量;rf为燃料箱与航天器初始质心之间的距离;r(t)为t时刻航天器瞬时质心与航天器初始质心之间的距离;c为体现燃料质量消耗与控制力矩之间关系的参数,是一个正的常数;||u||为控制力矩的范数。
4.根据权利要求1所述的控制方法,其特征在于:所述步骤(2)中设计标称控制器以及相应的自适应律如下:
s=ωe+kqe
其中,s为用于设计控制器所选取的滑模面;k>0为待选取的控制参数;θ=[J011,J022,J033]T为包含转动惯量未知部分J0所有特征参数的向量;为向量θ的估计值;γ为自适应律增益参数,且为正的常数;回归矩阵W满足:Wθ=-S(ω)J0ω+J0φ+kJ0Qωe,其中
控制器中的H定义为H=-S(ω)J1Ψω+J1Ψφ+kJ1ΨQωe,Ω定义为K为控制器增益参数,是正的常数,且满足K>dm;上式中的符号函数sgn(·)定义为
5.根据权利要求1所述的控制方法,其特征在于:所述步骤(3)具体为:
加入执行器故障后的航天器姿态跟踪动力学模型以及设计的辅助控制器如下:
u=DT(unom+uaux)
其中,航天器动力学方程中的W1θ定义为W1θ=-S(ω)J0ω+J0φ,H1定义为H1=-S(ω)J1Ψω+J1Ψφ;D为执行机构分配矩阵,且满足秩为rank(D)=3,使用多于三个的执行器冗余配置的方式,对各个轴向的执行器力矩进行分配;DT为矩阵D的转置;为执行器实际输出的控制力矩,其中,u=[u1,u2,...,un]T为对应的n个执行器的控制力矩信号,且n≥4,E(t)=diag(g1(t),g2(t),...,gn(t))为执行机构失效矩阵,是n×n的对角矩阵,gi(t),i=1,2,...,n为各个执行器的失效因子,且满足0≤gi(t)≤1,这里,如果gi(t)=1表示第i个执行器正常工作,如果0<gi(t)<1表示第i个执行器部分失效,如果gi(t)=0则表示第i个执行器完全失效,为执行器加性故障力矩,其值未知但是有界,且满足其中f0和fm为两个正的常数;uaux为设计的辅助控制器;σmax和σmin定义为矩阵DEDT特征值的上界值与下界值;K*为控制器增益参数,是正的常数,且满足K*≥dm+fm。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711276018.4A CN108153322B (zh) | 2017-12-06 | 2017-12-06 | 一种考虑时变的转动惯量的航天器姿态跟踪自适应容错控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711276018.4A CN108153322B (zh) | 2017-12-06 | 2017-12-06 | 一种考虑时变的转动惯量的航天器姿态跟踪自适应容错控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108153322A CN108153322A (zh) | 2018-06-12 |
CN108153322B true CN108153322B (zh) | 2019-03-29 |
Family
ID=62466085
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711276018.4A Active CN108153322B (zh) | 2017-12-06 | 2017-12-06 | 一种考虑时变的转动惯量的航天器姿态跟踪自适应容错控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108153322B (zh) |
Families Citing this family (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109164819B (zh) * | 2018-08-22 | 2021-09-14 | 哈尔滨工业大学(深圳) | 刚体航天器的反步自适应滑模大角度姿态机动控制方法 |
CN109164822B (zh) * | 2018-09-26 | 2020-02-21 | 北京航空航天大学 | 一种基于具有混合执行机构的航天器姿态控制方法 |
CN109343550B (zh) * | 2018-10-15 | 2020-04-21 | 北京航空航天大学 | 一种基于滚动时域估计的航天器角速度的估计方法 |
CN109669471B (zh) * | 2018-12-17 | 2020-05-12 | 北京理工大学 | 小天体悬停姿轨耦合自抗扰控制方法 |
CN109901394B (zh) * | 2019-03-22 | 2021-03-19 | 北京航空航天大学 | 基于分布式高阶滑模估计器的航天器姿态协同控制方法 |
CN110146082B (zh) * | 2019-05-05 | 2021-03-19 | 中国人民解放军63921部队 | 利用测速数据实时估计航天器异常姿态的方法和设备 |
CN110361975B (zh) * | 2019-08-06 | 2022-04-29 | 大连海事大学 | 一种基于滑模技术的umv状态时滞系统的自适应容错控制方法 |
CN110333661B (zh) * | 2019-08-06 | 2022-04-01 | 大连海事大学 | 一种考虑量化和状态时滞的umv自适应滑模容错控制方法 |
CN111258221B (zh) * | 2020-01-21 | 2022-09-02 | 中国西安卫星测控中心 | 一种基于自适应滑模理论的航天器容错控制方法 |
CN111338368B (zh) * | 2020-03-06 | 2023-10-20 | 上海航天控制技术研究所 | 一种航天器快速机动姿态跟踪自适应鲁棒控制方法 |
CN111413995B (zh) * | 2020-03-24 | 2021-03-05 | 北京科技大学 | 双刚体特征点间相对位置跟踪与姿态同步控制方法及系统 |
CN111812981A (zh) * | 2020-07-02 | 2020-10-23 | 哈尔滨工业大学 | 一种有限时间稳定的航天器姿态跟踪滑模控制方法 |
CN112623275B (zh) * | 2020-12-15 | 2022-07-19 | 中国人民解放军国防科技大学 | 一种快速响应小卫星的自适应容错姿态控制方法及系统 |
CN113220007B (zh) * | 2021-05-14 | 2022-11-18 | 哈尔滨工程大学 | 执行机构故障的挠性航天器有限时间姿态协同控制方法 |
CN113485304B (zh) * | 2021-07-22 | 2022-06-07 | 北京航空航天大学 | 一种基于深度学习故障诊断的飞行器分层容错控制方法 |
CN115139340B (zh) * | 2022-09-01 | 2022-11-18 | 北京科技大学 | 一种失效故障下柔性机器人关节神经网络观测器设计方法 |
CN115685761B (zh) * | 2022-11-10 | 2023-06-30 | 哈尔滨工业大学 | 挠性航天器预设性能姿态控制方法、计算机设备和存储介质 |
CN116923730A (zh) * | 2023-07-24 | 2023-10-24 | 哈尔滨工业大学 | 一种具有自调节预设性能约束的航天器姿态主动容错控制方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105843240A (zh) * | 2016-04-08 | 2016-08-10 | 北京航空航天大学 | 一种考虑执行器故障的航天器姿态积分滑模容错控制方法 |
CN105867401A (zh) * | 2016-04-28 | 2016-08-17 | 北京航空航天大学 | 单框架控制力矩陀螺群的航天器姿态容错控制方法 |
-
2017
- 2017-12-06 CN CN201711276018.4A patent/CN108153322B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105843240A (zh) * | 2016-04-08 | 2016-08-10 | 北京航空航天大学 | 一种考虑执行器故障的航天器姿态积分滑模容错控制方法 |
CN105867401A (zh) * | 2016-04-28 | 2016-08-17 | 北京航空航天大学 | 单框架控制力矩陀螺群的航天器姿态容错控制方法 |
Non-Patent Citations (1)
Title |
---|
袁国平.航天器姿态系统的自适应鲁棒控制.《中国博士学位论文全文数据库•工程科技Ⅱ辑》.2014, |
Also Published As
Publication number | Publication date |
---|---|
CN108153322A (zh) | 2018-06-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108153322B (zh) | 一种考虑时变的转动惯量的航天器姿态跟踪自适应容错控制方法 | |
CN107121961B (zh) | 一种基于迭代学习干扰观测器的航天器姿态容错控制方法 | |
Xiao et al. | Finite-time attitude tracking of spacecraft with fault-tolerant capability | |
CN106292681B (zh) | 一种基于观测器和在线控制分配的卫星主动容错控制方法 | |
Xiao et al. | Attitude stabilization of spacecrafts under actuator saturation and partial loss of control effectiveness | |
CN108287476B (zh) | 基于高阶滑模控制和扰动观测器的空间翻滚非合作目标自主交会制导方法 | |
Xiao et al. | Fault-tolerant tracking control of spacecraft with attitude-only measurement under actuator failures | |
CN105843240B (zh) | 一种考虑执行器故障的航天器姿态积分滑模容错控制方法 | |
CN105867401B (zh) | 单框架控制力矩陀螺群的航天器姿态容错控制方法 | |
Xiao et al. | Attitude tracking control of rigid spacecraft with actuator misalignment and fault | |
Li et al. | Fault-tolerant attitude stabilization incorporating closed-loop control allocation under actuator failure | |
Qinglei et al. | Adaptive integral-type sliding mode control for spacecraft attitude maneuvering under actuator stuck failures | |
Zhu et al. | Satellite attitude stabilization control with actuator faults | |
Zhang et al. | Extended-state-observer-based event-triggered orbit-attitude tracking for low-thrust spacecraft | |
Fonod et al. | Robust FDI for fault-tolerant thrust allocation with application to spacecraft rendezvous | |
Hu et al. | Attitude control of spacecraft with actuator uncertainty | |
CN108181807B (zh) | 一种卫星初态阶段自适应容错姿态控制方法 | |
CN109765920A (zh) | 集成故障观测器和控制分配策略的航天器姿态容错的控制方法 | |
CN109164822B (zh) | 一种基于具有混合执行机构的航天器姿态控制方法 | |
CN103676918B (zh) | 一种基于未知输入观测器的卫星执行机构故障诊断方法 | |
Kumar et al. | A novel single thruster control strategy for spacecraft attitude stabilization | |
Wang et al. | Fault‐tolerant spacecraft attitude control under actuator saturation and without angular velocity | |
Wang et al. | Adaptive non-singular integral terminal sliding mode-based fault tolerant control for autonomous underwater vehicles | |
Li et al. | Observer-based robust actuator fault isolation and identification for microsatellite attitude control systems | |
CN113220007A (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 |