CN107132764A - 基于自抗扰控制技术的碎片抓捕后轨道转移控制方法 - Google Patents
基于自抗扰控制技术的碎片抓捕后轨道转移控制方法 Download PDFInfo
- Publication number
- CN107132764A CN107132764A CN201710336025.2A CN201710336025A CN107132764A CN 107132764 A CN107132764 A CN 107132764A CN 201710336025 A CN201710336025 A CN 201710336025A CN 107132764 A CN107132764 A CN 107132764A
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- mtd
- mtr
- mover
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 39
- 239000012634 fragment Substances 0.000 title claims abstract description 20
- 230000009466 transformation Effects 0.000 title claims abstract description 18
- 238000013461 design Methods 0.000 claims abstract description 8
- 230000000694 effects Effects 0.000 claims abstract description 7
- 238000005312 nonlinear dynamic Methods 0.000 claims abstract description 6
- 230000008878 coupling Effects 0.000 claims description 10
- 238000010168 coupling process Methods 0.000 claims description 10
- 238000005859 coupling reaction Methods 0.000 claims description 10
- 230000009471 action Effects 0.000 claims description 9
- 239000011159 matrix material Substances 0.000 claims description 8
- 230000001133 acceleration Effects 0.000 claims description 6
- 238000006243 chemical reaction Methods 0.000 claims description 4
- 230000003068 static effect Effects 0.000 claims description 4
- 230000003321 amplification Effects 0.000 claims description 3
- 238000001914 filtration Methods 0.000 claims description 3
- 230000010354 integration Effects 0.000 claims description 3
- 230000007246 mechanism Effects 0.000 claims description 3
- 230000009022 nonlinear effect Effects 0.000 claims description 3
- 238000003199 nucleic acid amplification method Methods 0.000 claims description 3
- 230000002441 reversible effect Effects 0.000 claims description 3
- 238000011156 evaluation Methods 0.000 claims 1
- 238000005516 engineering process Methods 0.000 abstract description 3
- 230000008569 process Effects 0.000 description 4
- 238000004088 simulation Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 238000005183 dynamical system Methods 0.000 description 2
- 230000001965 increasing effect Effects 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 230000035935 pregnancy Effects 0.000 description 2
- 241000406668 Loxodonta cyclotis Species 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000002708 enhancing effect Effects 0.000 description 1
- 230000021824 exploration behavior Effects 0.000 description 1
- 230000008713 feedback mechanism Effects 0.000 description 1
- 230000002427 irreversible effect Effects 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 238000003786 synthesis reaction Methods 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
- 230000001052 transient effect Effects 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
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
-
- 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/10—Simultaneous control of position or course in three dimensions
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Other Investigation Or Analysis Of Materials By Electrical Means (AREA)
Abstract
本发明提出了一种基于自抗扰控制技术的碎片抓捕后轨道转移控制方法,属于轨道转移控制领域。技术方案包括:第一步:根据抓捕后组合系统的运动方程,通过引入“虚拟控制量”U,将组合系统的每一个通道解耦为单输入—单输出的子控制系统;第二步:根据每个子系统控制模型,设计非线性动态补偿控制率;第三步:设计每一个通道的自抗扰控制器,包括跟踪微分器、扩张状态观测器、和非线性状态误差反馈控制率;第四步:根据每个通道的“虚拟控制量”,得出所需的实际控制量。本发明最突出的优势就是利用自抗扰技术“实时估计补偿不确定因素并给予补偿”的突出特征,来克服抓捕后组合系统模型的不确定性以及外界扰动作用。
Description
技术领域
本发明属于轨道转移控制领域,具体公开了一种基于自抗扰控制技术的碎片抓捕后轨道转移控制方法。
背景技术
近年来,随着经济实力的增强和航天技术的发展,人类对于空间的探索活动也急剧增加。空间碎片是指分布在地球轨道上,并且已经丧失功能的空间物体。从第一颗人造卫星成功发射升空,空间碎片就已经出现了。然而几十年以后,空间碎片对在轨航天器的威胁才被人们重视。到目前为止,美国空间检测平台检测到大约有17000个在轨运行的物体,然而只有1200件为正常工作的卫星或其它航天器。如果不加以控制,随着人类空间活动的继续,空间碎片的数量增长到一定程度后,主动清除碎片的速度会低于碎片产生的速度,这样就会形成一种“凯斯勒综合”链式反应,最终整个轨道空间将布满空间碎片。
在碎片清除任务中,主要包括以下几个过程:接近碎片、抓捕碎片、抓捕后轨道转移。与航天器轨道转移不同之处在于,抓捕后组合系统不仅具有非线性、多输入多输出、时变、高阶等的特点,而且具有不确定性,很难应用传统的基于精确模型的“现代控制理论”对其进行控制。
发明内容
本发明的目的在于提供一种基于自抗扰控制技术的碎片抓捕后轨道转移控制方法,该方法基于自抗扰控制技术,对多变量的抓捕后组合系统进行解耦控制,确保抓捕后组合系统能精确跟随预先规划的轨迹实现碎片轨道转移。
本发明是通过以下技术方案来实现:
本发明公开了一种基于自抗扰控制技术的碎片抓捕后轨道转移控制方法,其特征在于,包括以下步骤:
步骤一:建立抓捕后组合系统的动力学模型,根据抓捕后组合系统的运动方程,通过引入虚拟控制量U,将抓捕后组合系统的每一个通道解耦为单输入-单输出的子控制系统;
步骤二:根据每个子控制系统的控制模型,设计非线性动态补偿控制律;
步骤三:设计每个通道的自抗扰控制器,包括跟踪微分器、扩张状态观测器和非线性状态误差反馈控制律,以得到每个通道的虚拟控制量;
步骤四:根据每个通道的虚拟控制量,得出所需的实际控制量。
优选地,步骤一中,对于抓捕后组合系统,其动力学模型方程如下式:
选取状态空间:
其中,p0b为航天器质心位置,Θ0b代表航天器姿态的欧拉角,和为航天器的线速度和角速度,q为操纵机构的关节位置;τv是由推进器所产生的作用于航天器的力,τω是由推进器动量陀螺或反作用轮所产生的作用于航天器的力矩,τq是操纵器力矩;
将该抓捕后组合系统动力学方程写为如下状态空间方程形式:
假设该多输入-多输出系统是m输入-m输出系统,控制量的放大系数bij是状态变量和时间的函数矩阵可逆;
将控制量之外的模型部分f(x1,x2,...,xm)=[f1 f2...fm]T称作动态耦合部分,把部分称作静态耦合部分;
记x=[x1,x2...xm]T,f=[x1,x2...xm]T,u=[u1 u2...um]T,并引入虚拟控制量则系统状态方程变为:
在这个系统中的第i通道的输入输出关系为:
每一个通道的虚拟控制量Ui与被控输出yi之间是单输入-单输出关系,即第i通道的被控输出yi和虚拟控制量之间Ui已经被完全解耦了,而则是作用于第i通道上的扰动总和;
只要有控制量yi的目标值且yi能被测量,那么在Ui和yi之间嵌入一个自抗扰控制器就完全能够让yi达到目标在控制向量U与输出向量y之间并行地嵌入m个自抗扰控制器能实现多变量系统的解耦控制;系统动态耦合作用的各分量在解耦控制中被当作各自通道上的扰动总和来被估计并补偿掉。
优选地,步骤二所述的根据每个子控制系统的控制模型,设计非线性动态补偿控制律,具体操作为:
对于系统第i通道的输入输出关系为:
对于系统的输入-输出信号u(t)和y(t)=x(t),利用特殊的非线性效应,实时估计出作用于系统的全部加速度对系统进行加速度a(t)的估计值z3(t)的补偿;
取对系统进行加速度a(t)的估计值的补偿;
使系统变成即系统变为线性积分器串联型系统
优选地,步骤三所述设计每一个通道的自抗扰控制器,包括跟踪微分器、扩张状态观测器和非线性状态误差反馈控制律;
对于该解耦系统的第i个通道:
微分跟踪器采用如下模型:
其中,xtr是输入信号xref的跟踪信号,v是它的微分信号;函数fhan(xtr-xref,v,r0,h0)定义为:
其中,r0是待调参数,即跟踪微分器的速度因子,h0是滤波因子,h是积分步长;
扩张状态观测器采用如下模型,对于非线性系统:
把作用于开环系统的加速度f(x1(t),x2(t))的实时作用量扩充成新的状态变量x3,并记则将原系统扩充成新的线性控制系统:
对这个被扩充的新的线性控制系统建立状态观测器:
其中,z1、z2分别跟踪系统状态x1、x2;z3估计系统总的扰动作用x3,β01、β02、β03是待调系数,e1为系统状态x1的估计量与系统输出y之间的误差,e是状态误差,δ是幂次函数fal的线性段区间长度,满足δ∈[0,1],α表示幂次函数fal的幂,满足0<α<1;
非线性状态误差反馈控制律采用如下模型:
其中,e1,e2为状态跟踪量与观测量之间的误差,r,c为可调参数。
优选地,步骤四中:
实际的控制量u=[u1 u2...um]T,虚拟控制量U=[U1 U2...Um]T;
则由下式计算得到所需的实际控制量:
与现有技术相比,本发明具有以下有益的技术效果:
本发明针对抓捕后组合系统的非线性、多输入多输出、时变、高阶以及不确定性等特点,提出了一种基于自抗扰控制技术的碎片抓捕后轨道转移控制方法,自抗扰控制技术最突出的特征就是把作用于被控对象的所有不确定因素作用都归结为“未知扰动”而用对象的输入输出数据对它进行估计并给予补偿。本发明利用自抗扰控制技术的“实时估计补偿不确定因素并给予补偿”的突出特征,来克服抓捕后组合系统模型的不确定性以及外界扰动作用,将未建模动态和未知外扰都归结为对象的未知扰动,用输入输出数据估计并给予补偿,从而实现动态系统的动态反馈线性化,再使用非线性配置构成非线性反馈控制律,来提高其闭环系统的控制性能。该方法可以克服传统现代控制理论对对象精确建模的依赖性,更适用于对抓捕后组合系统的轨道转移控制。
附图说明
图1是多变量系统解耦控制过程框图;
图2是每个通道上的自抗扰控制器结构图;
图3是在x方向上,参考位置信息与控制输出的位置信息;
图4是在y方向上,参考位置信息与控制输出的位置信息;
图5是在z方向上,参考位置信息与控制输出的位置信息。
具体实施方式
下面结合具体的实施例对本发明做进一步的详细说明,所述是对本发明的解释而不是限定。
本发明所述的自抗扰,是指将未建模动态和未知外扰都归结为对象的未知扰动,用输入输出数据估计并给予补偿,从而实现动态系统的动态反馈线性化,再使用非线性配置构成非线性反馈控制律来提高其闭环系统的控制性能。因此,并不需要直接测量外扰作用,也不需要事先知道扰动作用规律,而是对不确定因素进行实时的估计与补偿。
本发明将基于自抗扰控制技术,对多变量的抓捕后组合系统进行解耦控制,确保抓捕后组合系统能精确跟随预先规划的轨迹实现碎片轨道转移。
本发明提出的一种基于自抗扰控制技术的碎片抓捕后轨道转移控制方法,包括以下几个步骤:
步骤一:建立抓捕后组合系统的动力学模型,根据抓捕后组合系统的运动方程,通过引入“虚拟控制量”U,将组合系统的每一个通道解耦为单输入—单输出的子控制系统。
对于抓捕后的spacecraft-manipulator-payload组合系统,其动力学模型可以写为如下形式:
选取状态空间:
其中,p0b为航天器质心位置,Θ0b代表航天器姿态的欧拉角,和为航天器的线速度和角速度,q为操纵机构的关节位置;τv是由推进器所产生的作用于航天器的力,τω是由推进器、动量陀螺或反作用轮所产生的作用于航天器的力矩,τq是操纵器力矩;
将该抓捕后组合系统动力学方程写为如下状态空间方程形式:
假设该多输入-多输出系统是m输入-m输出系统,控制量的放大系数bij是状态变量和时间的函数矩阵可逆;
将控制量之外的模型部分f(x1,x2,...,xm)=[f1 f2...fm]T称作“动态耦合部分”,把部分称作“静态耦合部分”;
记x=[x1x2...xm]T,f=[x1x2...xm]T,u=[u1 u2...um]T,并引入“虚拟控制量”则系统状态方程变为:
在这个系统中的第i通道的输入输出关系为:
每一个通道的虚拟控制量Ui与被控输出yi之间是单输入-单输出关系,即第i通道的被控输出yi和虚拟控制量之间Ui已经被完全解耦了,而则是作用于第i通道上的扰动总和;
因此,只要有控制量yi的目标值且yi能被测量,那么在Ui和yi之间嵌入一个自抗扰控制器就完全能够让yi达到目标这样,在控制向量U与输出向量y之间并行地嵌入m个自抗扰控制器能实现多变量系统的解耦控制;系统动态耦合作用的各分量在解耦控制中被当作各自通道上的扰动总和来被估计并补偿掉。这个过程的框图参见图1。
步骤二:根据每个子系统控制模型,设计非线性动态补偿控制律。
对于系统第i通道的输入输出关系:
根据系统的输入-输出信号u(t)和y(t)=x(t),利用特殊的非线性效应,实时估计出作用于系统的全部加速度对系统进行加速度a(t)的估计值z3(t)的补偿;
取对系统进行加速度a(t)的估计值的补偿;
使系统变成即系统变为“线性积分器串联型系统”
步骤三:设计每一个通道的自抗扰控制器,包括跟踪微分器、扩张状态观测器、和非线性状态误差反馈控制律。
对于该解耦系统的第i个通道:
设计这个通道的自抗扰控制器参见图2,其基本结构可以看作在传统PID控制框图的基础上,1)增加微分跟踪器1,用来提供微分信号并增加过渡过程,解决超调与快速性之间的矛盾;2)增加微分跟踪器2,可以过滤输出信号中的噪声干扰;3)运用扩张状态观测器来实时估计扰动作用量并加以补偿;4)采用误差信号的非线性组合方式。
微分跟踪器TD采用如下模型:
其中,xtr是输入信号xref的跟踪信号,v是它的微分信号;
函数fhan(xtr-xref,v,r0,h0)定义为:
其中,r0是待调参数,即跟踪微分器的速度因子,h0是滤波因子,h是积分步长;
扩张状态观测器ESO采用如下模型,对于非线性系统:
把作用于开环系统的加速度f(x1(t),x2(t))的实时作用量扩充成新的状态变量x3,并记则将原系统扩充成新的线性控制系统:
对这个被扩充的新的线性控制系统建立状态观测器:
其中,z1、z2分别跟踪系统状态x1、x2;z3估计系统总的扰动作用x3,β01、β02、β03是待调系数,e1为系统状态x1的估计量与系统输出y之间的误差,e是状态误差,δ是幂次函数fal的线性段区间长度,满足δ∈[0,1],α表示幂次函数fal的幂,满足0<α<1;
扩张状态观测器的基本思想是:如果某一种扰动作用不影响系统的被控输出,那么在控制过程中不需要考虑消除这种扰动的影响,需要消除的是能够影响被控输出的那种扰动,既然某一种扰动能够影响被控输出,其作用就应该反映在这个被控输出信息中,从而就有可能以适当方式处理被控输出信息来估计出其作用。既然能估计出影响被控输出的扰动作用,就有可能用补偿的办法来消除其影响了。
借用状态观测器的思想,把能够影响被控输出的扰动作用扩张成新的状态变量,用特殊的反馈机制来建立能够观测被扩张的状态的扩张状态观测器。这个扩张状态观测器并不依赖于生成扰动的具体数学模型,也不需要直接去测量其作用。
非线性状态误差反馈控制律采用如下模型:
其中,e1,e2为状态跟踪量与观测量之间的误差,r,c为可调参数。
步骤四:根据每个通道的“虚拟控制量”,得出所需的实际控制量。
实际的控制量u=[u1 u2...um]T,虚拟控制量U=[U1 U2...Um]T;
则由下式计算得到所需的实际控制量:
大量的仿真研究表明,用自抗扰控制器进行解耦控制时,对静态耦合矩阵的估计精度要求不高,即使有百分之几十的估计误差,只要保证矩阵的可逆性,对闭环的控制品质无多大影响。即使矩阵在系统运行过程中瞬间地出现不可逆的奇异现象也关系不大,可以在矩阵附近找一个可逆矩阵来近似就可以了。
以下为本发明的仿真实例:
为了证实本方法的可行性及有效性,假设有如下非线性多变量耦合系统:
令其跟踪轨迹:
对于解耦后的x,y,z通道,每个通道的自抗扰控制器参数表示如下:跟踪微分器1的速度因子为ri,跟踪微分器2的速度因子为r0i;扩张状态观测器的参数分别为βi1,βi2,βi3。
编写matlab仿真程序,相关的仿真参数取:h=0.001,跟踪微分器1的速度因子ri=1000,跟踪微分器2的速度因子r0i=2000;扩张状态观测器参数β11=β21=200,β12=β22=600,β13=β23=2000,β31=100,β32=300,β33=1000;δ=h,α1=0.5,α2=0.25;非线性状态误差反馈控制律参数c=0.5,α=5,h3=0.01。仿真结果如图3-图5所示。从图中可以看出,在系统模型非线性并存在不确定性的条件下,自抗扰控制器能够控制系统快速、无稳态误差地跟踪参考轨迹,具有较好的鲁棒性。相较于基于系统模型的现代控制理论,自抗扰控制器设计简单,控制精度更好。
Claims (5)
1.一种基于自抗扰控制技术的碎片抓捕后轨道转移控制方法,其特征在于,包括以下步骤:
步骤一:建立抓捕后组合系统的动力学模型,根据抓捕后组合系统的运动方程,通过引入虚拟控制量U,将抓捕后组合系统的每一个通道解耦为单输入-单输出的子控制系统;
步骤二:根据每个子控制系统的控制模型,设计非线性动态补偿控制律;
步骤三:设计每个通道的自抗扰控制器,包括跟踪微分器、扩张状态观测器和非线性状态误差反馈控制律,以得到每个通道的虚拟控制量;
步骤四:根据每个通道的虚拟控制量,得出所需的实际控制量。
2.根据权利要求1所述的基于自抗扰控制技术的碎片抓捕后轨道转移控制方法,其特征在于,步骤一中,对于抓捕后组合系统,其动力学模型方程如下式:
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>M</mi>
<mi>v</mi>
</msub>
</mtd>
<mtd>
<msubsup>
<mi>M</mi>
<mrow>
<mi>&omega;</mi>
<mi>v</mi>
</mrow>
<mi>T</mi>
</msubsup>
</mtd>
<mtd>
<msubsup>
<mi>M</mi>
<mrow>
<mi>q</mi>
<mi>v</mi>
</mrow>
<mi>T</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>M</mi>
<mrow>
<mi>&omega;</mi>
<mi>v</mi>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>M</mi>
<mi>&omega;</mi>
</msub>
</mtd>
<mtd>
<msubsup>
<mi>M</mi>
<mrow>
<mi>q</mi>
<mi>&omega;</mi>
</mrow>
<mi>T</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>M</mi>
<mrow>
<mi>q</mi>
<mi>v</mi>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>M</mi>
<mrow>
<mi>q</mi>
<mi>&omega;</mi>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>M</mi>
<mi>q</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mover>
<mi>v</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mn>0</mn>
<mi>b</mi>
</mrow>
<mi>E</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mover>
<mi>&omega;</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mn>0</mn>
<mi>b</mi>
</mrow>
<mi>E</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>q</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>+</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>C</mi>
<mi>v</mi>
</msub>
</mtd>
<mtd>
<msub>
<mi>C</mi>
<mrow>
<mi>v</mi>
<mi>&omega;</mi>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>C</mi>
<mrow>
<mi>v</mi>
<mi>q</mi>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>C</mi>
<mrow>
<mi>&omega;</mi>
<mi>v</mi>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>C</mi>
<mi>&omega;</mi>
</msub>
</mtd>
<mtd>
<msub>
<mi>C</mi>
<mrow>
<mi>&omega;</mi>
<mi>q</mi>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>C</mi>
<mrow>
<mi>q</mi>
<mi>v</mi>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>C</mi>
<mrow>
<mi>q</mi>
<mi>&omega;</mi>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>C</mi>
<mi>q</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mi>v</mi>
<mrow>
<mn>0</mn>
<mi>b</mi>
</mrow>
<mi>E</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mn>0</mn>
<mi>b</mi>
</mrow>
<mi>E</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>&tau;</mi>
<mi>v</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>&tau;</mi>
<mi>&omega;</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>&tau;</mi>
<mi>q</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
选取状态空间:
<mrow>
<mi>x</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>p</mi>
<mrow>
<mn>0</mn>
<mi>b</mi>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>&Theta;</mi>
<mrow>
<mn>0</mn>
<mi>b</mi>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>q</mi>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
<mi>v</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mi>v</mi>
<mrow>
<mn>0</mn>
<mi>b</mi>
</mrow>
<mi>E</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mn>0</mn>
<mi>b</mi>
</mrow>
<mi>E</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,p0b为航天器质心位置,Θ0b代表航天器姿态的欧拉角,和为航天器的线速度和角速度,q为操纵机构的关节位置;τv是由推进器所产生的作用于航天器的力,τω是由推进器动量陀螺或反作用轮所产生的作用于航天器的力矩,τq是操纵器力矩;
将该抓捕后组合系统动力学方程写为如下状态空间方程形式:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>=</mo>
<msub>
<mi>f</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>,</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>,</mo>
<mn>...</mn>
<mo>,</mo>
<msub>
<mi>x</mi>
<mi>m</mi>
</msub>
<mo>,</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>m</mi>
</msub>
</mrow>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>b</mi>
<mn>11</mn>
</msub>
<msub>
<mi>u</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<mn>...</mn>
<mo>+</mo>
<msub>
<mi>b</mi>
<mrow>
<mn>1</mn>
<mi>m</mi>
</mrow>
</msub>
<msub>
<mi>u</mi>
<mi>m</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>=</mo>
<msub>
<mi>f</mi>
<mn>2</mn>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>,</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>,</mo>
<mn>...</mn>
<mo>,</mo>
<msub>
<mi>x</mi>
<mi>m</mi>
</msub>
<mo>,</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>m</mi>
</msub>
</mrow>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>b</mi>
<mn>21</mn>
</msub>
<msub>
<mi>u</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<mn>...</mn>
<mo>+</mo>
<msub>
<mi>b</mi>
<mrow>
<mn>2</mn>
<mi>m</mi>
</mrow>
</msub>
<msub>
<mi>u</mi>
<mi>m</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>...</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>m</mi>
</msub>
<mo>=</mo>
<msub>
<mi>f</mi>
<mi>m</mi>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>,</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>,</mo>
<mn>...</mn>
<mo>,</mo>
<msub>
<mi>x</mi>
<mi>m</mi>
</msub>
<mo>,</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>m</mi>
</msub>
</mrow>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>b</mi>
<mrow>
<mi>m</mi>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>u</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<mn>...</mn>
<mo>+</mo>
<msub>
<mi>b</mi>
<mrow>
<mi>m</mi>
<mi>m</mi>
</mrow>
</msub>
<msub>
<mi>u</mi>
<mi>m</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>y</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>,</mo>
<msub>
<mi>y</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>,</mo>
<mn>...</mn>
<mo>,</mo>
<msub>
<mi>y</mi>
<mi>m</mi>
</msub>
<mo>=</mo>
<msub>
<mi>x</mi>
<mi>m</mi>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
假设多输入-多输出系统是m输入-m输出系统,控制量的放大系数bij是状态变量和时间的函数矩阵可逆;
将控制量之外的模型部分f(x1,x2,...,xm)=[f1 f2 ... fm]T称作动态耦合部分,把部分称作静态耦合部分;
记x=[x1 x2 ... xm]T,f=[x1 x2 ... xm]T,u=[u1 u2 ... um]T,并引入虚拟控制量则系统状态方程变为:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>=</mo>
<mi>f</mi>
<mrow>
<mo>(</mo>
<mrow>
<mi>x</mi>
<mo>,</mo>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>,</mo>
<mi>t</mi>
</mrow>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>U</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>y</mi>
<mo>=</mo>
<mi>x</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>4</mn>
<mo>)</mo>
</mrow>
</mrow>
在这个系统中的第i通道的输入输出关系为:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>i</mi>
</msub>
<mo>=</mo>
<msub>
<mi>f</mi>
<mi>i</mi>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>,</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>,</mo>
<mn>...</mn>
<mo>,</mo>
<msub>
<mi>x</mi>
<mi>m</mi>
</msub>
<mo>,</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>m</mi>
</msub>
<mo>,</mo>
<mi>t</mi>
</mrow>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>U</mi>
<mi>i</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>y</mi>
<mi>i</mi>
</msub>
<mo>=</mo>
<msub>
<mi>x</mi>
<mi>i</mi>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>5</mn>
<mo>)</mo>
</mrow>
</mrow>
每一个通道的虚拟控制量Ui与被控输出yi之间是单输入-单输出关系,即第i通道的被控输出yi和虚拟控制量之间Ui已经被完全解耦了,而则是作用于第i通道上的扰动总和;
只要有控制量yi的目标值且yi能被测量,那么在Ui和yi之间嵌入一个自抗扰控制器就完全能够让yi达到目标在控制向量U与输出向量y之间并行地嵌入m个自抗扰控制器能实现多变量系统的解耦控制;系统动态耦合作用的各分量在解耦控制中被当作各自通道上的扰动总和来被估计并补偿掉。
3.根据权利要求2所述的基于自抗扰控制技术的碎片抓捕后轨道转移控制方法,其特征在于,步骤二所述的根据每个子控制系统的控制模型,设计非线性动态补偿控制律,具体操作为:
对于系统第i通道的输入输出关系为:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>i</mi>
</msub>
<mo>=</mo>
<msub>
<mi>f</mi>
<mi>i</mi>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>,</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>,</mo>
<mn>...</mn>
<mo>,</mo>
<msub>
<mi>x</mi>
<mi>m</mi>
</msub>
<mo>,</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>m</mi>
</msub>
<mo>,</mo>
<mi>t</mi>
</mrow>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>U</mi>
<mi>i</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>y</mi>
<mi>i</mi>
</msub>
<mo>=</mo>
<msub>
<mi>x</mi>
<mi>i</mi>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>6</mn>
<mo>)</mo>
</mrow>
</mrow>
对于系统的输入-输出信号u(t)和y(t)=x(t),利用特殊的非线性效应,实时估计出作用于系统的全部加速度对系统进行加速度a(t)的估计值z3(t)的补偿;
取对系统进行加速度a(t)的估计值的补偿;
使系统变成即系统变为线性积分器串联型系统
4.根据权利要求2所述的基于自抗扰控制技术的碎片抓捕后轨道转移控制方法,其特征在于,步骤三所述设计每一个通道的自抗扰控制器,包括跟踪微分器、扩张状态观测器和非线性状态误差反馈控制律;
对于该解耦系统的第i个通道:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>i</mi>
</msub>
<mo>=</mo>
<msub>
<mi>f</mi>
<mi>i</mi>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>,</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>,</mo>
<mn>...</mn>
<mo>,</mo>
<msub>
<mi>x</mi>
<mi>m</mi>
</msub>
<mo>,</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>m</mi>
</msub>
<mo>,</mo>
<mi>t</mi>
</mrow>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>U</mi>
<mi>i</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>y</mi>
<mi>i</mi>
</msub>
<mo>=</mo>
<msub>
<mi>x</mi>
<mi>i</mi>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
微分跟踪器采用如下模型:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>t</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>=</mo>
<mi>v</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mover>
<mi>v</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mi>f</mi>
<mi>h</mi>
<mi>a</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mrow>
<mi>t</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mrow>
<mi>r</mi>
<mi>e</mi>
<mi>f</mi>
</mrow>
</msub>
<mo>,</mo>
<mi>v</mi>
<mo>,</mo>
<msub>
<mi>r</mi>
<mn>0</mn>
</msub>
<mo>,</mo>
<msub>
<mi>h</mi>
<mn>0</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>8</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,xtr是输入信号xref的跟踪信号,v是它的微分信号;函数fhan(xtr-xref,v,r0,h0)定义为:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>d</mi>
<mo>=</mo>
<msub>
<mi>r</mi>
<mn>0</mn>
</msub>
<msub>
<mi>h</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>d</mi>
<mn>0</mn>
</msub>
<mo>=</mo>
<msub>
<mi>h</mi>
<mn>0</mn>
</msub>
<mi>d</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>y</mi>
<mo>=</mo>
<msub>
<mi>x</mi>
<mrow>
<mi>t</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mrow>
<mi>r</mi>
<mi>e</mi>
<mi>f</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>h</mi>
<mn>0</mn>
</msub>
<mi>v</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>a</mi>
<mn>0</mn>
</msub>
<mo>=</mo>
<msqrt>
<mrow>
<msup>
<mi>d</mi>
<mn>2</mn>
</msup>
<mo>+</mo>
<mn>8</mn>
<msub>
<mi>r</mi>
<mn>0</mn>
</msub>
<mo>|</mo>
<mi>y</mi>
<mo>|</mo>
</mrow>
</msqrt>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>a</mi>
<mo>=</mo>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>v</mi>
<mo>+</mo>
<mfrac>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>a</mi>
<mn>0</mn>
</msub>
<mo>-</mo>
<mi>d</mi>
</mrow>
<mo>)</mo>
</mrow>
<mn>2</mn>
</mfrac>
<mi>s</mi>
<mi>i</mi>
<mi>g</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>y</mi>
<mo>)</mo>
</mrow>
<mo>,</mo>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>|</mo>
<mi>y</mi>
<mo>|</mo>
<mo>></mo>
<msub>
<mi>d</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>v</mi>
<mo>+</mo>
<mfrac>
<mi>y</mi>
<mi>h</mi>
</mfrac>
<mo>,</mo>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>|</mo>
<mi>y</mi>
<mo>|</mo>
<mo>&le;</mo>
<msub>
<mi>d</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>f</mi>
<mi>h</mi>
<mi>a</mi>
<mi>n</mi>
<mo>=</mo>
<mo>-</mo>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>r</mi>
<mn>0</mn>
</msub>
<mi>s</mi>
<mi>i</mi>
<mi>g</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>a</mi>
<mo>)</mo>
</mrow>
<mo>,</mo>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>|</mo>
<mi>a</mi>
<mo>|</mo>
<mo>></mo>
<mi>d</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>r</mi>
<mn>0</mn>
</msub>
<mfrac>
<mi>a</mi>
<mi>d</mi>
</mfrac>
<mo>,</mo>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>|</mo>
<mi>a</mi>
<mo>|</mo>
<mo>&le;</mo>
<mi>d</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>9</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,r0是待调参数,即跟踪微分器的速度因子,h0是滤波因子,h是积分步长;
扩张状态观测器采用如下模型,对于非线性系统:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>=</mo>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>=</mo>
<mi>f</mi>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>,</mo>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
</mrow>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>b</mi>
<mi>u</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>y</mi>
<mo>=</mo>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>10</mn>
<mo>)</mo>
</mrow>
</mrow>
把作用于开环系统的加速度f(x1(t),x2(t))的实时作用量扩充成新的状态变量x3,并记则将原系统扩充成新的线性控制系统:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>=</mo>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>=</mo>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mo>+</mo>
<mi>b</mi>
<mi>u</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>3</mn>
</msub>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mi>w</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>y</mi>
<mo>=</mo>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>11</mn>
<mo>)</mo>
</mrow>
</mrow>
对这个被扩充的新的线性控制系统建立状态观测器:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>e</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<msub>
<mi>z</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<mi>y</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>z</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>=</mo>
<msub>
<mi>z</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>&beta;</mi>
<mn>01</mn>
</msub>
<msub>
<mi>e</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>z</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>=</mo>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msub>
<mi>&beta;</mi>
<mn>02</mn>
</msub>
<mi>f</mi>
<mi>a</mi>
<mi>l</mi>
<mrow>
<mo>(</mo>
<mrow>
<mi>e</mi>
<mo>,</mo>
<msub>
<mi>&alpha;</mi>
<mn>1</mn>
</msub>
<mo>,</mo>
<mi>&delta;</mi>
</mrow>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>b</mi>
<mi>u</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>z</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>3</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>&beta;</mi>
<mn>03</mn>
</msub>
<mi>f</mi>
<mi>a</mi>
<mi>l</mi>
<mrow>
<mo>(</mo>
<mrow>
<mi>e</mi>
<mo>,</mo>
<msub>
<mi>&alpha;</mi>
<mn>2</mn>
</msub>
<mo>,</mo>
<mi>&delta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>12</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>f</mi>
<mi>a</mi>
<mi>l</mi>
<mrow>
<mo>(</mo>
<mrow>
<mi>e</mi>
<mo>,</mo>
<mi>&alpha;</mi>
<mo>,</mo>
<mi>&delta;</mi>
</mrow>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mfrac>
<mi>e</mi>
<msup>
<mi>&delta;</mi>
<mrow>
<mi>&alpha;</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
</mfrac>
<mo>,</mo>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>|</mo>
<mi>e</mi>
<mo>|</mo>
<mo>&le;</mo>
<mi>&delta;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>|</mo>
<mi>e</mi>
<msup>
<mo>|</mo>
<mi>&alpha;</mi>
</msup>
<mi>s</mi>
<mi>i</mi>
<mi>g</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>e</mi>
<mo>)</mo>
</mrow>
<mo>,</mo>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>|</mo>
<mi>e</mi>
<mo>|</mo>
<mo>></mo>
<mi>&delta;</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>13</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,z1、z2分别跟踪系统状态x1、x2;z3估计系统总的扰动作用x3,β01、β02、β03是待调系数,e1为系统状态x1的估计量与系统输出y之间的误差,e是状态误差,δ是幂次函数fal的线性段区间长度,满足δ∈[0,1],α表示幂次函数fal的幂,满足0<α<1;
非线性状态误差反馈控制律采用如下模型:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>e</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<msub>
<mi>x</mi>
<mrow>
<mi>t</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>z</mi>
<mn>1</mn>
</msub>
<mo>,</mo>
<msub>
<mi>e</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mi>v</mi>
<mo>-</mo>
<msub>
<mi>z</mi>
<mn>2</mn>
</msub>
<mo>,</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>u</mi>
<mo>=</mo>
<mo>-</mo>
<mi>f</mi>
<mi>h</mi>
<mi>a</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>e</mi>
<mn>1</mn>
</msub>
<mo>,</mo>
<msub>
<mi>ce</mi>
<mn>2</mn>
</msub>
<mo>,</mo>
<mi>r</mi>
<mo>,</mo>
<mi>h</mi>
</mrow>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>14</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,e1,e2为状态跟踪量与观测量之间的误差,r,c为可调参数。
5.根据权利要求2所述的基于自抗扰控制技术的碎片抓捕后轨道转移控制方法,其特征在于,步骤四中:
实际的控制量u=[u1 u2 … um]T,虚拟控制量U=[U1 U2 … Um]T;
则由下式计算得到所需的实际控制量:
<mrow>
<mi>u</mi>
<mo>=</mo>
<msup>
<mi>B</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mrow>
<mo>(</mo>
<mi>x</mi>
<mo>,</mo>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>,</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mi>U</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>15</mn>
<mo>)</mo>
</mrow>
<mo>.</mo>
</mrow>
3
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710336025.2A CN107132764A (zh) | 2017-05-12 | 2017-05-12 | 基于自抗扰控制技术的碎片抓捕后轨道转移控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710336025.2A CN107132764A (zh) | 2017-05-12 | 2017-05-12 | 基于自抗扰控制技术的碎片抓捕后轨道转移控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107132764A true CN107132764A (zh) | 2017-09-05 |
Family
ID=59731827
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710336025.2A Pending CN107132764A (zh) | 2017-05-12 | 2017-05-12 | 基于自抗扰控制技术的碎片抓捕后轨道转移控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107132764A (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108762097A (zh) * | 2018-07-27 | 2018-11-06 | 合肥工业大学 | 一种基于虚拟模型的跟踪抗扰控制方法 |
CN109683471A (zh) * | 2018-08-28 | 2019-04-26 | 杭州电子科技大学 | 自抗扰控制方法、装置和系统 |
CN109709810A (zh) * | 2019-01-22 | 2019-05-03 | 天津大学 | 全方位移动机器人轨迹跟踪无模型自抗扰控制方法 |
CN110531776A (zh) * | 2019-08-13 | 2019-12-03 | 北京理工大学 | 基于自抗扰控制技术的四旋翼飞行器位置控制方法和系统 |
CN115773569A (zh) * | 2023-02-10 | 2023-03-10 | 中国海洋大学 | 基于自抗扰解耦的海洋平台通风系统风量控制方法 |
CN115857419A (zh) * | 2023-03-02 | 2023-03-28 | 中国航发四川燃气涡轮研究院 | 一种大型高空台舱压模拟系统的多回路解耦控制方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103777641A (zh) * | 2014-02-19 | 2014-05-07 | 北京理工大学 | 飞行器跟踪控制的复合自抗扰控制方法 |
US20140195013A1 (en) * | 2002-04-18 | 2014-07-10 | Cleveland State University | Extended active disturbance rejection controller |
CN105607478A (zh) * | 2016-01-21 | 2016-05-25 | 北京理工大学 | 地球静止轨道航天器电推进转移轨道控制方法 |
CN105717936A (zh) * | 2014-11-30 | 2016-06-29 | 中国科学院沈阳自动化研究所 | 一种无缆自治水下机器人的潜浮控制方法 |
-
2017
- 2017-05-12 CN CN201710336025.2A patent/CN107132764A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20140195013A1 (en) * | 2002-04-18 | 2014-07-10 | Cleveland State University | Extended active disturbance rejection controller |
CN103777641A (zh) * | 2014-02-19 | 2014-05-07 | 北京理工大学 | 飞行器跟踪控制的复合自抗扰控制方法 |
CN105717936A (zh) * | 2014-11-30 | 2016-06-29 | 中国科学院沈阳自动化研究所 | 一种无缆自治水下机器人的潜浮控制方法 |
CN105607478A (zh) * | 2016-01-21 | 2016-05-25 | 北京理工大学 | 地球静止轨道航天器电推进转移轨道控制方法 |
Non-Patent Citations (4)
Title |
---|
任艳焱: "《自抗扰控制器解决多变量系统的耦合问题的研究》", 《赤峰学院学报(自然科学版)》 * |
刘海涛: "《空间绳网展开及复合体离轨动力学与控制》", 《中国优秀博士学位论文工程科技II辑2017年》 * |
姚瑶等: "《基于自抗扰控制技术的飞行器姿态控制》", 《第27届中国控制与决策会议论文集(下册)》 * |
王利桐: "《面对称飞行器姿态控制建模与仿真研究》", 《万方硕士论文数据库》 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108762097A (zh) * | 2018-07-27 | 2018-11-06 | 合肥工业大学 | 一种基于虚拟模型的跟踪抗扰控制方法 |
CN109683471A (zh) * | 2018-08-28 | 2019-04-26 | 杭州电子科技大学 | 自抗扰控制方法、装置和系统 |
CN109683471B (zh) * | 2018-08-28 | 2021-12-10 | 杭州电子科技大学 | 自抗扰控制方法、装置和系统 |
CN109709810A (zh) * | 2019-01-22 | 2019-05-03 | 天津大学 | 全方位移动机器人轨迹跟踪无模型自抗扰控制方法 |
CN110531776A (zh) * | 2019-08-13 | 2019-12-03 | 北京理工大学 | 基于自抗扰控制技术的四旋翼飞行器位置控制方法和系统 |
CN115773569A (zh) * | 2023-02-10 | 2023-03-10 | 中国海洋大学 | 基于自抗扰解耦的海洋平台通风系统风量控制方法 |
CN115857419A (zh) * | 2023-03-02 | 2023-03-28 | 中国航发四川燃气涡轮研究院 | 一种大型高空台舱压模拟系统的多回路解耦控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107132764A (zh) | 基于自抗扰控制技术的碎片抓捕后轨道转移控制方法 | |
CN101708780B (zh) | 用于目标姿态跟踪的刚性航天器的控制方法 | |
Tian et al. | Active disturbance rejection control based robust output feedback autopilot design for airbreathing hypersonic vehicles | |
CN104950677B (zh) | 基于反演滑模控制的机械臂系统饱和补偿控制方法 | |
CN110376882A (zh) | 基于有限时间扩张状态观测器的预定性能控制方法 | |
CN106773713A (zh) | 针对欠驱动海洋航行器的高精度非线性路径跟踪控制方法 | |
CN103439975B (zh) | 一种分布式指数时变滑模姿态协同跟踪控制方法 | |
Wu et al. | Quantized fixed-time fault-tolerant attitude control for hypersonic reentry vehicles | |
CN105159304A (zh) | 接近并跟踪空间非合作目标的有限时间容错控制方法 | |
CN105629732B (zh) | 一种考虑控制受限的航天器姿态输出反馈跟踪控制方法 | |
CN103112603B (zh) | 欠驱动高速自旋卫星建立正常姿态的方法 | |
CN107065564A (zh) | 一种基于自抗扰的中性浮力机器人姿态与轨迹控制方法 | |
CN107544262A (zh) | 一种运载火箭自适应精确回收控制方法 | |
CN105242683B (zh) | 一种飞艇神经网络终端滑模航迹控制方法 | |
CN107450328A (zh) | 一种基于e‑s滑模观测器的抗干扰容错控制方法 | |
CN105629734A (zh) | 一种近空间飞行器的轨迹跟踪控制方法 | |
CN104656447A (zh) | 一种航天器抗干扰姿态跟踪的微分几何非线性控制方法 | |
CN113361013B (zh) | 一种基于时间同步稳定的航天器姿态鲁棒控制方法 | |
Yang et al. | A new kind of nonlinear disturbance observer for nonlinear systems with applications to cruise control of air-breathing hypersonic vehicles | |
CN107193210A (zh) | 一种非线性系统的自适应学习预设性能控制方法 | |
Wang et al. | Adaptive Finite‐Time Control for a Flexible Hypersonic Vehicle with Actuator Fault | |
Li et al. | Anti-disturbance control for attitude and altitude systems of the helicopter under random disturbances | |
Dong et al. | Integrated finite-time disturbance observer and controller design for reusable launch vehicle in reentry phase | |
Zehong et al. | Adaptive accurate tracking control of HFVs in the presence of dead-zone and hysteresis input nonlinearities | |
CN105116905A (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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20170905 |
|
RJ01 | Rejection of invention patent application after publication |