CN115327925B - 一种基于扩张状态观测器的组合体姿态有限时间控制方法 - Google Patents
一种基于扩张状态观测器的组合体姿态有限时间控制方法 Download PDFInfo
- Publication number
- CN115327925B CN115327925B CN202211103652.9A CN202211103652A CN115327925B CN 115327925 B CN115327925 B CN 115327925B CN 202211103652 A CN202211103652 A CN 202211103652A CN 115327925 B CN115327925 B CN 115327925B
- Authority
- CN
- China
- Prior art keywords
- extended state
- state observer
- combined
- controller
- combined body
- 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 35
- 239000011159 matrix material Substances 0.000 claims description 31
- 238000013461 design Methods 0.000 claims description 11
- 230000008569 process Effects 0.000 claims description 5
- 102100039510 Cancer/testis antigen 2 Human genes 0.000 claims description 4
- 101000889345 Homo sapiens Cancer/testis antigen 2 Proteins 0.000 claims description 4
- 238000006073 displacement reaction Methods 0.000 claims description 3
- 229920001971 elastomer Polymers 0.000 claims description 3
- 239000000806 elastomer Substances 0.000 claims description 3
- 239000007788 liquid Substances 0.000 claims description 3
- 239000000463 material Substances 0.000 claims description 3
- 230000003068 static effect Effects 0.000 claims description 3
- 239000000758 substrate Substances 0.000 claims description 3
- 239000013598 vector Substances 0.000 claims description 3
- 230000000087 stabilizing effect Effects 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 3
- 238000011160 research Methods 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004140 cleaning Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000002441 reversible effect Effects 0.000 description 1
- 230000009897 systematic 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
- G05B13/042—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 in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开的一种基于扩张状态观测器的组合体姿态有限时间控制方法,属于航空航天技术领域。本发明实现方法为:通过设计扩张状态观测器跟踪组合体的状态,进而设计组合体有限时间控制器;所述组合体有限时间控制器采用双闭环姿态稳定控制器,内环以服务星的三轴惯性角速度为输入,利用二阶扩张状态观测器,输出不确定量的估计值,所述不确定量在外环反馈控制器输出控制量中加以补偿,能够提高姿态控制的精度;利用扩张状态观测器对实时观测得到的总扰动量进行快速估计和补偿,并通过有限时间控制方法加快组合体姿态稳定的收敛速度,提高捕获后组合体系统的抗干扰性和鲁棒性,实现对机械臂捕获大挠性失效卫星后的组合体的高精度姿态稳定控制。
Description
技术领域
本发明涉及一种基于扩张状态观测器的组合体姿态有限时间控制方法,尤其涉及一种面向空间机械臂捕获大挠性失效卫星后形成的组合体的基于扩张状态观测器的有限时间姿态控制方法,属于航空航天技术领域。
背景技术
随着航天事业的发展,在轨航天器的数目日益增多,随之而来的是大量空间碎片,例如失效卫星、火箭上面级等。这些空间碎片对空间环境产生了显著的影响,严重威胁着在轨航天器的安全、制约了人类对空间资源的可持续利用。因此,空间碎片清除问题已成为目前航天领域所面临的关键问题之一。目前已有多种清除方式被提出,其中较为典型的是基于空间机械臂的刚性捕获方式,该方式具有精度较高、捕获可控、抓捕操作可逆等优势。
目前已有许多学者面向利用空间机械臂实现失效卫星抓捕的过程开展了大量研究。值得注意的是,利用空间机械臂完成失效卫星抓捕后形成的组合体,由于机械臂和失效卫星帆板的大挠性特点,相比于抓捕完成前的“服务星+机械臂”系统,抓捕后形成的复杂多柔体系统存在系统参数跃变、失效卫星挠性附件模态及频率未知等问题,传统的动力学方法无法得到显式的动力学方程,面对未知扰动的控制系统也不能及时、快速地加以补偿。
发明内容
本发明的主要目的是提供一种基于扩张状态观测器的组合体姿态有限时间控制方法,通过设计扩张状态观测器跟踪组合体的状态,进而设计组合体有限时间控制器,利用扩张状态观测器对实时观测得到的总扰动量进行快速估计和补偿,并通过有限时间控制方法加快组合体姿态稳定的收敛速度,提高捕获后组合体系统的抗干扰性和鲁棒性,实现对机械臂捕获大挠性失效卫星后的组合体的高精度姿态稳定控制。
本发明的目的是通过下述技术方案实现的。
本发明公开的基于有限时间控制的失效卫星捕获后组合体姿态控制方法,包括以下步骤:
步骤一:基于广义惯性力的自动组集算法建立柔性多体系统的动力学方程,即利用组合体系统的偏速度矩阵、偏角速度矩阵和模态选择矩阵先得到单体对组合体系统广义惯性力的贡献,进一步得到单个柔体或刚体对组合体系统质量矩阵和广义惯性力非线性项的贡献,较之递推算法能够给出组合体系统显式的动力学方程,从而便于步骤二进行控制器设计。
基于广义惯性力的自动组集算法建立组合体系统的动力学方程为
其中:是系统总体的质量矩阵;u=[u1 T u2 T…un T]T,是系统广义速度依次排列组成的列阵;FA是系统的广义主动力,包括外界施加的力和力矩,以及弹性体的广义内力项;/>是系统广义惯性力的非线性项。其中,
其中,和/>是坐标系Fj相对于惯性系Fe的速度和角速度;/>和/>定义为坐标系Fj的偏速度矩阵和偏角速度矩阵,/>mj为体j的质量;Δj为体j的模态选择矩阵;/>为体j变形后相对于本体系的静矩;/>为体j的模态动量系数;Jj为体j变形后,相对于本体系的惯性张量;/>为体j变形后的模态角动量系数;Ej为模态质量,如果是正则模态,则为单位阵。
步骤二:基于步骤一建立的组合体系统的显式动力学方程,推导设计高精度高效率的扩张状态观测器,对实时观测得到的总扰动量进行快速估计和补偿,进而设计组合体有限时间控制器,加快组合体姿态稳定的收敛速度。通过在组合体系统姿态控制回路中增加扩张状态观测器和有限时间控制器,提高捕获后组合体系统的抗干扰性和鲁棒性,实现对机械臂捕获大挠性失效卫星后的组合体的高精度姿态稳定控制。
所述组合体有限时间控制器采用双闭环姿态稳定控制器。内环以服务星的三轴惯性角速度为输入,利用二阶扩张状态观测器,输出不确定量的估计值,所述不确定量在外环反馈控制器输出控制量中加以补偿,能够提高姿态控制的精度。
步骤2.1:基于建立的组合体系统的动力学方程推导得到关于角速度的一阶微分方程。
控制器设计模型由动力学方程推导为关于角速度ω的一阶微分方程
其中,Ub为控制量,为已知非线性项,ab(t)则为动力学方程中总的不确定量。其中,
Ub=B0T
ab(t)=Bfb(·)+ΔBT-ΔBfb(ω)
B=(I0t+ΔI0t)-1
ΔB=B-B0
其中,T为控制力矩;fb(·)为系统总的干扰量;I0t为系统总惯量矩阵中的已知部分,取为机械臂处于标称位置时不考虑弹性位移的相应取值。
步骤2.2:基于建立的组合体系统的动力学方程设计扩张状态观测器,采用内环补偿加外环反馈的双闭环控制。内环补偿环节采用二阶扩张状态观测器ESO2,对组合体系统的三个通道均配置相同结构相同参数的二阶扩张状态观测器ESO2:
eb0=zb1-Yb
其中,βb1>0、βb2>0、0<αb0<1、δb0均为标量。eb0、zb1、zb2、/>均为3×1的向量。其中,
Yb=ω=[ωx ωy ωz]T
需选取合适参数βb1,βb2,αb0,δb0,满足稳定性条件:
使得稳态时,状态zb2收敛于ab(t)。利用估计值zb2,对组合体系统实施动态反馈补偿律:
Ub=Ub0-zb2
外环反馈控制器设计为
其中,
其中,“s”表示“sin”,“c”表示“cos”。
通过所述扩张状态观测器对实时观测得到的总扰动量进行快速估计和补偿。
步骤2.3:在步骤2.2设计的扩张状态观测器基础上,对组合体系统的三个通道均采用有限时间控制律设计稳定的组合体有限时间控制器,加快组合体姿态稳定的收敛速度。
考虑非线性系统f(0)=0,x∈Rn,非线性系统存在一个定义在原点的领域上的C1光滑的函数V(x),并且存在实数c>0和0<α<1,使得V(x)在/>上正定和在/>上半负定,则该非线性系统的原点是有限时间稳定的。停息时间依赖于系统初始值x(0)=x0,其上界是
其中x0是原点某一开领域中的任何一点。如果并且V(x)是径向无界的(即,当||x||→+∞时,V(x)→+∞),则该非线性系统的原点是全局有限时间稳定的。
设计基于状态反馈的有限时间控制律
其中,α∈(0,1),
对每个通道均采用有限时间控制律,较之传统的PD控制器,收敛速度快、抗干扰和鲁棒性能好。
步骤2.3得到的有限时间控制器是稳定的,稳定性分析过程如下
选取正定Lyapunov函数
V(x1,x2)的一阶导数为
其中,
将上式带入,得V(x1,x2)沿着系统闭环轨迹的一阶导数为
由上式易见,对于固定的α∈(0,1),是连续的。且对于k>0,V(x1,x2)易证有如下性质
V(k2-αx1,kx2)=k3-αV(x1,x2)
观察V(x1,x2)和的表达式,若r>1,且s<1,则V和/>在集合
上均为正定,其中集合Ο为围绕原点的一个封闭曲线。
由于对于任意的存在k>0使得(k2-αx1,kx2)∈O。因此,由上述性质可得V正定,/>负定。
V为径向无限大函数,因此集合v={(x1,x2)|V(x1,x2)=1}是紧的。由于是连续的,易得/>在集合v上能够取到最大值。定义
由于易得c>0,且/>定义/>简记为/>由上述性质得
因此,得
因此,
得有限时间控制器能够在有限时间稳定至原点(0,0)。注意到V是径向无限大函数,易得有限时间控制器是全局稳定的。
有益效果:
1、本发明公开的一种基于扩张状态观测器的组合体姿态有限时间控制方法,通过设计扩张状态观测器跟踪组合体的状态,进而设计组合体有限时间控制器,利用扩张状态观测器对实时观测得到的总扰动量进行快速估计和补偿,并通过有限时间控制方法加快组合体姿态稳定的收敛速度,提高捕获后组合体系统的抗干扰性和鲁棒性,实现对机械臂捕获大挠性失效卫星后的组合体的高精度姿态稳定控制。
2、本发明公开的一种基于扩张状态观测器的组合体姿态有限时间控制方法,采用双闭环姿态稳定控制器。内环以服务星的三轴惯性角速度为输入,利用二阶扩张状态观测器,输出不确定量的估计值,所述不确定量在外环反馈控制器输出控制量中加以补偿,能够提高姿态控制的精度。
3、本发明公开的一种基于扩张状态观测器的组合体姿态有限时间控制方法,在设计的高精度高效率扩张状态观测器基础上,对组合体系统的三个通道均采用有限时间控制律设计稳定性的组合体有限时间控制器,加快组合体姿态稳定的收敛速度。对每个通道均采用有限时间控制律,较之传统的PD控制器,收敛速度快、抗干扰和鲁棒性能好。
4、本发明公开的一种基于扩张状态观测器的组合体姿态有限时间控制方法,将二阶扩张状态观测器与有限时间控制器相结合,能够对组合体系统未知扰动进行估计,并在控制中加以补偿,且能够使状态误差在有限时间内快速完成收敛,实现对组合体姿态的高精度控制。
5、本发明公开的一种基于扩张状态观测器的组合体姿态有限时间控制方法,基于广义惯性力的自动组集算法建立柔性多体系统的动力学模型,即利用系统的偏速度矩阵、偏角速度矩阵和模态选择矩阵先得到单体对系统广义惯性力的贡献,进一步得到单个柔体或刚体对系统质量矩阵和广义惯性力非线性项的贡献,较之递推算法能够给出系统显式的动力学方程,提高动力学方程求解的效率和精度,从而便于进行控制器设计,适应对实时性要求高的星载环境。
附图说明
图1为本发明实施例中捕获后组合体的构型图。
其中:A——服务星;B——失效卫星;10、13——刚性机械臂;11、12——柔性机械臂;21、31——服务星的柔性帆板;41、51——失效卫星的柔性帆板。
图2为本发明公开的一种基于扩张状态观测器的组合体姿态有限时间控制方法的总流程图。
图3为本发明公开的一种基于扩张状态观测器的组合体姿态有限时间控制方法的结构框图。
图4为本发明实施例中服务星本体的姿态角变化曲线图。
图5为本发明实施例中服务星本体的姿态角速度变化曲线图。
具体实施方式
下面结合实施例和附图对本发明公开的一种基于扩张状态观测器的组合体姿态有限时间控制方法作详细说明。
本实例所采用的仿真模型为图1所示的组合体模型,由边长2m的服务星及两块挠性帆板、6自由度机械、边长2m的失效卫星及两块挠性帆板组成。其中服务星、失效卫星和两端较短机械臂为刚体,服务星帆板与失效卫星帆板和中间两个较长机械臂视为柔体。
取本体星体质量Mb=1000kg,主轴转动惯量
目标星体质量MbT=1500kg,主轴转动惯量
帆板质量Mp=37.6546kg,几何参数取宽为bp=1.72m,长为hp=6.795m,厚为dp=0.002m。
考虑机械臂质量参数时,需要考虑铰接对系统质量参数的影响,假设机械臂的三处铰接质量均为Mjoint=1kg。机械臂的内径rm=0.03m,外径Rm=0.05m,材料密度ρ=7850kg/m3,长度尺寸参数分别为l10=0.2m,l11=1m,l12=1.2m,l13=0.3m。其中,机械臂10、11、12均为柱铰,机械臂13末端为3自由度球铰。
各组成部分几何尺寸参数和质量特性参数可以根据研究要求进行改变,但期望目标星体质量特性参数满足大于本体星体,柔性帆板尺寸几何参数大于星体本体以满足研究内容对大挠性附件的要求。
如图2所示,本实施例公开的一种基于扩张状态观测器的组合体姿态有限时间控制方法的总流程图,包括如下步骤:
步骤一:基于广义惯性力的自动组集算法建立柔性多体系统的动力学方程,即利用组合体系统的偏速度矩阵、偏角速度矩阵和模态选择矩阵先得到单体对组合体系统广义惯性力的贡献,进一步得到单个柔体或刚体对组合体系统质量矩阵和广义惯性力非线性项的贡献,较之递推算法能够给出组合体系统显式的动力学方程,从而便于步骤二进行控制器设计。
基于广义惯性力的自动组集算法建立组合体系统的动力学方程为
其中:u=[u1 T u2 T…un T]T,是系统广义速度依次排列组成的列阵,本实施例中的广义速度在表1中给出。是系统总体的质量矩阵;FA是系统的广义主动力,包括外界施加的力和力矩,以及弹性体的广义内力项;/>是系统广义惯性力的非线性项。
表1系统广义速度
其中,对于刚体部分,有
对于柔性体部分,有
其中,和/>是坐标系Fj相对于惯性系Fe的速度和角速度;/>和/>定义为坐标系Fj的偏速度矩阵和偏角速度矩阵,/>mj为体j的质量;Δj为体j的模态选择矩阵;/>为体j变形后相对于本体系的静矩;/>为体j的模态动量系数;Jj为体j变形后,相对于本体系的惯性张量;/>为体j变形后的模态角动量系数;Ej为模态质量,如果是正则模态,则为单位阵。
步骤二:基于步骤一建立的组合体系统的显式动力学方程,推导设计高精度高效率的扩张状态观测器,对实时观测得到的总扰动量进行快速估计和补偿,进而设计组合体有限时间控制器,加快组合体姿态稳定的收敛速度。通过在组合体系统姿态控制回路中增加扩张状态观测器和有限时间控制器,提高捕获后组合体系统的抗干扰性和鲁棒性,实现对机械臂捕获大挠性失效卫星后的组合体的高精度姿态稳定控制。
步骤2.1:控制器设计模型由动力学方程可推导为关于角速度ω的一阶微分方程
其中,Ub为控制量,为已知非线性项,ab(t)则为方程中总的不确定量。其中,
Ub=B0T
ab(t)=Bfb(·)+ΔBT-ΔBfb(ω)
B=(I0t+ΔI0t)-1
ΔB=B-B0
其中,T为控制力矩;fb(·)为系统总的干扰量;I0t为系统总惯量矩阵中的已知部分,可取为机械臂处于标称位置时不考虑弹性位移的相应取值。:
步骤2.2:设计扩张状态观测器跟踪组合体的状态,采用内环补偿加外环反馈的双闭环控制,对实时观测得到的总扰动量进行快速估计和补偿。
内环补偿环节采用二阶扩张状态观测器,对系统的三个通道均配置相同结构相同参数的二阶扩张状态观测器:
eb0=zb1-Yb
其中,βb1>0、βb2>0、0<αb0<1、δb0均为标量。eb0、zb1、zb1、zb2、zb2均为3×1的向量。其中,
Yb=ω=[ωx ωy ωz]T
需选取合适参数βb1,βb2,αb0,δb0,满足稳定性条件:
使得稳态时,状态zb2收敛于ab(t)。利用估计值zb2,对系统实施动态反馈补偿律:
Ub=Ub0-zb2
内环以服务星的三轴惯性角速度为输入,利用二阶扩张状态观测器,输出不确定量的估计值,所述不确定量在外环反馈控制器输出控制量中加以补偿,以提高姿态控制的精度。
外环反馈控制器设计为
其中,
其中“s”表示“sin”,“c”表示“cos”。
通过所述扩张状态观测器对实时观测得到的总扰动量进行快速估计和补偿。
步骤2.3:在步骤2.2设计的扩张状态观测器基础上,对组合体系统的三个通道均采用有限时间控制律设计稳定的组合体有限时间控制器,加快组合体姿态稳定的收敛速度。
设计基于状态反馈的有限时间控制律
其中α∈(0,1),
对每个通道均采用有限时间控制律,较之传统的PD控制器,收敛速度快、抗干扰和鲁棒性能好。
步骤2.3得到的有限时间控制器是稳定的,稳定性分析过程如下:
由上式易见,对于固定的α∈(0,1),是连续的。且对于k>0,V(x1,x2)易证有如下性质:
V(k2-αx1,kx2)=k3-αV(x1,x2)
观察V(x1,x2)和的表达式,若r>1,且s<1,则V和/>在集合
上均为正定,其中集合Ο为围绕原点的一个封闭曲线。
由于对于任意的存在k>0使得(k2-αx1,kx2)∈O。因此,由上述性质可得V正定,/>负定。
V为径向无限大函数,因此集合v={(x1,x2)|V(x1,x2)=1}是紧的。由于是连续的,易得/>在集合v上能够取到最大值。定义
由于易得c>0,且/>定义/>简记为/>由上述性质可得:
因此,可得:
因此,
能够得系统有限时间稳定至原点(0,0)。注意到V是径向无限大函数,易得系统是全局稳定的。
结合图3的基于扩张状态观测器的组合体姿态有限时间控制方法结构框图说明本实施例的实施方式,控制方法与实现方法与发明内容相同。
本实施例中考虑机械臂各关节锁定时的情况,仿真任务为服务星本体到达期望姿态。设置服务星初始姿态角为[π/35,π/60,-π/100]T,初始角速度为[0,0,0]T。本实施例中控制器参数设定如下:βb1=200,βb2=2,αb0=0.5,δb0=5×10-8,α=0.8。
经过50s仿真,结果表明,本实施例中,本发明公开的一种基于扩张状态观测器的组合体姿态有限时间控制方法能实现对组合体姿态的稳定控制。图4表明,本实施例中的控制方案能实现对于服务型本体的姿态稳定控制。图5表明服务星在控制器的作用下角速度能快速收敛到平衡点。
以上所述的具体描述,对发明的目的、技术方案和有益效果进行了进一步详细说明,所应理解的是,以上所述仅为本发明的具体实施例而已,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (1)
1.基于有限时间控制的失效卫星捕获后组合体姿态控制方法,其特征在于:包括以下步骤,
步骤一:基于广义惯性力的自动组集算法建立柔性多体系统的动力学方程,即利用组合体系统的偏速度矩阵、偏角速度矩阵和模态选择矩阵先得到单体对组合体系统广义惯性力的贡献,进一步得到单个柔体或刚体对组合体系统质量矩阵和广义惯性力非线性项的贡献,结合非线性项能够给出组合体系统显式的动力学方程,从而便于步骤二进行控制器设计;
步骤一实现方法为,
基于广义惯性力的自动组集算法建立组合体系统的动力学方程为
其中:是系统总体的质量矩阵;u=[u1 T u2 T … un T]T,是系统广义速度依次排列组成的列阵;FA是系统的广义主动力,包括外界施加的力和力矩,以及弹性体的广义内力项;/>是系统广义惯性力的非线性项;其中,
其中,和/>是坐标系Fj相对于惯性系Fe的速度和角速度;/>和/>定义为坐标系Fj的偏速度矩阵和偏角速度矩阵,/>mj为体j的质量;Δj为体j的模态选择矩阵;/>为体j变形后相对于本体系的静矩;/>为体j的模态动量系数;Jj为体j变形后,相对于本体系的惯性张量;/>为体j变形后的模态角动量系数;Ej为模态质量,如果是正则模态,则为单位阵;
步骤二:基于步骤一建立的组合体系统的显式动力学方程,推导设计高精度高效率的扩张状态观测器,对实时观测得到的总扰动量进行快速估计和补偿,进而设计组合体有限时间控制器,加快组合体姿态稳定的收敛速度;通过在组合体系统姿态控制回路中增加扩张状态观测器和有限时间控制器,提高捕获后组合体系统的抗干扰性和鲁棒性,实现对机械臂捕获大挠性失效卫星后的组合体的高精度姿态稳定控制;
所述组合体有限时间控制器采用双闭环姿态稳定控制器;内环以服务星的三轴惯性角速度为输入,利用二阶扩张状态观测器,输出不确定量的估计值,所述不确定量在外环反馈控制器输出控制量中加以补偿,能够提高姿态控制的精度;
步骤二实现方法为,
步骤2.1:基于建立的组合体系统的动力学方程推导得到关于角速度的一阶微分方程;
控制器设计模型由动力学方程推导为关于角速度ω的一阶微分方程
其中,Ub为控制量,为已知非线性项,ab(t)则为动力学方程中总的不确定量;其中,Ub=B0T
ab(t)=Bfb(·)+ΔBT-ΔBfb(ω)
B=(I0t+ΔI0t)-1
ΔB=B-B0
其中,T为控制力矩;fb(·)为系统总的干扰量;I0t为系统总惯量矩阵中的已知部分,取为机械臂处于标称位置时不考虑弹性位移的相应取值;
步骤2.2:基于建立的组合体系统的动力学方程设计扩张状态观测器,采用内环补偿加外环反馈的双闭环控制;内环补偿环节采用二阶扩张状态观测器ESO2,对组合体系统的三个通道均配置相同结构相同参数的二阶扩张状态观测器ESO2:
eb0=zb1-Yb
其中,βb1>0、βb2>0、0<αb0<1、δb0均为标量;eb0、zb1、zb2、/>均为3×1的向量;其中,
Yb=ω=[ωx ωy ωz]T
需选取合适参数βb1,βb2,αb0,δb0,满足稳定性条件:
使得稳态时,状态zb2收敛于ab(t);利用估计值zb2,对组合体系统实施动态反馈补偿律:
Ub=Ub0-zb2
外环反馈控制器设计为
其中,
其中,“s”表示“sin”,“c”表示“cos”;
通过所述扩张状态观测器对实时观测得到的总扰动量进行快速估计和补偿;
步骤2.3:在步骤2.2设计的扩张状态观测器基础上,对组合体系统的三个通道均采用有限时间控制律设计稳定的组合体有限时间控制器,加快组合体姿态稳定的收敛速度;
考虑非线性系统f(0)=0,x∈Rn,非线性系统存在一个定义在原点的领域上的C1光滑的函数V(x),并且存在实数c>0和0<α<1,使得V(x)在/>上正定和在/>上半负定,则该非线性系统的原点是有限时间稳定的;停息时间依赖于系统初始值x(0)=x0,其上界是
其中x0是原点某一开领域中的任何一点;如果并且V(x)是径向无界的,即当||x||→+∞时,V(x)→+∞,则该非线性系统的原点是全局有限时间稳定的;
设计基于状态反馈的有限时间控制律
其中,α∈(0,1),
对每个通道均采用有限时间控制律,较之传统的PD控制器,收敛速度快、抗干扰和鲁棒性能好;
步骤2.3得到的有限时间控制器是稳定的,稳定性分析过程如下
选取正定Lyapunov函数
V(x1,x2)的一阶导数为
其中,
将上式带入,得V(x1,x2)沿着系统闭环轨迹的一阶导数为
由上式易见,对于固定的α∈(0,1),是连续的;且对于k>0,V(x1,x2)易证有如下性质
V(k2-αx1,kx2)=k3-αV(x1,x2)
观察V(x1,x2)和的表达式,若r>1,且s<1,则V和/>在集合
上均为正定,其中集合Ο为围绕原点的一个封闭曲线;
由于对于任意的存在k>0使得(k2-αx1,kx2)∈O;因此,由上述性质可得V正定,/>负定;
V为径向无限大函数,因此集合v={(x1,x2)|V(x1,x2)=1}是紧的;由于是连续的,易得/>在集合v上能够取到最大值;定义
由于易得c>0,且/>定义/>简记为/>由上述性质得
因此,得
因此,
得有限时间控制器能够在有限时间稳定至原点(0,0);注意到V是径向无限大函数,易得有限时间控制器是全局稳定的。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211103652.9A CN115327925B (zh) | 2022-09-09 | 2022-09-09 | 一种基于扩张状态观测器的组合体姿态有限时间控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211103652.9A CN115327925B (zh) | 2022-09-09 | 2022-09-09 | 一种基于扩张状态观测器的组合体姿态有限时间控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115327925A CN115327925A (zh) | 2022-11-11 |
CN115327925B true CN115327925B (zh) | 2023-12-15 |
Family
ID=83930392
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211103652.9A Active CN115327925B (zh) | 2022-09-09 | 2022-09-09 | 一种基于扩张状态观测器的组合体姿态有限时间控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115327925B (zh) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE10342866A1 (de) * | 2003-09-15 | 2005-04-21 | Eads Astrium Gmbh | Verfahren zur Lagebestimmung eines Raumfahrzeuges mit Hilfe eines Richtungsvektors und einer Gesamtdrallmessung |
CN105468007A (zh) * | 2015-12-02 | 2016-04-06 | 哈尔滨工业大学 | 一种基于干扰观测器的挠性卫星轨迹线性化姿态控制方法 |
CN108196445A (zh) * | 2017-12-11 | 2018-06-22 | 西北工业大学 | 一种基于双闭环自抗扰的水下机器人姿态与位置控制方法 |
CN109426147A (zh) * | 2017-08-23 | 2019-03-05 | 中国空气动力研究与发展中心计算空气动力研究所 | 捕获卫星后组合航天器的自适应增益调整控制方法 |
CN110376882A (zh) * | 2019-04-28 | 2019-10-25 | 天津大学 | 基于有限时间扩张状态观测器的预定性能控制方法 |
CN110844122A (zh) * | 2019-11-20 | 2020-02-28 | 中山大学 | 一种约束姿态跟踪误差的卫星姿态控制方法 |
CN114047773A (zh) * | 2021-11-26 | 2022-02-15 | 江西理工大学 | 一种基于扩张状态观测器的水下集矿机器人反步滑模自适应姿态控制方法 |
-
2022
- 2022-09-09 CN CN202211103652.9A patent/CN115327925B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE10342866A1 (de) * | 2003-09-15 | 2005-04-21 | Eads Astrium Gmbh | Verfahren zur Lagebestimmung eines Raumfahrzeuges mit Hilfe eines Richtungsvektors und einer Gesamtdrallmessung |
CN105468007A (zh) * | 2015-12-02 | 2016-04-06 | 哈尔滨工业大学 | 一种基于干扰观测器的挠性卫星轨迹线性化姿态控制方法 |
CN109426147A (zh) * | 2017-08-23 | 2019-03-05 | 中国空气动力研究与发展中心计算空气动力研究所 | 捕获卫星后组合航天器的自适应增益调整控制方法 |
CN108196445A (zh) * | 2017-12-11 | 2018-06-22 | 西北工业大学 | 一种基于双闭环自抗扰的水下机器人姿态与位置控制方法 |
CN110376882A (zh) * | 2019-04-28 | 2019-10-25 | 天津大学 | 基于有限时间扩张状态观测器的预定性能控制方法 |
CN110844122A (zh) * | 2019-11-20 | 2020-02-28 | 中山大学 | 一种约束姿态跟踪误差的卫星姿态控制方法 |
CN114047773A (zh) * | 2021-11-26 | 2022-02-15 | 江西理工大学 | 一种基于扩张状态观测器的水下集矿机器人反步滑模自适应姿态控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN115327925A (zh) | 2022-11-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110794863B (zh) | 一种控制性能指标可定制的重型运载火箭姿态控制方法 | |
Zou et al. | Fixed-time attitude tracking control for rigid spacecraft | |
Zhong et al. | Attitude control for flexible spacecraft with disturbance rejection | |
Ulrich et al. | Modeling and direct adaptive control of a flexible-joint manipulator | |
Luo et al. | Inverse optimal adaptive control for attitude tracking of spacecraft | |
Zhang et al. | Extended state observer based robust adaptive control on SE (3) for coupled spacecraft tracking maneuver with actuator saturation and misalignment | |
Xiao et al. | Reaction wheel fault compensation and disturbance rejection for spacecraft attitude tracking | |
CN111506095B (zh) | 一种双刚体特征点间饱和固定时间相对位姿跟踪控制方法 | |
Wang et al. | Fault‐tolerant spacecraft attitude control under actuator saturation and without angular velocity | |
Xiao et al. | A general tracking control framework for uncertain systems with exponential convergence performance | |
Chen et al. | Sliding-mode-based attitude tracking control of spacecraft under reaction wheel uncertainties | |
Yu | Hybrid-trajectory based terminal sliding mode control of a flexible space manipulator with an elastic base | |
Tang et al. | Integrated control method for spacecraft considering the flexibility of the spacecraft bus | |
CN115327925B (zh) | 一种基于扩张状态观测器的组合体姿态有限时间控制方法 | |
Muralidharan et al. | Rendezvous and attitude synchronization of a space manipulator | |
Holguin et al. | Guidance and control for spacecraft autonomous rendezvous and proximity maneuvers using a geometric mechanics framework | |
CN113485396B (zh) | 一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制方法 | |
CN116203842A (zh) | 运载火箭的自适应容错反步姿态控制设计方法 | |
Sun et al. | Finite-time integrated target tracking for spacecraft with two-dimensional turntable under performance constraints | |
Toriumi et al. | Passivity-based nonlinear control approach for tracking task of an underactuated CMG | |
Hong et al. | A hybrid PID controller for flexible joint manipulator based on state observer and singular perturbation approach | |
CN114229039A (zh) | 一种充液柔性航天器自适应无角速度复合控制方法 | |
Torres et al. | A super-twisting sliding mode control in a backstepping setup for rendezvous with a passive target | |
Tian et al. | Analysis and evaluation on unloading ratio of zero-g simulation system based on torques of space manipulator | |
Ulrich et al. | Nonlinear adaptive output feedback control of flexible-joint space robot manipulators |
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 |