CN107121961A - 一种基于迭代学习干扰观测器的航天器姿态容错控制方法 - Google Patents
一种基于迭代学习干扰观测器的航天器姿态容错控制方法 Download PDFInfo
- Publication number
- CN107121961A CN107121961A CN201710379752.7A CN201710379752A CN107121961A CN 107121961 A CN107121961 A CN 107121961A CN 201710379752 A CN201710379752 A CN 201710379752A CN 107121961 A CN107121961 A CN 107121961A
- Authority
- CN
- China
- Prior art keywords
- mrow
- spacecraft
- actuator
- mover
- disturbance
- 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
- 238000000034 method Methods 0.000 title claims abstract description 36
- 201000003723 learning disability Diseases 0.000 claims description 31
- 239000011159 matrix material Substances 0.000 claims description 28
- 238000009434 installation Methods 0.000 claims description 12
- 238000004364 calculation method Methods 0.000 claims description 4
- 230000005484 gravity Effects 0.000 claims description 4
- 230000005855 radiation Effects 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 239000000758 substrate Substances 0.000 claims 1
- 238000013461 design Methods 0.000 abstract description 6
- 230000000694 effects Effects 0.000 description 3
- 230000006870 function Effects 0.000 description 3
- 238000004458 analytical method Methods 0.000 description 2
- 230000001174 ascending effect Effects 0.000 description 2
- 238000012937 correction Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000003044 adaptive effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000003745 diagnosis Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
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
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/04—Programme control other than numerical control, i.e. in sequence controllers or logic controllers
- G05B19/048—Monitoring; Safety
-
- 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)
- Automation & Control Theory (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (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
技术领域
本发明涉及一种基于迭代学习干扰观测器的航天器姿态容错控制方法,主要应用于航天器在进行空间任务时遇到执行器故障且受到外部扰动影响时的姿态控制系统。
背景技术
“十三五”是中国航天发展的战略机遇期,到2020年左右,我国将完成载人航天、探月工程、北斗导航、高分辨率对地观测系统等现有的重大科技专项;2025年前后,将全面建成国家民用空间基础设施,推动空间信息应用规模化、业务化、产业化发展;2030年实现整体跃升,跻身航天强国之列,以航天梦助力中国梦。姿态控制系统作为航天器重要分系统之一,它的可靠性、是否正常工作将直接决定航天器能否正常完成既定航天任务。根据统计数据可知,姿态控制系统中约44%的故障是由飞轮、控制力矩陀螺以及包括离子推进系统在内的执行器失效故障所造成的,这类执行器故障将会导致航天器全部或者部分丧失对系统的控制能力,如果不能及时、正确地被检测、定位、隔离并进行相应容错处理,则姿态控制性能将显著下降或系统稳定性将受到破坏,严重时将导致整个航天任务失败;考虑到反作用飞轮制造与装配过程中机械精度、物理工艺技术的约束,以及环境干扰力矩的影响,其安装构型往往与标称构型存在一定的偏差,即存在安装偏差问题;因此,提供航天器在轨自主处理相应的执行器故障方法便显得尤为重要;此外,航天器会受到来自空间的各种扰动力矩的影响,如重力梯度力矩、气动力矩、太阳辐射压力矩和剩磁力矩,在一定程度上会影响控制性能;因此,考虑到这些问题,提高航天器姿态控制系统的容错能力和鲁棒性同时保证比较满意的控制精度和控制要求是航天器姿态控制系统的重点和难点。
针对上述问题,国内外已有相关方法用于实现航天器姿态控制系统的容错控制。专利CN201210242175.4用随机切换系统模型描述带有间歇性故障的航天器姿控系统的运行全过程,进而将姿控系统的容错分析问题转化为带有不稳定模态的切换系统的稳定性分析问题,但这种方法属于被动容错控制,因此控制器在处理不同情况的故障时,对于当前故障难以达到最佳的控制性能,并且当未知的故障出现时,也谈不上系统的闭环稳定和优秀的系统性能;因此,相关研究人员提出主动容错控制方法,用于在线实时对故障进行诊断,隔离和重新配置,能够在达到控制性能的同时满足鲁棒性和容错能力;专利CN201510232385.9设计了一类三轴力矩有效性故障因子观测器,得到有效的执行器故障因子估计值,以此设计鲁棒自适应容错控制器,以实现当执行器出现故障下的航天器机动控制,但是,这种方法仅能处理执行器部分失效故障,而没有考虑执行器的安装偏差和外部扰动的影响;因此,现有的航天器容错控制方法存在难以有效估计执行器故障信息,且较少考虑执行器安装偏差和航天器受到外部扰动的情况。
发明内容
本发明的技术解决问题是:由于实际航天任务中,航天器姿态控制系统的执行器可能发生故障,存在安装偏差且同时受到外部扰动影响的问题,本发明提供一种基于迭代学习干扰观测器的航天器姿态容错控制方法,通过设计迭代学习观测器估计由执行器故障信息和外部扰动组成的广义干扰,由此设计一类主动容错控制器;解决了航天器实际在轨运行过程中存在执行器故障及其安装偏差,且航天器受到外部扰动影响的问题,保证了整个航天器姿态控制系统的容错能力和对外部扰动的鲁棒性。
本发明的技术解决方案为:本发明涉及一种基于迭代学习干扰观测器的航天器姿态容错控制方法,针对航天器在轨工作进行姿态控制的过程中存在执行器故障与外部扰动的问题,提出一种基于迭代学习观测器的主动容错控制方法;本发明包括以下步骤:首先,考虑航天器姿态控制系统中的执行器存在故障和航天器受到空间中的外部扰动影响,建立航天器姿态控制系统动力学模型;然后,设计迭代学习干扰观测器估计由执行器故障信息和外部扰动组成的广义干扰力矩;最后,基于估计出的广义干扰设计主动容错控制器;该方法保证了当航天器的执行器发生故障及存在外部扰动时姿态控制系统的稳定性,满足实际控制系统精度要求,具有较强的容错能力及对外部扰动的鲁棒性等优点。
具体实现步骤如下:
第一步,建立航天器姿态控制系统模型的运动学方程为:
其中,表示航天器的姿态单位四元数中的标量部分,与绕欧拉轴旋转的角度有关,θ表示绕着欧拉轴转过的一个角度,qv=[q1,q2,q3]T为含有三个元素的列向量,与欧拉轴方向有关,ex,ey,ez代表欧拉轴三个方向上的旋转轴,且满足单位化约束条件q0 2+qv Tqv=1;表示航天器在本体坐标系下相对惯性坐标系的姿态角速度向量,ω1,ω2,ω3分别为航天器关于本体系中的横滚轴、偏航轴和俯仰轴上的角速度分量;I3×3是3×3的单位矩阵;
考虑到执行器出现故障的情景,特别是当执行器损失全部或者部分动力时,考虑到其故障时的独立性,可以将航天器姿态控制系统模型的动力学方程写成下面的形式:
其中,J是航天器总的惯量矩阵,且是3×3的对称矩阵;表示航天器角加速度矢量;表示执行器实际提供的作用在航天器本体轴上的控制力矩,表示航天器所受来自空间环境的外部扰动,如重力梯度力矩、气动力矩、太阳辐射压力矩和剩磁力矩,虽然其值未知但是有界,可以表示为||d||≤dmax,dmax定义为外部扰动的上界值;S(ω)是斜对称矩阵,其形式为
为了提高航天器姿态控制系统的容错能力,使用多于三个的执行器冗余配置的方式,并针对执行器发生失效故障和安装偏差的情况,航天器的执行器所提供的实际输出力矩表示如下:
其中,是执行器分配矩阵,且其秩为rank(D0)=3,其用来将航天器上搭载的各个执行器提供的力矩分配到关于航天器本体轴的三个方向上,表示执行器的安装偏差矩阵;表示m个执行器的健康状况矩阵,称为执行器的失效矩阵,元素ei(t),i=1,2,...,m为各个执行器的失效因子,且满足0≤ei(t)≤1,用来表征执行器效能的大小,这里,如果ei(t)=1则表示第i个执行器正常工作,如果0<ei(t)<1则表示第i个执行器损失了部分效能,如果ei(t)=0则表示第i个执行器完全失效;uc为通过设计出的主动容错控制器得到的控制信号,τf表示由于执行器失效故障导致损失的那部分输出力矩;
将上式代入航天器姿态控制系统模型的动力学方程,因此后者可以写成下面的形式:
将上式中最后三项统一写成一个广义干扰uf=(D0+△D)τf+△Duc+d,则航天器姿态控制系统模型的动力学方程可以重新改写为:
第二步,基于第一步建立的航天器姿态控制系统模型,设计一类迭代学习干扰观测器为:
其中,T是迭代学习干扰观测器的更新时间,这里可以选取为系统的采样时间,t表示当前时刻;和v(t)分别定义为用上式迭代学习干扰观测器得到的t时刻的航天器角速度估计值和广义干扰的估计值,ω(t-T),和v(t-T)分别表示t-T时刻的航天器角速度,角速度估计值和广义干扰的估计值;λ是一个正的标量参数,和都是观测器增益正定矩阵,且需要选取观测器增益L使得L的最小特征值Lmin满足Lmin-dmax≥0,即Lmin≥dmax;此迭代学习干扰观测器的特点在于广义干扰的估计值v(t)是与其前一时刻的信息v(t-T)有关,而不需进行微分运算,提高了计算效率;对于任意一个向量x=[x1,x2,x3]T,x1,x2,x3分别为向量中的三个元素,则sgn(x)定义如下:
sgn(x)=[sign(x1),sign(x2),sign(x3)]T
这里,对于一个任意的标量变量p,定义sign(p)为:
第三步,根据第二步给出的迭代学习干扰观测器,设计一类主动容错控制器为:
u=D0 T(D0D0 T)-1[-kpqv-kdω-v(t)]
其中,D0 T为执行器分配矩阵的转置,D0 T(D0D0 T)-1表示关于D0的伪逆矩阵,kp和kd分别为控制器参数,其均为正的标量常数;
利用上面给出的主动容错控制器,可以保证在发生部分失效甚至在完全失效的特殊情况下,整个航天器姿态控制系统实现闭环稳定。
如图1所示,为本发明所述的基于迭代学习干扰观测器的航天器姿态容错控制原理框图,针对上述提出的基于迭代学习干扰观测器的航天器姿态容错控制系统需要由迭代学习干扰观测器、主动容错控制器、航天器动力学模型、航天器运动学模型几部分组成。当在轨工作的航天器出现执行器失效故障及安装偏差且受到外部扰动影响时,利用迭代学习干扰观测器计算出广义干扰估计值,同时,将航天器的姿态和角速度信息与广义干扰估计值引入到主动容错控制器中得到控制信号,并将控制信号传输到执行器以提供实际的控制力矩作用于航天器实现航天器姿态控制;这里,航天器同时受到外部扰动的影响,航天器动力学和运动学模型代表此航天器姿态控制系统的作用对象,动力学模型输出航天器角速度并可被陀螺仪测得,运动学模型输出航天器姿态可被姿态敏感器测得。
本发明设计的基于迭代学习干扰观测器的航天器姿态容错控制方法与现有技术相比的优点在于:
(1)与传统的故障诊断观测器或干扰观测器相比,可以同时估计出由于部分失效故障,安装偏差和外部扰动组成的广义干扰,并引入到主动容错控制器中,具有较好的容错能力和鲁棒性;
(2)与已有的迭代学习观测器相比,本发明中迭代学习干扰观测器的设计引入了符号函数和前一时刻的角速度修正项,符号函数的引入可以提高星载计算机的计算效率,减少内存占用空间,而前一时刻的角速度修正项可以减小由于符号函数的引入而导致的估计误差,提高估计精度。
附图说明
图1为基于迭代学习干扰观测器的航天器姿态容错控制原理框图;
图2为本发明的一种基于迭代学习干扰观测器的航天器姿态容错控制方法流程框图。
具体实施方式
如图2所示,本发明的一种基于迭代学习干扰观测器的航天器姿态容错控制方法步骤为:首先建立考虑执行器故障和外部扰动的航天器姿态控制系统模型;然后基于航天器姿态控制系统模型设计迭代学习干扰观测器对广义干扰进行在线估计;最后,进行主动容错控制器设计;具体实施步骤如下:
第一步,建立航天器姿态控制系统模型的运动学方程为:
其中,表示航天器的姿态单位四元数中的标量部分,与绕欧拉轴旋转的角度有关,θ表示绕着欧拉轴转过的一个角度,qv=[q1,q2,q3]T为含有三个元素的列向量,与欧拉轴方向有关,ex,ey,ez代表欧拉轴三个方向上的旋转轴,且满足单位化约束条件q0 2+qv Tqv=1,用姿态四元数表示的姿态初值选取为q(0)=[0.85 0.25 -0.3 0.35]T;表示航天器在本体坐标系下相对惯性坐标系的姿态角速度向量,ω1,ω2,ω3分别为航天器关于本体系中的横滚轴、偏航轴和俯仰轴上的角速度分量,角速度初值可选为ω(0)=[0,0,0]T rad/s;I3×3是3×3的单位矩阵;
考虑到执行器出现故障的情景,特别是当执行器损失全部或者部分动力时,考虑到其故障时的独立性,可以将航天器姿态控制系统模型的动力学方程写成下面的形式:
其中,J是航天器总的惯量矩阵,且是3×3的对称矩阵,根据实际工程中的航天器设计参数,J可选取为J=[20 0 0.9;0 17 0;0.9 0 15]kg·m2;表示航天器角加速度矢量;表示执行器实际提供的作用在航天器本体轴上的控制力矩,表示航天器所受来自空间环境的外部扰动,如重力梯度力矩、气动力矩、太阳辐射压力矩和剩磁力矩,虽然其值未知但是有界,可以表示为||d||≤dmax,dmax定义为外部扰动的上界值,这里可取S(ω)是斜对称矩阵,其形式为
为了提高航天器姿态控制系统的容错能力,使用多于三个的执行器冗余配置的方式,并针对执行器发生失效故障和安装偏差的情况,航天器执行器所提供的实际输出力矩表示如下:
其中,是执行器分配矩阵,且其秩为rank(D0)=3,其用来将航天器上搭载的各个执行器提供的力矩分配到关于航天器本体轴的三个方向上,表示执行器的安装偏差矩阵;表示m个执行器的健康状况矩阵,称为执行器的失效矩阵,元素ei(t),i=1,2,...,m为各个执行器的失效因子,且满足0≤ei(t)≤1,用来表征执行器效能的大小,这里,如果ei(t)=1则表示第i个执行器正常工作,如果0<ei(t)<1则表示第i个执行器损失了部分效能,如果ei(t)=0则表示第i个执行器完全失效,这里利用飞轮作为执行器提供实际控制力矩,并采用三个飞轮轴向正交与另一个飞轮轴向斜交安装的四飞轮配置方法,因此整个系统中满足m=4,考虑飞轮工作时可能出现的实际故障情况,将其表示为:e3(t)=0.85+0.07sin(0.2t);0≤t≤300s,uc为通过设计出的主动容错控制器得到的控制信号,τf表示由于执行器失效故障导致损失的那部分输出力矩;
将上式代入航天器姿态控制系统模型的动力学方程,因此后者可以写成下面的形式:
将上式中最后三项统一写成一个广义干扰uf=(D0+△D)τf+△Duc+d,则航天器姿态控制系统模型的动力学方程可以重新改写为:
第二步,基于第一步建立的航天器姿态控制系统模型,设计一类迭代学习干扰观测器为:
其中,T是迭代学习干扰观测器的更新时间,这里可以选取为系统的采样时间,t表示当前时刻;和v(t)分别定义为用上式迭代学习干扰观测器得到的t时刻的航天器角速度估计值和广义干扰的估计值,ω(t-T),和v(t-T)分别表示t-T时刻的航天器角速度,角速度估计值和广义干扰的估计值;角速度估计值和广义干扰估计值的初始值选取为v(0)=[0 0 0]T;λ是一个正的标量常数,和都是观测器增益正定矩阵,且需要选取观测器增益L使得L的最小特征值Lmin满足Lmin-dmax≥0,即Lmin≥dmax,为了取得较好的观测效果,通过调参,可以分别选择其值为L=[0.005,0,0;0,0.005,0;0,0,0.005],λ=30,K1=[1,0,0;0,1,0;0,0,1],K2=[0.0005,0,0;0.001,0;0,0,0.001],K3=[0.0003,0,0;0,0.0006,0;0,0,0.0006];此迭代学习干扰观测器的特点在于广义干扰的估计值v(t)是与其前一时刻的信息v(t-T)有关,而不需进行微分运算,提高了计算效率;对于任意一个向量x=[x1,x2,x3]T,x1,x2,x3分别为向量中的三个元素,则sgn(x)定义如下:
sgn(x)=[sign(x1),sign(x2),sign(x3)]T
这里,对于一个任意的标量变量p,定义sign(p)为
第三步,根据第二步给出的迭代学习干扰观测器,设计一类主动容错控制器为:
u=D0 T(D0D0 T)-1[-kpqv-kdω-v(t)]
其中,D0 T为执行器分配矩阵的转置,D0 T(D0D0 T)-1表示关于D0的伪逆矩阵,kp和kd分别为控制器参数,其均为正的标量常数,这里通过在仿真实验中不断调整参数,选取kp=1.2,kv=18为控制器参数的优选值;
利用上面给出的主动容错控制器,可以保证在发生部分失效甚至在完全失效的特殊情况下,整个航天器姿态控制系统仍然保证闭环稳定;
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
Claims (4)
1.一种基于迭代学习干扰观测器的航天器姿态容错控制方法,其特征在于包括以下步骤:
(1)对于航天器姿态控制系统,由执行器对航天器提供有效力矩,但同时需考虑航天器的执行器存在失效故障和安装偏差,以及含有外部扰动力矩对航天器姿态控制性能的影响,基于航天器姿态动力学及运动学方程,建立航天器姿态控制系统动力学模型;
(2)基于第一步建立的航天器姿态控制系统动力学模型,设计迭代学习观测器,以此估计由执行器故障信息和外部扰动组成的广义干扰;
(3)在第二步的基础上,对于第一步中给出的航天器姿态控制系统动力学模型,引入第二步所得的广义干扰估计值,设计主动容错控制器。
2.根据权利要求1所述的基于迭代学习干扰观测器的航天器姿态容错控制方法,建立步骤(1)中航天器姿态控制系统模型的动力学方程为:
<mrow>
<mi>J</mi>
<mover>
<mi>&omega;</mi>
<mo>.</mo>
</mover>
<mo>=</mo>
<mo>-</mo>
<mi>S</mi>
<mrow>
<mo>(</mo>
<mi>&omega;</mi>
<mo>)</mo>
</mrow>
<mi>J&omega;</mi>
<mo>+</mo>
<msub>
<mi>D</mi>
<mn>0</mn>
</msub>
<msub>
<mi>u</mi>
<mi>c</mi>
</msub>
<mo>+</mo>
<msub>
<mi>u</mi>
<mi>f</mi>
</msub>
</mrow>
其中,表示航天器在本体坐标系下相对惯性坐标系的姿态角速度向量,ω1,ω2,ω3分别为航天器关于本体系中的横滚轴、偏航轴和俯仰轴上的角速度分量;J是航天器总的惯量矩阵,且是3×3的对称矩阵;表示航天器角加速度矢量;为了提高航天器姿态控制系统的容错能力,使用多于三个的执行器冗余配置的方式,是执行器分配矩阵且其秩为rank(D0)=3,;uc为通过设计出的主动容错控制器得到的控制信号;由执行器失效故障、安装偏差和外部扰动组成的广义干扰可以定义为uf=(D0+△D)τf+△Duc+d,这里,表示执行器的安装偏差矩阵;表示航天器所受来自空间环境的外部扰动,包括重力梯度力矩、气动力矩、太阳辐射压力矩和剩磁力矩,虽然其值未知但是有界,表示为||d||≤dmax,dmax定义为外部扰动的上界值;τf表示由于执行器失效故障导致损失的那部分输出力矩,其形式为τf=(E(t)-Im×m)uc,这里,表示m个执行器的健康状况矩阵,称为执行器的失效矩阵,元素ei(t),i=1,2,...,m为各个执行器的失效因子,且满足0≤ei(t)≤1,用来表征执行器效能的大小,如果ei(t)=1则表示第i个执行器正常工作,如果0<ei(t)<1则表示第i个执行器损失了部分效能,如果ei(t)=0则表示第i个执行器完全失效;Im×m是m×m的单位矩阵。
3.根据权利要求1所述的基于迭代学习干扰观测器的航天器姿态容错控制方法,其特征在于:所述步骤(2)中,迭代学习干扰观测器设计为:
<mfenced open = "" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>J</mi>
<mover>
<mover>
<mi>&omega;</mi>
<mo>^</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mo>-</mo>
<mover>
<mi>&omega;</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>&times;</mo>
<mi>J</mi>
<mover>
<mi>&omega;</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>&lambda;</mi>
<mrow>
<mo>(</mo>
<mi>&omega;</mi>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>-</mo>
<mover>
<mi>&omega;</mi>
<mo>^</mo>
</mover>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>D</mi>
<mn>0</mn>
</msub>
<msub>
<mi>u</mi>
<mi>c</mi>
</msub>
<mo>+</mo>
<mi>v</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>L</mi>
<mi> </mi>
<mi>sgn</mi>
<mo>&lsqb;</mo>
<mi>&omega;</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mover>
<mi>&omega;</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>v</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>K</mi>
<mn>1</mn>
</msub>
<mi>v</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>-</mo>
<mi>T</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>K</mi>
<mn>2</mn>
</msub>
<mi>sgn</mi>
<mo>&lsqb;</mo>
<mi>&omega;</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mover>
<mi>&omega;</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<mo>+</mo>
<msub>
<mi>K</mi>
<mn>3</mn>
</msub>
<mi>sgn</mi>
<mo>&lsqb;</mo>
<mi>&omega;</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>-</mo>
<mi>T</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mover>
<mi>&omega;</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>-</mo>
<mi>T</mi>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
其中,T是迭代学习干扰观测器的更新时间,可以选取为系统的采样时间,t表示当前时刻;和v(t)分别定义为用上式迭代学习干扰观测器得到的t时刻的航天器角速度估计值和广义干扰的估计值,ω(t-T),和v(t-T)分别表示t-T时刻的航天器角速度,角速度估计值和广义干扰的估计值;λ是一个正的标量常数,和都是观测器增益正定矩阵;是执行器分配矩阵且其秩为rank(D0)=3;uc为通过设计出的主动容错控制器得到的控制信号;对于任意一个向量x=[x1,x2,x3]T,x1,x2,x3分别为向量中的三个元素,则sgn(x)如下:
sgn(x)=[sign(x1),sign(x2),sign(x3)]T
这里,对于一个任意的标量变量p,定义sign(p)为:
<mrow>
<mi>s</mi>
<mi>i</mi>
<mi>g</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>p</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mrow>
<mi>p</mi>
<mo>></mo>
<mn>0</mn>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>p</mi>
<mo>=</mo>
<mn>0</mn>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>p</mi>
<mo><</mo>
<mn>0</mn>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
此迭代学习干扰观测器的特点在于广义干扰的估计值v(t)是与其前一时刻的信息v(t-T)有关,而不需进行微分运算,提高了计算效率。
4.根据权利要求1所述的基于迭代学习干扰观测器的航天器姿态容错控制方法,其特征在于:所述步骤(3)中主动容错控制器为:
u=D0 T(D0D0 T)-1[-kpqv-kdω-v(t)]
其中,是执行器分配矩阵且其秩为rank(D0)=3;D0 T(D0D0 T)-1表示关于D0的伪逆矩阵,kp和kd分别为控制器参数,其均为正的常数;qv=[q1,q2,q3]T表示姿态四元数的矢量部分,其为含有三个元素的列向量,与欧拉轴方向有关, ex,ey,ez代表欧拉轴三个方向上的旋转轴;表示航天器在本体坐标系下相对惯性坐标系的姿态角速度向量,ω1,ω2,ω3分别为航天器关于本体系中的横滚轴、偏航轴和俯仰轴上的角速度分量;v(t)为用迭代学习干扰观测器得出的t时刻的广义干扰的估计值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710379752.7A CN107121961B (zh) | 2017-05-25 | 2017-05-25 | 一种基于迭代学习干扰观测器的航天器姿态容错控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710379752.7A CN107121961B (zh) | 2017-05-25 | 2017-05-25 | 一种基于迭代学习干扰观测器的航天器姿态容错控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107121961A true CN107121961A (zh) | 2017-09-01 |
CN107121961B CN107121961B (zh) | 2018-05-15 |
Family
ID=59729380
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710379752.7A Active CN107121961B (zh) | 2017-05-25 | 2017-05-25 | 一种基于迭代学习干扰观测器的航天器姿态容错控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107121961B (zh) |
Cited By (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108363840A (zh) * | 2018-01-23 | 2018-08-03 | 中国人民解放军战略支援部队航天工程大学 | 一种基于电磁力的集群航天器磁矩最优分配方法 |
CN108710293A (zh) * | 2018-04-09 | 2018-10-26 | 无锡职业技术学院 | 一种直流调速系统的容错迭代学习控制方法 |
CN109116737A (zh) * | 2018-09-19 | 2019-01-01 | 南京航空航天大学 | 基于观测器的多智能体系统故障上限评估以及容错一致性控制算法 |
CN109597403A (zh) * | 2018-12-14 | 2019-04-09 | 江南大学 | 基于迭代学习滤波器的机电控制系统故障诊断方法 |
CN109765920A (zh) * | 2019-03-04 | 2019-05-17 | 北京航空航天大学 | 集成故障观测器和控制分配策略的航天器姿态容错的控制方法 |
CN109991857A (zh) * | 2019-05-07 | 2019-07-09 | 中国民航大学 | 基于pd型学习观测器的故障重构方法 |
CN110086393A (zh) * | 2019-05-27 | 2019-08-02 | 东北大学 | 一种永磁同步电机(pmsm)转速脉动和转矩脉动抑制系统 |
CN110531737A (zh) * | 2019-08-28 | 2019-12-03 | 北京空间飞行器总体设计部 | 基于混合模型的卫星执行机构故障诊断方法、系统及介质 |
CN110703602A (zh) * | 2019-10-22 | 2020-01-17 | 西北工业大学深圳研究院 | 一种多机器人在轨装配姿态稳定的鲁棒微分博弈控制方法 |
CN111240297A (zh) * | 2018-11-28 | 2020-06-05 | 中国科学院沈阳自动化研究所 | 基于Kalman滤波器的航天器姿控系统故障诊断方法 |
CN111610779A (zh) * | 2020-07-02 | 2020-09-01 | 青岛科技大学 | 一种数据驱动的非线性系统执行器故障因子的辨识技术 |
CN112068434A (zh) * | 2020-09-09 | 2020-12-11 | 北京航空航天大学 | 基于扩展状态观测器的康复机械装置迭代学习控制方法 |
CN112256048A (zh) * | 2020-10-13 | 2021-01-22 | 北京航空航天大学 | 一种混合灵敏度优化的cmg框架系统速度调节方法 |
CN112835373A (zh) * | 2020-12-30 | 2021-05-25 | 中国航天空气动力技术研究院 | 在线建模及预测控制一体化方法及装置 |
CN113341733A (zh) * | 2021-06-29 | 2021-09-03 | 哈尔滨工业大学 | 直线电机系统故障与未知扰动补偿方法 |
CN113859588A (zh) * | 2021-09-30 | 2021-12-31 | 西北工业大学 | 一种航天器姿态/故障/干扰协同观测与容错抗干扰控制方法 |
CN114389257A (zh) * | 2021-12-29 | 2022-04-22 | 杭州电子科技大学 | 基于故障分布的单区域电力系统的容错负载频率控制器 |
CN114879512A (zh) * | 2022-07-06 | 2022-08-09 | 南京航空航天大学 | 基于学习神经网络滑模的航天器编队轨道容错控制方法 |
CN114879515A (zh) * | 2022-07-12 | 2022-08-09 | 南京航空航天大学 | 基于学习神经网络的航天器姿态重构容错控制方法 |
CN116923730A (zh) * | 2023-07-24 | 2023-10-24 | 哈尔滨工业大学 | 一种具有自调节预设性能约束的航天器姿态主动容错控制方法 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5335179A (en) * | 1992-12-24 | 1994-08-02 | General Electric Co. | Unified spacecraft attitude control system with pseudo-complementary paired thrusters |
US6702234B1 (en) * | 2002-03-29 | 2004-03-09 | Lockheed Martin Corporation | Fault tolerant attitude control system for zero momentum spacecraft |
CN103116357A (zh) * | 2013-03-14 | 2013-05-22 | 郭雷 | 一种具有抗干扰容错性能的滑模控制方法 |
CN104880948A (zh) * | 2015-05-08 | 2015-09-02 | 北京航空航天大学 | 一种基于鲁棒自适应的带有飞轮的航天器容错控制方法 |
CN104898686A (zh) * | 2015-06-02 | 2015-09-09 | 北京航空航天大学 | 一种基于反作用轮摩擦特性的抗干扰姿态控制方法 |
CN105607485A (zh) * | 2016-02-04 | 2016-05-25 | 河北科技师范学院 | 基于故障特征模型的挠性充液卫星姿态自适应容错控制方法 |
CN105843240A (zh) * | 2016-04-08 | 2016-08-10 | 北京航空航天大学 | 一种考虑执行器故障的航天器姿态积分滑模容错控制方法 |
CN105867401A (zh) * | 2016-04-28 | 2016-08-17 | 北京航空航天大学 | 单框架控制力矩陀螺群的航天器姿态容错控制方法 |
CN106292681A (zh) * | 2016-09-19 | 2017-01-04 | 北京航空航天大学 | 一种基于观测器和在线控制分配的卫星主动容错控制方法 |
-
2017
- 2017-05-25 CN CN201710379752.7A patent/CN107121961B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5335179A (en) * | 1992-12-24 | 1994-08-02 | General Electric Co. | Unified spacecraft attitude control system with pseudo-complementary paired thrusters |
US6702234B1 (en) * | 2002-03-29 | 2004-03-09 | Lockheed Martin Corporation | Fault tolerant attitude control system for zero momentum spacecraft |
CN103116357A (zh) * | 2013-03-14 | 2013-05-22 | 郭雷 | 一种具有抗干扰容错性能的滑模控制方法 |
CN104880948A (zh) * | 2015-05-08 | 2015-09-02 | 北京航空航天大学 | 一种基于鲁棒自适应的带有飞轮的航天器容错控制方法 |
CN104898686A (zh) * | 2015-06-02 | 2015-09-09 | 北京航空航天大学 | 一种基于反作用轮摩擦特性的抗干扰姿态控制方法 |
CN105607485A (zh) * | 2016-02-04 | 2016-05-25 | 河北科技师范学院 | 基于故障特征模型的挠性充液卫星姿态自适应容错控制方法 |
CN105843240A (zh) * | 2016-04-08 | 2016-08-10 | 北京航空航天大学 | 一种考虑执行器故障的航天器姿态积分滑模容错控制方法 |
CN105867401A (zh) * | 2016-04-28 | 2016-08-17 | 北京航空航天大学 | 单框架控制力矩陀螺群的航天器姿态容错控制方法 |
CN106292681A (zh) * | 2016-09-19 | 2017-01-04 | 北京航空航天大学 | 一种基于观测器和在线控制分配的卫星主动容错控制方法 |
Cited By (28)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108363840A (zh) * | 2018-01-23 | 2018-08-03 | 中国人民解放军战略支援部队航天工程大学 | 一种基于电磁力的集群航天器磁矩最优分配方法 |
CN108710293A (zh) * | 2018-04-09 | 2018-10-26 | 无锡职业技术学院 | 一种直流调速系统的容错迭代学习控制方法 |
CN109116737B (zh) * | 2018-09-19 | 2021-04-06 | 南京航空航天大学 | 观测器下的多智能体系统故障评估及容错一致性控制算法 |
CN109116737A (zh) * | 2018-09-19 | 2019-01-01 | 南京航空航天大学 | 基于观测器的多智能体系统故障上限评估以及容错一致性控制算法 |
CN111240297A (zh) * | 2018-11-28 | 2020-06-05 | 中国科学院沈阳自动化研究所 | 基于Kalman滤波器的航天器姿控系统故障诊断方法 |
CN109597403A (zh) * | 2018-12-14 | 2019-04-09 | 江南大学 | 基于迭代学习滤波器的机电控制系统故障诊断方法 |
CN109765920A (zh) * | 2019-03-04 | 2019-05-17 | 北京航空航天大学 | 集成故障观测器和控制分配策略的航天器姿态容错的控制方法 |
CN109765920B (zh) * | 2019-03-04 | 2021-08-06 | 北京航空航天大学 | 集成故障观测器和控制分配策略的航天器姿态容错的控制方法 |
CN109991857A (zh) * | 2019-05-07 | 2019-07-09 | 中国民航大学 | 基于pd型学习观测器的故障重构方法 |
CN110086393A (zh) * | 2019-05-27 | 2019-08-02 | 东北大学 | 一种永磁同步电机(pmsm)转速脉动和转矩脉动抑制系统 |
CN110531737A (zh) * | 2019-08-28 | 2019-12-03 | 北京空间飞行器总体设计部 | 基于混合模型的卫星执行机构故障诊断方法、系统及介质 |
CN110703602A (zh) * | 2019-10-22 | 2020-01-17 | 西北工业大学深圳研究院 | 一种多机器人在轨装配姿态稳定的鲁棒微分博弈控制方法 |
CN111610779A (zh) * | 2020-07-02 | 2020-09-01 | 青岛科技大学 | 一种数据驱动的非线性系统执行器故障因子的辨识技术 |
CN112068434A (zh) * | 2020-09-09 | 2020-12-11 | 北京航空航天大学 | 基于扩展状态观测器的康复机械装置迭代学习控制方法 |
CN112256048A (zh) * | 2020-10-13 | 2021-01-22 | 北京航空航天大学 | 一种混合灵敏度优化的cmg框架系统速度调节方法 |
CN112256048B (zh) * | 2020-10-13 | 2022-02-11 | 北京航空航天大学 | 一种混合灵敏度优化的cmg框架系统速度调节方法 |
CN112835373A (zh) * | 2020-12-30 | 2021-05-25 | 中国航天空气动力技术研究院 | 在线建模及预测控制一体化方法及装置 |
CN112835373B (zh) * | 2020-12-30 | 2023-05-26 | 中国航天空气动力技术研究院 | 在线建模及预测控制一体化方法及装置 |
CN113341733A (zh) * | 2021-06-29 | 2021-09-03 | 哈尔滨工业大学 | 直线电机系统故障与未知扰动补偿方法 |
CN113341733B (zh) * | 2021-06-29 | 2022-02-22 | 哈尔滨工业大学 | 直线电机系统故障与未知扰动补偿方法 |
CN113859588A (zh) * | 2021-09-30 | 2021-12-31 | 西北工业大学 | 一种航天器姿态/故障/干扰协同观测与容错抗干扰控制方法 |
CN113859588B (zh) * | 2021-09-30 | 2023-07-25 | 西北工业大学 | 一种航天器协同观测与容错抗干扰控制方法 |
CN114389257A (zh) * | 2021-12-29 | 2022-04-22 | 杭州电子科技大学 | 基于故障分布的单区域电力系统的容错负载频率控制器 |
CN114879512A (zh) * | 2022-07-06 | 2022-08-09 | 南京航空航天大学 | 基于学习神经网络滑模的航天器编队轨道容错控制方法 |
CN114879512B (zh) * | 2022-07-06 | 2022-11-08 | 南京航空航天大学 | 基于学习神经网络滑模的航天器编队轨道容错控制方法 |
CN114879515A (zh) * | 2022-07-12 | 2022-08-09 | 南京航空航天大学 | 基于学习神经网络的航天器姿态重构容错控制方法 |
CN116923730A (zh) * | 2023-07-24 | 2023-10-24 | 哈尔滨工业大学 | 一种具有自调节预设性能约束的航天器姿态主动容错控制方法 |
CN116923730B (zh) * | 2023-07-24 | 2024-06-18 | 哈尔滨工业大学 | 一种具有自调节预设性能约束的航天器姿态主动容错控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107121961B (zh) | 2018-05-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107121961B (zh) | 一种基于迭代学习干扰观测器的航天器姿态容错控制方法 | |
CN106292681B (zh) | 一种基于观测器和在线控制分配的卫星主动容错控制方法 | |
CN105867401B (zh) | 单框架控制力矩陀螺群的航天器姿态容错控制方法 | |
CN106773679B (zh) | 一种基于角速度观测器的航天器容错控制方法 | |
Hu et al. | Robust fault-tolerant tracking control for spacecraft proximity operations using time-varying sliding mode | |
CN109765920B (zh) | 集成故障观测器和控制分配策略的航天器姿态容错的控制方法 | |
Qinglei et al. | Adaptive integral-type sliding mode control for spacecraft attitude maneuvering under actuator stuck failures | |
CN104527994B (zh) | 异面交叉快变轨道固定时间稳定姿态指向跟踪控制方法 | |
CN103116357B (zh) | 一种具有抗干扰容错性能的滑模控制方法 | |
CN103676941B (zh) | 基于运动学和动力学模型的卫星控制系统故障诊断方法 | |
Ma et al. | Actuator failure compensation and attitude control for rigid satellite by adaptive control using quaternion feedback | |
CN103676918B (zh) | 一种基于未知输入观测器的卫星执行机构故障诊断方法 | |
CN106933241B (zh) | 基于故障解耦的单框架控制力矩陀螺航天器容错控制方法 | |
Chang et al. | Decentralized coordinated attitude control for satellite formation flying via the state-dependent Riccati equation technique | |
CN107422639B (zh) | 一种基于时间延迟估计的双边遥操作控制方法 | |
CN107703742A (zh) | 一种柔性航天器传感器故障调节方法 | |
CN104880948A (zh) | 一种基于鲁棒自适应的带有飞轮的航天器容错控制方法 | |
Hu et al. | Fault tolerant control with H∞ performance for attitude tracking of flexible spacecraft | |
Dos Santos et al. | Bank of controllers and virtual thrusters for fault-tolerant control of autonomous underwater vehicles | |
CN108804846B (zh) | 非合作目标组合体航天器的数据驱动姿态控制器设计方法 | |
CN102735259A (zh) | 一种基于多层状态估计器的卫星控制系统故障诊断方法 | |
CN109164816B (zh) | 一种控制器故障和饱和特性的非合作目标姿态跟踪控制方法 | |
Tafazoli et al. | Nonlinear control and stability analysis of spacecraft attitude recovery | |
Li et al. | Adaptive sliding mode control for spacecraft rendezvous with unknown system parameters and input saturation | |
Li et al. | Observer-based robust actuator fault isolation and identification for microsatellite attitude control systems |
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 |