CN109062043A - 考虑网络传输以及执行器饱和的航天器自抗扰控制方法 - Google Patents
考虑网络传输以及执行器饱和的航天器自抗扰控制方法 Download PDFInfo
- Publication number
- CN109062043A CN109062043A CN201810865053.8A CN201810865053A CN109062043A CN 109062043 A CN109062043 A CN 109062043A CN 201810865053 A CN201810865053 A CN 201810865053A CN 109062043 A CN109062043 A CN 109062043A
- Authority
- CN
- China
- Prior art keywords
- nonlinear
- spacecraft
- saturation
- follows
- 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
- 230000005540 biological transmission Effects 0.000 title claims abstract description 21
- 238000005070 sampling Methods 0.000 claims abstract description 25
- 238000013461 design Methods 0.000 claims abstract description 23
- 238000000034 method Methods 0.000 claims abstract description 17
- 230000008878 coupling Effects 0.000 claims abstract description 6
- 238000010168 coupling process Methods 0.000 claims abstract description 6
- 238000005859 coupling reaction Methods 0.000 claims abstract description 6
- 230000001052 transient effect Effects 0.000 claims abstract description 4
- 239000011159 matrix material Substances 0.000 claims description 34
- 229920006395 saturated elastomer Polymers 0.000 claims description 7
- 239000002131 composite material Substances 0.000 claims description 6
- 230000017105 transposition Effects 0.000 claims description 6
- 150000001875 compounds Chemical class 0.000 claims description 3
- 238000001914 filtration Methods 0.000 claims description 3
- 238000005096 rolling process Methods 0.000 claims 1
- 230000000694 effects Effects 0.000 abstract description 3
- 230000008569 process Effects 0.000 abstract description 3
- 230000002411 adverse Effects 0.000 abstract description 2
- 230000015572 biosynthetic process Effects 0.000 abstract 1
- 238000011217 control strategy Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000009415 formwork Methods 0.000 description 2
- 230000006872 improvement Effects 0.000 description 2
- 238000009434 installation Methods 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 230000001681 protective effect Effects 0.000 description 2
- 238000011161 development Methods 0.000 description 1
- 238000003745 diagnosis Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000002401 inhibitory effect Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 230000006855 networking Effects 0.000 description 1
- 230000035935 pregnancy Effects 0.000 description 1
- 238000013468 resource allocation Methods 0.000 description 1
- 230000007704 transition 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
-
- 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
-
- 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/048—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 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控制显示了其不足之处;滑模控制鲁棒性强,干扰抑制效果较好,但是会出现系统输出抖振等现象,在要求高精度的航天器姿态控制中,这种抖动是不能容忍的;最优控制是依赖于模型设计的,鲁棒性不强的控制策略,这从一定程度上限制了它在要求高可靠性的航天工程领域的应用。同时随着计算机网络技术的发展,网络和控制结合的技术也日趋成熟。网络化控制系统体现出较高的诊断能力,安装、扩展与维护的便捷性,实现资源共享和远程控制,降低系统重量和体积,增强系统的灵活性和可靠性等优点,并已在智能交通、楼宇自动化、航天器等领域中得到广泛应用。但是采用网络传输信息会引入丢包、延迟等问题,影响系统稳定性。除此之外,为了确保航天器在规定范围内运行,其执行机构会受到一定的饱和约束。因此,在信号网络化传输条件下,寻求一种不基于精准模型的抗干扰主动控制方法,确保航天器系统在安全范围内完成定向任务显得尤为重要。
自二十世纪九十年代不基于系统模型的自抗扰控制技术被提出以来,其已被广泛应用于非线性最小相位系统、非最小相位系统、分数阶系统、多输入多输出系统等复杂非线性系统中。自抗扰控制技术的主要核心思想为:利用系统的测量输出信息,对系统状态以及由未建模动态和内外干扰形成的非线性不确定项进行实时估计,并将非线性不确定项的估计值补偿到误差反馈控制器中,从而实现了系统的动态反馈线性化。
发明内容
本发明的目的在于针对航天器姿态控制受网络传输影响、内外扰动影响及控制饱和约束影响等问题,提供一种考虑网络传输以及执行器饱和的航天器自抗扰控制方法,该方法用于解决带有执行器饱和及外部干扰等时变非线性不确定项的航天器姿态控制,保证其在自身安全范围内顺利完成空间定向任务。
为达到上述目的,本发明采用以下技术方案予以实现:
考虑网络传输以及执行器饱和的航天器自抗扰控制方法,其特征在于,包括以下步骤:
第一步:构建带有执行器饱和的航天器系统姿态动力学模型;
第二步:设计跟踪微分器;
第三步:设计非线性采样扩张状态观测器,估计系统状态和非线性不确定项;
第四步:设计复合控制器;
第五步:求解航天器姿态跟踪误差状态的收敛域以及抗饱和系数。
本发明进一步的改进在于:
步骤一中,航天器近似为刚体,由动量矩定理,将其动力学方程写成:
其中,J=diag(Jx,Jy,Jz)为沿航天器本体主惯量轴的转动惯量矩阵,diag(·)表示对角矩阵,ω=[ωx,ωy,ωz]T为航天器相对惯性坐标系的瞬时转速在本体坐标系中的矢量,上标T表示向量或者矩阵转置,定义斜对称矩阵S(ω)为:
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;
采用欧拉角描述航天器的姿态,其运动学方程为:
其中,θ和ψ分别为航天器的滚转角、俯仰角和偏航角,和分别为航天器的滚转角速度、俯仰角速度和偏航角速度;
联立式(1)和(2),得到带有执行器饱和的航天器姿态动力学模型:
其中,为系统状态,并且
f(x(t))=[fx,fy,fz]T为系统中耦合以及外部干扰带来的非线性不确定项,并且:
系数矩阵A1、B1和C1分别为:
Bp=diag(b1,b2,b3),
其中,03×3和I3×3分别表示三阶零矩阵和三阶单位矩阵。
步骤二中,跟踪微分器如下:
其中,为航天器姿态角的期望值并作为跟踪微分器的输入信号,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)的表达式为:
忽略跟踪微分器对信号造成的误差,即假设x1d(t)=v1(t),
步骤三设计非线性采样扩张状态观测器,估计系统状态和非线性不确定项的具体方法如下:
首先,设饱和函数sat(uj(t))的近似函数如下所示:
式中,ε0为正常数;
该饱和函数连续可导,并且满足和dsat(uj(t))/duj(t)≤1;
因此,原带有执行器饱和的航天器系统(3)改写为:
其中,并且:
利用网络协议获取测量信号并设计非线性采样扩张状态观测器形式如式(6)所示:
其中,为非线性采样扩张状态观测器的输出状态,且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,表示Λ=diag(εI3×3,I3×3,ε-1I3×3),ε为非线性采样扩张状态观测器的可调参数,η(t)∈R3为两次网络传输时刻间的系统输出预测值,R3表示三维实向量空间,表示表示关于的非线性函数,R9表示九维实向量空间,表示正整数,hy(i,ey(ti))为网络协议,系数矩阵A2和B2分别为:
步骤四中,设计复合控制器的具体方法如下:
根据非线性采样扩张状态观测器(6)的观测值z1(t)和z2(t)以及跟踪微分器的输出值v1(t)和v2(t),设误差信号:
其中,r1(t)=[r11(t),r12(t),r13(t)]T和r2(t)=[r21(t),r22(t),r23(t)]T;
基于以上误差信号(7)和非线性采样扩张状态观测器(6)对系统中非线性不确定项的估计值z3(t),并且考虑执行器饱和问题,该航天器系统(4)中的复合制器设计为:
其中,是关于误差r1(t)和r2(t)的非线性函数,设且:
K为控制器可调增益,λ(sat(u(t))-u(t))为抗饱和补偿器,λ为抗饱和系数。
步骤五中,求解航天器姿态跟踪误差状态的收敛域以及抗饱和系数的具体方法如下:
考虑航天器姿态跟踪误差状态r(t),如果存在正定对称矩阵P2∈R6×6,正定对角矩阵S1∈R3×3和S2∈R3×3,矩阵H∈R3×6,正实数R1和ρ,使以下凸最优问题:
有最优解;则,区域Ω(P2,ρ)={r(t)∈R6:rT(t)P2r(t)≤ρ}为跟踪误差状态r(t)的收敛域;
其中,Rm×n表示m×n维实矩阵空间,c为模型参数,其由模型参数求得,γ=ρ-1,wj为矩阵的行向量,I6×6为六阶单位矩阵,03×6为三行六列零矩阵,Θ11=(P2A1+R0P2C1K)+(P2A1+R0P2C1K)T+3P2, Θ33=-R1I3×3,trace(P2)表示矩阵P2的迹,符号*表示对称矩阵中的转置项。
与现有技术相比,本发明具有以下有益效果:
首先,本发明利用通过网络协议获取的测量信号设计非线性采样扩张状态观测器,对系统所有状态以及非线性不确定项进行实时估计;其次,将非线性不确定项的估计值补偿到含有抗饱和补偿器的状态反馈控制器中,即抑制了内外扰动对航天器姿态的影响,又避免执行机构过饱和对系统造成损坏;最后求解线性矩阵不等式的方法求解系统的安全域以及控制器中的抗饱和系数。所设计方法解决了航天器网络化控制系统所面临的网络传输、内外扰动以及执行器饱和问题,确保航天器网络化控制系统在安全范围内实现精准的姿态控制,提高了系统的鲁棒稳定性。
进一步的,本发明利用跟踪微分器安排过渡过程,避免了因初始误差过大而造成的输出超调现象,对航天器起到一定的保护作用。
进一步的,本发明利用系统的网络传输信号设计非线性采样扩张状态观测器,对系统中的状态以及非线性不确定项进行实时估计。
进一步的,本发明将非线性不确定项的估计值补偿到跟踪误差反馈控制器中,并设计抗饱和补偿器,构成复合控制器,即克服了非线性不确定项对系统造成的不利影响,提高系统的鲁棒性,又避免了执行器饱和现象,便于在安全范围内实现航天器姿态控制。
附图说明
图1为本发明基于采样扩张状态观测器的航天器网络化控制系统自抗扰姿态控制流程图。
图2为本发明基于采样扩张状态观测器的航天器网络化控制系统自抗扰姿态控制方框图。
具体实施方式
下面结合附图对本发明做进一步详细描述:
参见图1,本发明考虑网络传输以及执行器饱和的航天器自抗扰控制方法,包括以下步骤:
第一步:构建带有执行器饱和的航天器系统姿态动力学模型
本发明考虑的航天器近似为刚体,由动量矩定理,可将其动力学方程写成
其中,J=diag(Jx,Jy,Jz)为沿航天器本体主惯量轴的转动惯量矩阵,diag(·)表示对角矩阵,ω=[ωx,ωy,ωz]T为航天器相对惯性坐标系的瞬时转速在本体坐标系中的矢量,上标T表示向量或者矩阵转置,定义斜对称矩阵S(ω)为
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转序的欧拉角描述航天器的姿态,其运动学方程为:
其中,θ和ψ分别为航天器的滚转角、俯仰角和偏航角,和分别为航天器的滚转角速度、俯仰角速度和偏航角速度。
联立式(10)和(11),可得带有执行器饱和的航天器姿态动力学模型:
其中,为系统状态,并且
f(x(t))=[fx,fy,fz]T为系统中耦合以及外部干扰带来的非线性不确定项,并且
系数矩阵A1、B1和C1分别为
Bp=diag(b1,b2,b3),
其中,03×3和I3×3分别表示三阶零矩阵和三阶单位矩阵。
第二步:设计跟踪微分器
一方面为了避免初始时刻航天器系统实际输出姿态角与期望值偏差过大而造成系统输出超调;另一方面为了获取姿态角的微分信号为设计控制器做准备,设计跟踪微分器如下所示:
其中,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)的表达式为
本实例中,设航天器姿态角的期望值为:跟踪微分器的速度因子r0和滤波因子h分别设为20和0.01,则,可通过跟踪微分器(13)获取x1d(t)的跟踪信号v1(t)和x1d(t)的近似微分信号v2(t),为后续控制器设计做准备。
在此,忽略跟踪微分器对信号造成的误差,即假设x1d(t)=v1(t),
第三步:设计非线性采样扩张状态观测器,估计系统状态和非线性不确定项
首先,由于系统中的非线性不确定项f(x(t))中含有饱和函数sat(uj(t)),因此该非线性不确定项存在微分无法求解的问题。为了解决此问题,设饱和函数sat(uj(t))的近似函数如下所示:
式中,ε0为正常数。
该饱和函数连续可导,并且满足和dsat(uj(t))/duj(t)≤1。
因此,原带有执行器饱和的航天器系统(12)改写为:
其中,并且
考虑航天器三个姿态角的测量值通过一定的网络协议进行传输,为了解决有限带宽资源分配问题以及避免网络造成系统不稳定问题,本发明利用网络协议获取测量信号并设计非线性采样扩张状态观测器形式如下所示:
其中,为非线性采样扩张状态观测器的输出状态,且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,表示Λ=diag(εI3×3,I3×3,ε-1I3×3),0<ε<1,hy(i,ey(ti))为网络协议,通过该协议来决定哪个传感器传输测量数据,η(t)∈R3为两次网络传输间的预测值,当满足一定的网络协议时对应的预测值会更新一次,R3表示三维实向量空间,表示 表示正整数。在本实例中选取ε=0.08,网络传输方式采用循环调度协议,即hy(i,ey(ti))=(I3×3-Δ(i))ey,
其中,Δ(i)=diag(Δ1(i),Δ2(i),Δ2(i)),并且
为了便于表示,设χ(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))=[g1(χ1(t)),g2(χ2(t)),g3(χ3(t))]T,且
h2(χ(t))=β2χ(t),可调增益β2=diag(5,5,5),h3(χ(t))=β3χ(t),可调增益β3=diag(3,3,3),
系数矩阵A2和B2分别为
第四步:设计复合控制器
一方面为了实现对航天器精准的姿态控制,本发明中控制器采用误差反馈控制形式,并将非线性采样扩张状态观测器估计出的非线性不确定项实时补偿到控制器中;另一方面为了对航天器中的执行机构起到一定的保护作用,本发明考虑执行器饱和问题,并采用抗饱和补偿措施。
根据非线性采样扩张状态观测器(15)的观测值z1(t)和z2(t)以及跟踪微分器的输出值v1(t)和v2(t),设误差信号:
其中,r1(t)=[r11(t),r12(t),r13(t)]T和r2(t)=[r21(t),r22(t),r23(t)]T。
基于以上误差信号(16)和非线性采样扩张状态观测器(15)对系统中非线性不确定项的估计值z3(t),并且考虑执行器饱和问题,该航天器系统(14)中的复合制器设计为:
本实例中设可调控制增益K=[k1,k2],选取k1=diag(100,65,63),k2=diag(20,30,30),是关于误差r1(t)和r2(t)的非线性函数,为了便于表示,设且:
可调参数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和ρ,使以下凸最优问题
有最优解。则,区域Ω(P2,ρ)={r(t)∈R6:rT(t)P2r(t)≤ρ}为跟踪误差状态r(t)的收敛域。
其中,Rm×n表示m×n维实矩阵空间,γ=ρ-1,wj为矩阵的行向量,I6×6为六阶单位矩阵,03×6为三行六列零矩阵,Θ11=(P2A1+R0P2C1K)+(P2A1+R0P2C1K)T+3P2, Θ33=-R1I3×3,trace(P2)表示矩阵P2的迹,符号*表示对称矩阵中的转置项。
本实例中设参数c=5并结合系统其他给定参数,可以通过求解线性矩阵不等式(18)获取跟踪误差状态r(t)的最大收敛域Ω(P2,ρ)={r(t)∈R6:rT(t)P2r(t)≤ρ}以及抗饱和系数λ。
以上内容仅为说明本发明的技术思想,不能以此限定本发明的保护范围,凡是按照本发明提出的技术思想,在技术方案基础上所做的任何改动,均落入本发明权利要求书的保护范围之内。
Claims (6)
1.考虑网络传输以及执行器饱和的航天器自抗扰控制方法,其特征在于,包括以下步骤:
第一步:构建带有执行器饱和的航天器系统姿态动力学模型;
第二步:设计跟踪微分器;
第三步:设计非线性采样扩张状态观测器,估计系统状态和非线性不确定项;
第四步:设计复合控制器;
第五步:求解航天器姿态跟踪误差状态的收敛域以及抗饱和系数。
2.根据权利要求1所述的考虑网络传输以及执行器饱和的航天器自抗扰控制方法,其特征在于,步骤一中,航天器近似为刚体,由动量矩定理,将其动力学方程写成:
其中,J=diag(Jx,Jy,Jz)为沿航天器本体主惯量轴的转动惯量矩阵,diag(·)表示对角矩阵,ω=[ωx,ωy,ωz]T为航天器相对惯性坐标系的瞬时转速在本体坐标系中的矢量,上标T表示向量或者矩阵转置,定义斜对称矩阵S(ω)为:
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;
采用欧拉角描述航天器的姿态,其运动学方程为:
其中,θ和ψ分别为航天器的滚转角、俯仰角和偏航角,和分别为航天器的滚转角速度、俯仰角速度和偏航角速度;
联立式(1)和(2),得到带有执行器饱和的航天器姿态动力学模型:
其中,为系统状态,并且
f(x(t))=[fx,fy,fz]T为系统中耦合以及外部干扰带来的非线性不确定项,并且:
系数矩阵A1、B1和C1分别为:
Bp=diag(b1,b2,b3),
其中,03×3和I3×3分别表示三阶零矩阵和三阶单位矩阵。
3.根据权利要求1所述的考虑网络传输以及执行器饱和的航天器自抗扰控制方法,其特征在于,步骤二中,跟踪微分器如下:
其中,为航天器姿态角的期望值并作为跟踪微分器的输入信号,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)的表达式为:
忽略跟踪微分器对信号造成的误差,即假设x1d(t)=v1(t),
4.根据权利要求3所述的考虑网络传输以及执行器饱和的航天器自抗扰控制方法,其特征在于,步骤三设计非线性采样扩张状态观测器,估计系统状态和非线性不确定项的具体方法如下:
首先,设饱和函数sat(uj(t))的近似函数如下所示:
式中,ε0为正常数;
该饱和函数连续可导,并且满足和dsat(uj(t))/duj(t)≤1;
因此,原带有执行器饱和的航天器系统(3)改写为:
其中,并且:
利用网络协议获取测量信号并设计非线性采样扩张状态观测器形式如式(6)所示:
其中,为非线性采样扩张状态观测器的输出状态,且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,表示Λ=diag(εI3×3,I3×3,ε-1I3×3),ε为非线性采样扩张状态观测器的可调参数,η(t)∈R3为两次网络传输时刻间的系统输出预测值,R3表示三维实向量空间,表示 表示关于的非线性函数,R9表示九维实向量空间,表示正整数,hy(i,ey(ti))为网络协议,系数矩阵A2和B2分别为:
5.根据权利要求4所述的考虑网络传输以及执行器饱和的航天器自抗扰控制方法,其特征在于,步骤四中,设计复合控制器的具体方法如下:
根据非线性采样扩张状态观测器(6)的观测值z1(t)和z2(t)以及跟踪微分器的输出值v1(t)和v2(t),设误差信号:
其中,r1(t)=[r11(t),r12(t),r13(t)]T和r2(t)=[r21(t),r22(t),r23(t)]T;
基于以上误差信号(7)和非线性采样扩张状态观测器(6)对系统中非线性不确定项的估计值z3(t),并且考虑执行器饱和问题,该航天器系统(4)中的复合制器设计为:
其中,是关于误差r1(t)和r2(t)的非线性函数,设且:
K为控制器可调增益,λ(sat(u(t))-u(t))为抗饱和补偿器,λ为抗饱和系数。
6.根据权利要求1所述的考虑网络传输以及执行器饱和的航天器自抗扰控制方法,其特征在于,步骤五中,求解航天器姿态跟踪误差状态的收敛域以及抗饱和系数的具体方法如下:
考虑航天器姿态跟踪误差状态r(t),如果存在正定对称矩阵P2∈R6×6,正定对角矩阵S1∈R3×3和S2∈R3×3,矩阵H∈R3×6,正实数R1和ρ,使以下凸最优问题:
有最优解;则,区域Ω(P2,ρ)={r(t)∈R6:rT(t)P2r(t)≤ρ}为跟踪误差状态r(t)的收敛域;
其中,Rm×n表示m×n维实矩阵空间,c为模型参数,其由模型参数求得,γ=ρ-1,wj为矩阵的行向量,I6×6为六阶单位矩阵,03×6为三行六列零矩阵,Θ11=(P2A1+R0P2C1K)+(P2A1+R0P2C1K)T+3P2, Θ33=-R1I3×3,trace(P2)表示矩阵P2的迹,符号*表示对称矩阵中的转置项。
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 true CN109062043A (zh) | 2018-12-21 |
CN109062043B 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) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110161857A (zh) * | 2019-05-24 | 2019-08-23 | 华侨大学 | 一种适用于非最小相位系统的自抗扰控制器设计方法 |
CN110362095A (zh) * | 2019-08-09 | 2019-10-22 | 大连海事大学 | 一种有限时间收敛无人船协同控制器的设计方法 |
CN111338368A (zh) * | 2020-03-06 | 2020-06-26 | 上海航天控制技术研究所 | 一种航天器快速机动姿态跟踪自适应鲁棒控制方法 |
CN112051730A (zh) * | 2020-09-16 | 2020-12-08 | 上海维宏电子科技股份有限公司 | 基于复合跟踪微分器实现自抗扰改进控制的方法、结构、装置及存储介质 |
CN112363522A (zh) * | 2020-11-09 | 2021-02-12 | 西北工业大学 | 一种基于混杂强制型观测器的网络化航天器姿态控制方法 |
CN113495485A (zh) * | 2021-07-22 | 2021-10-12 | 中国船舶重工集团公司第七一一研究所 | 一种主动控制系统的抗饱和控制方法和主动控制系统 |
CN113504730A (zh) * | 2021-08-03 | 2021-10-15 | 西北工业大学 | 一种考虑执行器饱和的非线性飞行器鲁棒控制方法 |
CN116203932A (zh) * | 2023-05-06 | 2023-06-02 | 安徽大学 | 基于模型的无人艇执行器故障检测方法、存储介质及设备 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103558857A (zh) * | 2013-11-14 | 2014-02-05 | 东南大学 | 一种btt飞行器的分布式复合抗干扰姿态控制方法 |
US20140358254A1 (en) * | 2013-05-31 | 2014-12-04 | Honeywell Asca, Inc. | 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 | 上海新跃仪表厂 | 微小卫星对地凝视抗饱和跟踪控制方法 |
CN105116725A (zh) * | 2015-07-17 | 2015-12-02 | 浙江工业大学 | 基于扩张状态观测器的伺服系统自适应滑模控制方法 |
CN105843240A (zh) * | 2016-04-08 | 2016-08-10 | 北京航空航天大学 | 一种考虑执行器故障的航天器姿态积分滑模容错控制方法 |
CN107065564A (zh) * | 2017-05-18 | 2017-08-18 | 西北工业大学 | 一种基于自抗扰的中性浮力机器人姿态与轨迹控制方法 |
CN107065847A (zh) * | 2016-03-31 | 2017-08-18 | 北京航空航天大学 | 一种执行器非对称饱和的水面舰船轨迹跟踪控制方法 |
CN108181914A (zh) * | 2017-12-11 | 2018-06-19 | 西北工业大学 | 一种中性浮力机器人姿态与轨迹自抗扰控制方法 |
CN108196445A (zh) * | 2017-12-11 | 2018-06-22 | 西北工业大学 | 一种基于双闭环自抗扰的水下机器人姿态与位置控制方法 |
CN108227485A (zh) * | 2017-12-01 | 2018-06-29 | 西北工业大学 | 一种带有执行器饱和的空间机器人自抗扰控制方法 |
-
2018
- 2018-08-01 CN CN201810865053.8A patent/CN109062043B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20140358254A1 (en) * | 2013-05-31 | 2014-12-04 | Honeywell Asca, Inc. | 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 | 上海新跃仪表厂 | 微小卫星对地凝视抗饱和跟踪控制方法 |
CN103558857A (zh) * | 2013-11-14 | 2014-02-05 | 东南大学 | 一种btt飞行器的分布式复合抗干扰姿态控制方法 |
CN105116725A (zh) * | 2015-07-17 | 2015-12-02 | 浙江工业大学 | 基于扩张状态观测器的伺服系统自适应滑模控制方法 |
CN107065847A (zh) * | 2016-03-31 | 2017-08-18 | 北京航空航天大学 | 一种执行器非对称饱和的水面舰船轨迹跟踪控制方法 |
CN105843240A (zh) * | 2016-04-08 | 2016-08-10 | 北京航空航天大学 | 一种考虑执行器故障的航天器姿态积分滑模容错控制方法 |
CN107065564A (zh) * | 2017-05-18 | 2017-08-18 | 西北工业大学 | 一种基于自抗扰的中性浮力机器人姿态与轨迹控制方法 |
CN108227485A (zh) * | 2017-12-01 | 2018-06-29 | 西北工业大学 | 一种带有执行器饱和的空间机器人自抗扰控制方法 |
CN108181914A (zh) * | 2017-12-11 | 2018-06-19 | 西北工业大学 | 一种中性浮力机器人姿态与轨迹自抗扰控制方法 |
CN108196445A (zh) * | 2017-12-11 | 2018-06-22 | 西北工业大学 | 一种基于双闭环自抗扰的水下机器人姿态与位置控制方法 |
Non-Patent Citations (1)
Title |
---|
马广富等: "组合体航天器有限时间超螺旋反步姿态控制", 《宇航学报》 * |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110161857A (zh) * | 2019-05-24 | 2019-08-23 | 华侨大学 | 一种适用于非最小相位系统的自抗扰控制器设计方法 |
CN110362095A (zh) * | 2019-08-09 | 2019-10-22 | 大连海事大学 | 一种有限时间收敛无人船协同控制器的设计方法 |
CN110362095B (zh) * | 2019-08-09 | 2022-04-01 | 大连海事大学 | 一种有限时间收敛无人船协同控制器的设计方法 |
CN111338368A (zh) * | 2020-03-06 | 2020-06-26 | 上海航天控制技术研究所 | 一种航天器快速机动姿态跟踪自适应鲁棒控制方法 |
CN111338368B (zh) * | 2020-03-06 | 2023-10-20 | 上海航天控制技术研究所 | 一种航天器快速机动姿态跟踪自适应鲁棒控制方法 |
CN112051730A (zh) * | 2020-09-16 | 2020-12-08 | 上海维宏电子科技股份有限公司 | 基于复合跟踪微分器实现自抗扰改进控制的方法、结构、装置及存储介质 |
CN112363522A (zh) * | 2020-11-09 | 2021-02-12 | 西北工业大学 | 一种基于混杂强制型观测器的网络化航天器姿态控制方法 |
CN112363522B (zh) * | 2020-11-09 | 2022-09-27 | 西北工业大学 | 一种基于混杂强制型观测器的网络化航天器姿态控制方法 |
CN113495485A (zh) * | 2021-07-22 | 2021-10-12 | 中国船舶重工集团公司第七一一研究所 | 一种主动控制系统的抗饱和控制方法和主动控制系统 |
CN113504730A (zh) * | 2021-08-03 | 2021-10-15 | 西北工业大学 | 一种考虑执行器饱和的非线性飞行器鲁棒控制方法 |
CN116203932A (zh) * | 2023-05-06 | 2023-06-02 | 安徽大学 | 基于模型的无人艇执行器故障检测方法、存储介质及设备 |
CN116203932B (zh) * | 2023-05-06 | 2023-07-21 | 安徽大学 | 基于模型的无人艇执行器故障检测方法、存储介质及设备 |
Also Published As
Publication number | Publication date |
---|---|
CN109062043B (zh) | 2021-02-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109062043A (zh) | 考虑网络传输以及执行器饱和的航天器自抗扰控制方法 | |
CN109189085B (zh) | 基于事件触发的航天器网络化系统姿态控制方法 | |
Zhang et al. | A novel control scheme for quadrotor UAV based upon active disturbance rejection control | |
CN105182743B (zh) | 一种基于鲁棒h无穷的变增益解耦控制方法 | |
CN107450588B (zh) | 一种挠性航天器姿态控制系统的强抗扰控制方法 | |
CN106325291B (zh) | 基于滑模控制律和eso的四旋翼飞行器姿态控制方法及系统 | |
CN105182984B (zh) | 飞行器俯仰姿态的线性自抗扰控制器设计与参数整定方法 | |
CN109143866A (zh) | 一种考虑执行器受限问题的刚性飞行器自适应固定时间姿态跟踪控制方法 | |
CN109507890A (zh) | 一种基于eso的无人机动态逆广义预测控制器 | |
CN105629732A (zh) | 一种考虑控制受限的航天器姿态输出反馈跟踪控制方法 | |
CN110161855A (zh) | 一种基于鲁棒伺服增益调度无人机控制器的设计方法 | |
CN105182990A (zh) | 具有输出受限的三自由度模型直升机的鲁棒控制方法 | |
CN113377014A (zh) | 一种机械臂系统鲁棒镇定控制方法和系统 | |
Emami et al. | Intelligent trajectory tracking of an aircraft in the presence of internal and external disturbances | |
Qiu et al. | Robust path‐following control based on trajectory linearization control for unmanned surface vehicle with uncertainty of model and actuator saturation | |
CN116923730B (zh) | 一种具有自调节预设性能约束的航天器姿态主动容错控制方法 | |
CN111123702B (zh) | 基于一致性理论的大型柔性航天器分散协调鲁棒控制方法 | |
Jiang et al. | A feedback linearization and saturated control structure for quadrotor UAV | |
CN110515389A (zh) | 一种考虑执行器受限问题的刚性飞行器自适应固定时间姿态镇定方法 | |
CN116382332A (zh) | 一种基于ude的战斗机大机动鲁棒飞行控制方法 | |
Zhao et al. | Trajectory tracking control for quadrotor uavs based on composite nonsingular terminal sliding mode method | |
Shen et al. | An improved chattering-free sliding mode control with finite time convergence for reentry vehicle | |
CN109814393B (zh) | 一种悬吊漂浮物随动系统的降维观测器和控制器设计方法 | |
CN108052003A (zh) | 基于光电平台精确模型的自抗扰控制器设计系统 | |
Wadoo et al. | Optimal control of an autonomous underwater vehicle |
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 |