CN109062043B - 考虑网络传输以及执行器饱和的航天器自抗扰控制方法 - Google Patents

考虑网络传输以及执行器饱和的航天器自抗扰控制方法 Download PDF

Info

Publication number
CN109062043B
CN109062043B CN201810865053.8A CN201810865053A CN109062043B CN 109062043 B CN109062043 B CN 109062043B CN 201810865053 A CN201810865053 A CN 201810865053A CN 109062043 B CN109062043 B CN 109062043B
Authority
CN
China
Prior art keywords
spacecraft
matrix
saturation
follows
nonlinear
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
Application number
CN201810865053.8A
Other languages
English (en)
Other versions
CN109062043A (zh
Inventor
袁源
于洋
袁建平
孙冲
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Northwestern Polytechnical University
Original Assignee
Northwestern Polytechnical University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Northwestern Polytechnical University filed Critical Northwestern Polytechnical University
Priority to CN201810865053.8A priority Critical patent/CN109062043B/zh
Publication of CN109062043A publication Critical patent/CN109062043A/zh
Application granted granted Critical
Publication of CN109062043B publication Critical patent/CN109062043B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive 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/042Adaptive 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
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • B64G1/244Spacecraft control systems
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive 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/048Adaptive 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 using a predictor

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • General Physics & Mathematics (AREA)
  • Artificial Intelligence (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Physics & Mathematics (AREA)
  • Health & Medical Sciences (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Remote Sensing (AREA)
  • Combustion & Propulsion (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Chemical & Material Sciences (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种考虑网络传输以及执行器饱和的航天器自抗扰控制方法,首先通过设计跟踪微分器为系统的期望姿态安排合适的过渡过程,同时获取期望值得微分信号为后续控制器设计做准备;然后利用网络协议输出的姿态角测量信号设计非线性采样扩张状态观测器,对航天器系统中的状态以及耦合、外部干扰等形成的非线性不确定项进行实时估计,并将非线性不确定项的估计值补偿到含有抗饱和补偿器的误差反馈控制率中;本发明不仅能够避免内外干扰等非线性因素对系统造成不利影响,又能够确保执行机构在饱和范围内对航天器姿态实施精准地控制,为空间操作任务的顺利完成提供保障。本发明具有良好的控制效果,并且可广泛应用于其他非线性网络化控制系统中。

Description

考虑网络传输以及执行器饱和的航天器自抗扰控制方法
技术领域
本发明属于空间机器人网络化控制系统伺服控制领域,涉及一种考虑网络传输以及执行器饱和的航天器自抗扰控制方法。
背景技术
航天器姿态控制是航天器在规定或预先确定的参考方向上定向的过程,但由于在轨运行的航天器不可避免地受到重力梯度力矩、太阳光压力矩、气动力矩等各种外部环境的干扰以及有效载荷活动部件的转动、飞轮安装误差及难于精确建模的摩擦、挠性结构的耦合等内部干扰。因此,航天器姿态控制是一个多输入多输出、强耦合的不确定非线性系统。为了确保对复杂环境下的航天器实施精准的姿态控制,目前相关研究人员已提出PID控制、滑模控制、最优控制等控制策略。其中,PID控制方法虽然简单有效,随着对控制精度要求的不断提高和系统特性的复杂多变,PID控制显示了其不足之处;滑模控制鲁棒性强,干扰抑制效果较好,但是会出现系统输出抖振等现象,在要求高精度的航天器姿态控制中,这种抖动是不能容忍的;最优控制是依赖于模型设计的,鲁棒性不强的控制策略,这从一定程度上限制了它在要求高可靠性的航天工程领域的应用。同时随着计算机网络技术的发展,网络和控制结合的技术也日趋成熟。网络化控制系统体现出较高的诊断能力,安装、扩展与维护的便捷性,实现资源共享和远程控制,降低系统重量和体积,增强系统的灵活性和可靠性等优点,并已在智能交通、楼宇自动化、航天器等领域中得到广泛应用。但是采用网络传输信息会引入丢包、延迟等问题,影响系统稳定性。除此之外,为了确保航天器在规定范围内运行,其执行机构会受到一定的饱和约束。因此,在信号网络化传输条件下,寻求一种不基于精准模型的抗干扰主动控制方法,确保航天器系统在安全范围内完成定向任务显得尤为重要。
自二十世纪九十年代不基于系统模型的自抗扰控制技术被提出以来,其已被广泛应用于非线性最小相位系统、非最小相位系统、分数阶系统、多输入多输出系统等复杂非线性系统中。自抗扰控制技术的主要核心思想为:利用系统的测量输出信息,对系统状态以及由未建模动态和内外干扰形成的非线性不确定项进行实时估计,并将非线性不确定项的估计值补偿到误差反馈控制器中,从而实现了系统的动态反馈线性化。
发明内容
本发明的目的在于针对航天器姿态控制受网络传输影响、内外扰动影响及控制饱和约束影响等问题,提供一种考虑网络传输以及执行器饱和的航天器自抗扰控制方法,该方法用于解决带有执行器饱和及外部干扰等时变非线性不确定项的航天器姿态控制,保证其在自身安全范围内顺利完成空间定向任务。
为达到上述目的,本发明采用以下技术方案予以实现:
考虑网络传输以及执行器饱和的航天器自抗扰控制方法,其特征在于,包括以下步骤:
第一步:构建带有执行器饱和的航天器系统姿态动力学模型;
第二步:设计跟踪微分器;
第三步:设计非线性采样扩张状态观测器,估计系统状态和非线性不确定项;
第四步:设计复合控制器;
第五步:求解航天器姿态跟踪误差状态的收敛域以及抗饱和系数。
本发明进一步的改进在于:
步骤一中,航天器近似为刚体,由动量矩定理,将其动力学方程写成:
Figure BDA0001750706930000031
其中,J=diag(Jx,Jy,Jz)为沿航天器本体主惯量轴的转动惯量矩阵,diag(·)表示对角矩阵,ω=[ωxyz]T为航天器相对惯性坐标系的瞬时转速在本体坐标系中的矢量,上标T表示向量或者矩阵转置,定义斜对称矩阵S(ω)为:
Figure BDA0001750706930000032
d(t)=[dx,dy,dz]T为作用在航天器上的外干扰力矩矢量,sat(u(t))=[sat(u1),sat(u2),sat(u3)]T为饱和控制力矩矢量,sat(uj(t)),j=1,2,3的具体表达式如下:
sat(uj(t))=sign(uj(t))min(|uj(t)|,1)
其中,sign(·)为符号函数:如果uj(t)>0,sign(uj(t))=1;uj(t)=0,sign(uj(t))=0;uj(t)<0,sign(uj(t))=-1;
采用欧拉角描述航天器的姿态,其运动学方程为:
Figure BDA0001750706930000033
其中,
Figure BDA0001750706930000034
θ和ψ分别为航天器的滚转角、俯仰角和偏航角,
Figure BDA0001750706930000035
Figure BDA0001750706930000036
分别为航天器的滚转角速度、俯仰角速度和偏航角速度;
联立式(1)和(2),得到带有执行器饱和的航天器姿态动力学模型:
Figure BDA0001750706930000037
其中,
Figure BDA0001750706930000038
为系统状态,并且
Figure BDA0001750706930000039
f(x(t))=[fx,fy,fz]T为系统中耦合以及外部干扰带来的非线性不确定项,并且:
Figure BDA0001750706930000041
Figure BDA0001750706930000042
Figure BDA0001750706930000043
系数矩阵A1、B1和C1分别为:
Figure BDA0001750706930000044
Bp=diag(b1,b2,b3),
Figure BDA0001750706930000045
其中,03×3和I3×3分别表示三阶零矩阵和三阶单位矩阵。
步骤二中,跟踪微分器如下:
Figure BDA0001750706930000046
其中,
Figure BDA0001750706930000047
为航天器姿态角的期望值并作为跟踪微分器的输入信号,v1(t)=[v11(t),v12(t),v13(t)]T和v2(t)=[v21(t),v22(t),v23(t)]T为跟踪微分器的输出信号,并且v1(t)是x1d(t)的跟踪信号,v2(t)是x1d(t)的近似微分信号,r0和h分别为跟踪微分器的速度因子和滤波因子;
fhan(t,r0,h)=[fhan1(t,r0,h),fhan2(t,r0,h),fhan3(t,r0,h)]T,并且fhanj(t,r0,h)的表达式为:
Figure BDA0001750706930000051
忽略跟踪微分器对信号造成的误差,即假设x1d(t)=v1(t),
Figure BDA0001750706930000052
步骤三设计非线性采样扩张状态观测器,估计系统状态和非线性不确定项的具体方法如下:
首先,设饱和函数sat(uj(t))的近似函数
Figure BDA0001750706930000053
如下所示:
Figure BDA0001750706930000054
式中,
Figure BDA0001750706930000055
ε0为正常数;
该饱和函数
Figure BDA0001750706930000056
连续可导,并且满足
Figure BDA0001750706930000057
和dsat(uj(t))/duj(t)≤1;
因此,原带有执行器饱和的航天器系统(3)改写为:
Figure BDA0001750706930000058
其中,
Figure BDA0001750706930000059
并且:
Figure BDA00017507069300000510
Figure BDA0001750706930000061
Figure BDA0001750706930000062
利用网络协议获取测量信号并设计非线性采样扩张状态观测器形式如式(6)所示:
Figure BDA0001750706930000063
其中,
Figure BDA0001750706930000064
为非线性采样扩张状态观测器的输出状态,且z1(t)=[z11(t),z12(t),z13(t)]T,z2(t)=[z21(t),z22(t),z23(t)]T,z3(t)=[z31(t),z32(t),z33(t)]T
Figure BDA0001750706930000065
表示
Figure BDA0001750706930000066
Λ=diag(εI3×3,I3×3-1I3×3),ε为非线性采样扩张状态观测器的可调参数,η(t)∈R3为两次网络传输时刻间的系统输出预测值,R3表示三维实向量空间,
Figure BDA0001750706930000067
表示
Figure BDA0001750706930000068
表示关于
Figure BDA0001750706930000069
的非线性函数,R9表示九维实向量空间,
Figure BDA00017507069300000610
表示正整数,hy(i,ey(ti))为网络协议,系数矩阵A2和B2分别为:
Figure BDA00017507069300000611
步骤四中,设计复合控制器的具体方法如下:
根据非线性采样扩张状态观测器(6)的观测值z1(t)和z2(t)以及跟踪微分器的输出值v1(t)和v2(t),设误差信号:
Figure BDA0001750706930000071
其中,r1(t)=[r11(t),r12(t),r13(t)]T和r2(t)=[r21(t),r22(t),r23(t)]T
基于以上误差信号(7)和非线性采样扩张状态观测器(6)对系统中非线性不确定项的估计值z3(t),并且考虑执行器饱和问题,该航天器系统(4)中的复合制器设计为:
Figure BDA0001750706930000072
其中,
Figure BDA0001750706930000073
是关于误差r1(t)和r2(t)的非线性函数,设
Figure BDA0001750706930000074
且:
Figure BDA0001750706930000075
K为控制器可调增益,λ(sat(u(t))-u(t))为抗饱和补偿器,λ为抗饱和系数。
步骤五中,求解航天器姿态跟踪误差状态的收敛域以及抗饱和系数的具体方法如下:
考虑航天器姿态跟踪误差状态r(t),如果存在正定对称矩阵P2∈R6×6,正定对角矩阵S1∈R3×3和S2∈R3×3,矩阵H∈R3×6,正实数R1和ρ,使以下凸最优问题:
Figure BDA0001750706930000076
有最优解;则,区域Ω(P2,ρ)={r(t)∈R6:rT(t)P2r(t)≤ρ}为跟踪误差状态r(t)的收敛域;
其中,Rm×n表示m×n维实矩阵空间,c为模型参数,其由模型参数求得,γ=ρ-1,wj为矩阵
Figure BDA0001750706930000081
的行向量,I6×6为六阶单位矩阵,03×6为三行六列零矩阵,Θ11=(P2A1+R0P2C1K)+(P2A1+R0P2C1K)T+3P2
Figure BDA0001750706930000082
Figure BDA0001750706930000083
Θ33=-R1I3×3,trace(P2)表示矩阵P2的迹,符号*表示对称矩阵中的转置项。
与现有技术相比,本发明具有以下有益效果:
首先,本发明利用通过网络协议获取的测量信号设计非线性采样扩张状态观测器,对系统所有状态以及非线性不确定项进行实时估计;其次,将非线性不确定项的估计值补偿到含有抗饱和补偿器的状态反馈控制器中,即抑制了内外扰动对航天器姿态的影响,又避免执行机构过饱和对系统造成损坏;最后求解线性矩阵不等式的方法求解系统的安全域以及控制器中的抗饱和系数。所设计方法解决了航天器网络化控制系统所面临的网络传输、内外扰动以及执行器饱和问题,确保航天器网络化控制系统在安全范围内实现精准的姿态控制,提高了系统的鲁棒稳定性。
进一步的,本发明利用跟踪微分器安排过渡过程,避免了因初始误差过大而造成的输出超调现象,对航天器起到一定的保护作用。
进一步的,本发明利用系统的网络传输信号设计非线性采样扩张状态观测器,对系统中的状态以及非线性不确定项进行实时估计。
进一步的,本发明将非线性不确定项的估计值补偿到跟踪误差反馈控制器中,并设计抗饱和补偿器,构成复合控制器,即克服了非线性不确定项对系统造成的不利影响,提高系统的鲁棒性,又避免了执行器饱和现象,便于在安全范围内实现航天器姿态控制。
附图说明
图1为本发明基于采样扩张状态观测器的航天器网络化控制系统自抗扰姿态控制流程图。
图2为本发明基于采样扩张状态观测器的航天器网络化控制系统自抗扰姿态控制方框图。
具体实施方式
下面结合附图对本发明做进一步详细描述:
参见图1,本发明考虑网络传输以及执行器饱和的航天器自抗扰控制方法,包括以下步骤:
第一步:构建带有执行器饱和的航天器系统姿态动力学模型
本发明考虑的航天器近似为刚体,由动量矩定理,可将其动力学方程写成
Figure BDA0001750706930000091
其中,J=diag(Jx,Jy,Jz)为沿航天器本体主惯量轴的转动惯量矩阵,diag(·)表示对角矩阵,ω=[ωxyz]T为航天器相对惯性坐标系的瞬时转速在本体坐标系中的矢量,上标T表示向量或者矩阵转置,定义斜对称矩阵S(ω)为
Figure BDA0001750706930000092
d(t)=[dx,dy,dz]T为作用在航天器上的外干扰力矩矢量,sat(u(t))=[sat(u1),sat(u2),sat(u3)]T为饱和控制力矩矢量,sat(uj(t)),j=1,2,3的具体表达式如下:
sat(uj(t))=sign(uj(t))min(|uj(t)|,1)
其中,sign(·)为符号函数:如果uj(t)>0,sign(uj(t))=1;uj(t)=0,sign(uj(t))=0;uj(t)<0,sign(uj(t))=-1。
采用3-1-2转序的欧拉角描述航天器的姿态,其运动学方程为:
Figure BDA0001750706930000101
其中,
Figure BDA0001750706930000102
θ和ψ分别为航天器的滚转角、俯仰角和偏航角,
Figure BDA0001750706930000103
Figure BDA0001750706930000104
分别为航天器的滚转角速度、俯仰角速度和偏航角速度。
联立式(10)和(11),可得带有执行器饱和的航天器姿态动力学模型:
Figure BDA0001750706930000105
其中,
Figure BDA0001750706930000106
为系统状态,并且
Figure BDA0001750706930000107
f(x(t))=[fx,fy,fz]T为系统中耦合以及外部干扰带来的非线性不确定项,并且
Figure BDA0001750706930000108
Figure BDA0001750706930000109
Figure BDA00017507069300001010
系数矩阵A1、B1和C1分别为
Figure BDA00017507069300001011
Bp=diag(b1,b2,b3),
Figure BDA00017507069300001012
其中,03×3和I3×3分别表示三阶零矩阵和三阶单位矩阵。
第二步:设计跟踪微分器
一方面为了避免初始时刻航天器系统实际输出姿态角与期望值偏差过大而造成系统输出超调;另一方面为了获取姿态角的微分信号为设计控制器做准备,设计跟踪微分器如下所示:
Figure BDA0001750706930000111
其中,v1(t)=[v11(t),v12(t),v13(t)]T和v2(t)=[v21(t),v22(t),v23(t)]T为跟踪微分器的输出信号,v1(t)和v2(t)分别是x1d(t)的跟踪信号以及x1d(t)的近似微分信号,fhan(t,r0,h)=[fhan1(t,r0,h),fhan2(t,r0,h),fhan3(t,r0,h)]T,并且fhanj(t,r0,h)的表达式为
Figure BDA0001750706930000112
本实例中,设航天器姿态角的期望值为:
Figure BDA0001750706930000113
跟踪微分器的速度因子r0和滤波因子h分别设为20和0.01,则,可通过跟踪微分器(13)获取x1d(t)的跟踪信号v1(t)和x1d(t)的近似微分信号v2(t),为后续控制器设计做准备。
在此,忽略跟踪微分器对信号造成的误差,即假设x1d(t)=v1(t),
Figure BDA0001750706930000114
第三步:设计非线性采样扩张状态观测器,估计系统状态和非线性不确定项
首先,由于系统中的非线性不确定项f(x(t))中含有饱和函数sat(uj(t)),因此该非线性不确定项存在微分无法求解的问题。为了解决此问题,设饱和函数sat(uj(t))的近似函数
Figure BDA0001750706930000115
如下所示:
Figure BDA0001750706930000116
式中,
Figure BDA0001750706930000121
ε0为正常数。
该饱和函数
Figure BDA0001750706930000122
连续可导,并且满足
Figure BDA0001750706930000123
和dsat(uj(t))/duj(t)≤1。
因此,原带有执行器饱和的航天器系统(12)改写为:
Figure BDA0001750706930000124
其中,
Figure BDA0001750706930000125
并且
Figure BDA0001750706930000126
Figure BDA0001750706930000127
Figure BDA0001750706930000128
考虑航天器三个姿态角的测量值通过一定的网络协议进行传输,为了解决有限带宽资源分配问题以及避免网络造成系统不稳定问题,本发明利用网络协议获取测量信号并设计非线性采样扩张状态观测器形式如下所示:
Figure BDA0001750706930000129
其中,
Figure BDA00017507069300001210
为非线性采样扩张状态观测器的输出状态,且z1(t)=[z11(t),z12(t),z13(t)]T,z2(t)=[z21(t),z22(t),z23(t)]T,z3(t)=[z31(t),z32(t),z33(t)]T
Figure BDA00017507069300001211
表示
Figure BDA0001750706930000131
Λ=diag(εI3×3,I3×3-1I3×3),0<ε<1,hy(i,ey(ti))为网络协议,通过该协议来决定哪个传感器传输测量数据,η(t)∈R3为两次网络传输间的预测值,当满足一定的网络协议时对应的预测值会更新一次,R3表示三维实向量空间,
Figure BDA0001750706930000132
表示
Figure BDA0001750706930000133
Figure BDA0001750706930000134
表示正整数。在本实例中选取ε=0.08,网络传输方式采用循环调度协议,即hy(i,ey(ti))=(I3×3-Δ(i))ey
其中,Δ(i)=diag(Δ1(i),Δ2(i),Δ2(i)),并且
Figure BDA0001750706930000135
为了便于表示,设
Figure BDA0001750706930000136
χ(t)=[χ1(t),χ2(t),χ3(t)]T∈R3,则
h0(χ(t))=[h1(χ(t)),h2(χ(t)),h3(χ(t))]T∈R9,hj(χ(t))表示关于χ(t)的函数,R9表示九维实向量空间。
在本实例中设h1(χ(t))=β1χ(t)+g(χ(t)),可调增益β1=diag(3,3,3),非线性函数g(χ(t))设为g(χ(t))=[g11(t)),g22(t)),g33(t))]T,且
Figure BDA0001750706930000137
h2(χ(t))=β2χ(t),可调增益β2=diag(5,5,5),h3(χ(t))=β3χ(t),可调增益β3=diag(3,3,3),
系数矩阵A2和B2分别为
Figure BDA0001750706930000138
第四步:设计复合控制器
一方面为了实现对航天器精准的姿态控制,本发明中控制器采用误差反馈控制形式,并将非线性采样扩张状态观测器估计出的非线性不确定项实时补偿到控制器中;另一方面为了对航天器中的执行机构起到一定的保护作用,本发明考虑执行器饱和问题,并采用抗饱和补偿措施。
根据非线性采样扩张状态观测器(15)的观测值z1(t)和z2(t)以及跟踪微分器的输出值v1(t)和v2(t),设误差信号:
Figure BDA0001750706930000141
其中,r1(t)=[r11(t),r12(t),r13(t)]T和r2(t)=[r21(t),r22(t),r23(t)]T
基于以上误差信号(16)和非线性采样扩张状态观测器(15)对系统中非线性不确定项的估计值z3(t),并且考虑执行器饱和问题,该航天器系统(14)中的复合制器设计为:
Figure BDA0001750706930000142
本实例中设可调控制增益K=[k1,k2],选取k1=diag(100,65,63),k2=diag(20,30,30),
Figure BDA0001750706930000143
是关于误差r1(t)和r2(t)的非线性函数,为了便于表示,设
Figure BDA0001750706930000144
且:
Figure BDA0001750706930000145
可调参数Bp=diag(120,120,120),λ(sat(u(t))-u(t))为抗饱和补偿器,λ为抗饱和系数。
第五步:求解航天器姿态跟踪误差状态的安全区域以及抗饱和系数
考虑航天器姿态跟踪误差状态r(t),如果存在正定对称矩阵P2∈R6×6,正定对角矩阵S1∈R3×3和S2∈R3×3,矩阵H∈R3×6,正实数R1和ρ,使以下凸最优问题
Figure BDA0001750706930000151
有最优解。则,区域Ω(P2,ρ)={r(t)∈R6:rT(t)P2r(t)≤ρ}为跟踪误差状态r(t)的收敛域。
其中,Rm×n表示m×n维实矩阵空间,γ=ρ-1,wj为矩阵
Figure BDA0001750706930000152
的行向量,I6×6为六阶单位矩阵,03×6为三行六列零矩阵,Θ11=(P2A1+R0P2C1K)+(P2A1+R0P2C1K)T+3P2
Figure BDA0001750706930000153
Figure BDA0001750706930000154
Θ33=-R1I3×3,trace(P2)表示矩阵P2的迹,符号*表示对称矩阵中的转置项。
本实例中设参数c=5并结合系统其他给定参数,可以通过求解线性矩阵不等式(18)获取跟踪误差状态r(t)的最大收敛域Ω(P2,ρ)={r(t)∈R6:rT(t)P2r(t)≤ρ}以及抗饱和系数λ。
以上内容仅为说明本发明的技术思想,不能以此限定本发明的保护范围,凡是按照本发明提出的技术思想,在技术方案基础上所做的任何改动,均落入本发明权利要求书的保护范围之内。

Claims (5)

1.考虑网络传输以及执行器饱和的航天器自抗扰控制方法,其特征在于,包括以下步骤:
第一步:构建带有执行器饱和的航天器系统姿态动力学模型;
航天器近似为刚体,由动量矩定理,将其动力学方程写成:
Figure FDA0002626328320000011
其中,J=diag(Jx,Jy,Jz)为沿航天器本体主惯量轴的转动惯量矩阵,diag(·)表示对角矩阵,ω=[ωxyz]T为航天器相对惯性坐标系的瞬时转速在本体坐标系中的矢量,上标T表示向量或者矩阵转置,定义斜对称矩阵S(ω)为:
Figure FDA0002626328320000012
d(t)=[dx,dy,dz]T为作用在航天器上的外干扰力矩矢量,sat(u(t))=[sat(u1),sat(u2),sat(u3)]T为饱和控制力矩矢量,sat(uj(t)),j=1,2,3的具体表达式如下:
sat(uj(t))=sign(uj(t))min(|uj(t)|,1)
其中,sign(·)为符号函数:如果uj(t)>0,sign(uj(t))=1;uj(t)=0,sign(uj(t))=0;uj(t)<0,sign(uj(t))=-1;
采用欧拉角描述航天器的姿态,其运动学方程为:
Figure FDA0002626328320000013
其中,
Figure FDA0002626328320000014
θ和ψ分别为航天器的滚转角、俯仰角和偏航角,
Figure FDA0002626328320000015
Figure FDA0002626328320000016
分别为航天器的滚转角速度、俯仰角速度和偏航角速度;
联立式(1)和(2),得到带有执行器饱和的航天器姿态动力学模型:
Figure FDA0002626328320000021
其中,
Figure FDA0002626328320000022
为系统状态,并且
Figure FDA0002626328320000023
f(x(t))=[fx,fy,fz]T为系统中耦合以及外部干扰带来的非线性不确定项,并且:
Figure FDA0002626328320000024
Figure FDA0002626328320000025
Figure FDA0002626328320000026
系数矩阵A1、B1和C1分别为:
Figure FDA0002626328320000027
Bp=diag(b1,b2,b3),
Figure FDA0002626328320000028
其中,03×3和I3×3分别表示三阶零矩阵和三阶单位矩阵;
第二步:设计跟踪微分器;
第三步:设计非线性采样扩张状态观测器,估计系统状态和非线性不确定项;
第四步:设计复合控制器;
第五步:求解航天器姿态跟踪误差状态的收敛域以及抗饱和系数。
2.根据权利要求1所述的考虑网络传输以及执行器饱和的航天器自抗扰控制方法,其特征在于,步骤二中,跟踪微分器如下:
Figure FDA0002626328320000029
其中,
Figure FDA00026263283200000210
为航天器姿态角的期望值并作为跟踪微分器的输入信号,v1(t)=[v11(t),v12(t),v13(t)]T和v2(t)=[v21(t),v22(t),v23(t)]T为跟踪微分器的输出信号,并且v1(t)是x1d(t)的跟踪信号,v2(t)是x1d(t)的近似微分信号,r0和h分别为跟踪微分器的速度因子和滤波因子;
fhan(t,r0,h)=[fhan1(t,r0,h),fhan2(t,r0,h),fhan3(t,r0,h)]T,并且fhanj(t,r0,h)的表达式为:
Figure FDA0002626328320000031
忽略跟踪微分器对信号造成的误差,即假设x1d(t)=v1(t),
Figure FDA0002626328320000032
3.根据权利要求2所述的考虑网络传输以及执行器饱和的航天器自抗扰控制方法,其特征在于,步骤三设计非线性采样扩张状态观测器,估计系统状态和非线性不确定项的具体方法如下:
首先,设饱和函数sat(uj(t))的近似函数
Figure FDA0002626328320000033
如下所示:
Figure FDA0002626328320000034
式中,
Figure FDA0002626328320000035
ε0为正常数;
该饱和函数
Figure FDA0002626328320000036
连续可导,并且满足
Figure FDA0002626328320000037
和dsat(uj(t))/duj(t)≤1;
因此,原带有执行器饱和的航天器系统(3)改写为:
Figure FDA0002626328320000041
其中,
Figure FDA0002626328320000042
并且:
Figure FDA0002626328320000043
Figure FDA0002626328320000044
Figure FDA0002626328320000045
利用网络协议获取测量信号并设计非线性采样扩张状态观测器形式如式(6)所示:
Figure FDA0002626328320000046
其中,
Figure FDA0002626328320000047
为非线性采样扩张状态观测器的输出状态,且z1(t)=[z11(t),z12(t),z13(t)]T,z2(t)=[z21(t),z22(t),z23(t)]T,z3(t)=[z31(t),z32(t),z33(t)]T
Figure FDA0002626328320000048
表示
Figure FDA0002626328320000049
Λ=diag(εI3×3,I3×3-1I3×3),ε为非线性采样扩张状态观测器的可调参数,η(t)∈R3为两次网络传输时刻间的系统输出预测值,R3表示三维实向量空间,
Figure FDA00026263283200000410
表示
Figure FDA00026263283200000411
Figure FDA00026263283200000412
表示关于
Figure FDA00026263283200000413
的非线性函数,R9表示九维实向量空间,
Figure FDA00026263283200000414
表示正整数,hy(i,ey(ti))为网络协议,系数矩阵A2和B2分别为:
Figure FDA0002626328320000051
4.根据权利要求3所述的考虑网络传输以及执行器饱和的航天器自抗扰控制方法,其特征在于,步骤四中,设计复合控制器的具体方法如下:
根据非线性采样扩张状态观测器(6)的观测值z1(t)和z2(t)以及跟踪微分器的输出值v1(t)和v2(t),设误差信号:
Figure FDA0002626328320000052
其中,r1(t)=[r11(t),r12(t),r13(t)]T和r2(t)=[r21(t),r22(t),r23(t)]T
基于以上误差信号(7)和非线性采样扩张状态观测器(6)对系统中非线性不确定项的估计值z3(t),并且考虑执行器饱和问题,该航天器系统(4)中的复合制器设计为:
Figure FDA0002626328320000053
其中,
Figure FDA0002626328320000054
是关于误差r1(t)和r2(t)的非线性函数,设
Figure FDA0002626328320000055
且:
Figure FDA0002626328320000056
K为控制器可调增益,λ(sat(u(t))-u(t))为抗饱和补偿器,λ为抗饱和系数。
5.根据权利要求1所述的考虑网络传输以及执行器饱和的航天器自抗扰控制方法,其特征在于,步骤五中,求解航天器姿态跟踪误差状态的收敛域以及抗饱和系数的具体方法如下:
考虑航天器姿态跟踪误差状态r(t),如果存在正定对称矩阵P2∈R6×6,正定对角矩阵S1∈R3×3和S2∈R3×3,矩阵H∈R3×6,正实数R1和ρ,使以下凸最优问题:
Figure FDA0002626328320000061
有最优解;则,区域Ω(P2,ρ)={r(t)∈R6:rT(t)P2r(t)≤ρ}为跟踪误差状态r(t)的收敛域;
其中,Rm×n表示m×n维实矩阵空间,c为模型参数,其由模型参数求得,γ=ρ-1,wj为矩阵
Figure FDA0002626328320000062
的行向量,I6×6为六阶单位矩阵,03×6为三行六列零矩阵,Θ11=(P2A1+R0P2C1K)+(P2A1+R0P2C1K)T+3P2
Figure FDA0002626328320000063
Figure FDA0002626328320000064
Θ33=-R1I3×3,trace(P2)表示矩阵P2的迹,符号*表示对称矩阵中的转置项。
CN201810865053.8A 2018-08-01 2018-08-01 考虑网络传输以及执行器饱和的航天器自抗扰控制方法 Active CN109062043B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810865053.8A CN109062043B (zh) 2018-08-01 2018-08-01 考虑网络传输以及执行器饱和的航天器自抗扰控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810865053.8A CN109062043B (zh) 2018-08-01 2018-08-01 考虑网络传输以及执行器饱和的航天器自抗扰控制方法

Publications (2)

Publication Number Publication Date
CN109062043A CN109062043A (zh) 2018-12-21
CN109062043B true CN109062043B (zh) 2021-02-02

Family

ID=64832432

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810865053.8A Active CN109062043B (zh) 2018-08-01 2018-08-01 考虑网络传输以及执行器饱和的航天器自抗扰控制方法

Country Status (1)

Country Link
CN (1) CN109062043B (zh)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110161857B (zh) * 2019-05-24 2022-04-05 华侨大学 一种适用于非最小相位系统的自抗扰控制器设计方法
CN110362095B (zh) * 2019-08-09 2022-04-01 大连海事大学 一种有限时间收敛无人船协同控制器的设计方法
CN111338368B (zh) * 2020-03-06 2023-10-20 上海航天控制技术研究所 一种航天器快速机动姿态跟踪自适应鲁棒控制方法
CN112051730A (zh) * 2020-09-16 2020-12-08 上海维宏电子科技股份有限公司 基于复合跟踪微分器实现自抗扰改进控制的方法、结构、装置及存储介质
CN112363522B (zh) * 2020-11-09 2022-09-27 西北工业大学 一种基于混杂强制型观测器的网络化航天器姿态控制方法
CN113495485B (zh) * 2021-07-22 2022-11-01 中国船舶集团有限公司第七一一研究所 一种主动控制系统的抗饱和控制方法和主动控制系统
CN113504730A (zh) * 2021-08-03 2021-10-15 西北工业大学 一种考虑执行器饱和的非线性飞行器鲁棒控制方法
CN116203932B (zh) * 2023-05-06 2023-07-21 安徽大学 基于模型的无人艇执行器故障检测方法、存储介质及设备

Family Cites Families (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9557724B2 (en) * 2013-05-31 2017-01-31 Honeywell Limited Technique for converting a model predictive control (MPC) system into an explicit two-degrees of freedom (2DOF) control system
CN104252177A (zh) * 2013-06-27 2014-12-31 上海新跃仪表厂 微小卫星对地凝视抗饱和跟踪控制方法
CN103558857B (zh) * 2013-11-14 2016-05-25 东南大学 一种btt飞行器的分布式复合抗干扰姿态控制方法
CN105116725B (zh) * 2015-07-17 2018-06-29 浙江工业大学 基于扩张状态观测器的伺服系统自适应滑模控制方法
CN107065847B (zh) * 2016-03-31 2020-03-20 北京航空航天大学 一种执行器非对称饱和的水面舰船轨迹跟踪控制方法
CN105843240B (zh) * 2016-04-08 2019-01-22 北京航空航天大学 一种考虑执行器故障的航天器姿态积分滑模容错控制方法
CN107065564B (zh) * 2017-05-18 2020-04-14 西北工业大学 一种基于自抗扰的中性浮力机器人姿态与轨迹控制方法
CN108227485B (zh) * 2017-12-01 2020-11-24 西北工业大学 一种带有执行器饱和的空间机器人自抗扰控制方法
CN108196445B (zh) * 2017-12-11 2021-02-02 西北工业大学 一种基于双闭环自抗扰的水下机器人姿态与位置控制方法
CN108181914B (zh) * 2017-12-11 2020-04-14 西北工业大学 一种中性浮力机器人姿态与轨迹自抗扰控制方法

Also Published As

Publication number Publication date
CN109062043A (zh) 2018-12-21

Similar Documents

Publication Publication Date Title
CN109062043B (zh) 考虑网络传输以及执行器饱和的航天器自抗扰控制方法
CN109189085B (zh) 基于事件触发的航天器网络化系统姿态控制方法
Ye et al. State damping control: A novel simple method of rotor UAV with high performance
CN108803649B (zh) 一种垂直起降重复使用运载器自抗扰滑模控制方法
CN105700536B (zh) 基于绳系拖曳系统的主动星姿态和系绳摆振联合控制方法
CN108227485B (zh) 一种带有执行器饱和的空间机器人自抗扰控制方法
CN107450588B (zh) 一种挠性航天器姿态控制系统的强抗扰控制方法
CN109164824B (zh) 一种考虑飞轮不确定性的航天器姿态控制方法
Fu et al. Finite-time trajectory tracking control for a 12-rotor unmanned aerial vehicle with input saturation
CN111198570B (zh) 一种基于固定时间微分器预测的抗时延高精度自抗扰姿态控制方法
CN112578804A (zh) 一种基于事件触发机制的四旋翼飞行器编队滑模控制方法
Zhang et al. A globally fixed-time solution of distributed formation control for multiple hypersonic gliding vehicles
CN108536185B (zh) 一种基于降阶级联扩张状态观测器的双框架磁悬浮cmg框架系统参数优化方法
CN112947067A (zh) 一种水下机器人三维轨迹精确跟踪控制方法
CN109143866A (zh) 一种考虑执行器受限问题的刚性飞行器自适应固定时间姿态跟踪控制方法
CN111831002A (zh) 一种基于预设性能的超高声速飞行器姿态控制方法
CN115649491A (zh) 适用于多源干扰下的低轨光学遥感卫星凝视成像控制方法
Emami et al. Intelligent trajectory tracking of an aircraft in the presence of internal and external disturbances
CN111506095A (zh) 一种双刚体特征点间饱和固定时间相对位姿跟踪控制方法
CN110377044B (zh) 一种无人直升机的有限时间高度和姿态跟踪控制方法
CN111439392B (zh) 一种航天器编队位置协同控制方法
Zhang et al. Adaptive disturbance observer-based dual-loop integral-type fast terminal sliding mode control for micro spacecraft and its gimbal tracking device
CN111123702B (zh) 基于一致性理论的大型柔性航天器分散协调鲁棒控制方法
CN116339141B (zh) 一种机械臂全局固定时间轨迹跟踪滑模控制方法
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