CN107608210A - 输入饱和的航天器姿态终端滑模跟踪控制方法 - Google Patents
输入饱和的航天器姿态终端滑模跟踪控制方法 Download PDFInfo
- Publication number
- CN107608210A CN107608210A CN201710743352.XA CN201710743352A CN107608210A CN 107608210 A CN107608210 A CN 107608210A CN 201710743352 A CN201710743352 A CN 201710743352A CN 107608210 A CN107608210 A CN 107608210A
- Authority
- CN
- China
- Prior art keywords
- mrow
- mover
- msub
- mtd
- msup
- 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
Landscapes
- Medicines Containing Antibodies Or Antigens For Use As Internal Diagnostic Agents (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及输入饱和的航天器姿态终端滑模控制方法,属于航天器姿态调整技术领域,本发明为航天器设计了两个无退绕鲁棒有限时间控制方法,一是补偿已知有界法;二是双曲线正切函数和辅助系统控制法。补偿已知有界法可以补偿已知有界的外部干扰;而通过采用双曲线正切函数和辅助系统控制法,可以处理外部干扰和输入饱和问题。利用李雅普诺夫定理,证明整个闭环系统的有限时间稳定性和渐近稳定性。仿真结果表明,控制器可以使航天器在限的时间内跟踪一个时变的参考姿态信号。
Description
技术领域
本发明属于航天器姿态调整技术领域,具体的说,涉及输入饱和的航天器姿态终端滑模跟踪控制方法。
背景技术
航天器的姿态控制被广泛应用于空间任务中,如地球观测和交会对接领域,越来越多的专家学者对航天器的姿态控制表现出浓厚的兴趣。
Wen和Kreutz-Delgado提出了一种基于四元素分析刚体姿态跟踪控制问题的通用框架。
由于单位四元素描述姿态的不唯一性,导致系统退绕,最终导致额外的燃料消耗。当闭环系统接近期望的姿态平衡状态时,退绕使航天器额外飞行很长一段距离,然后才返回到期望姿态。
现有的控制方法是渐近稳定性和指数稳定性的,状态误差收敛到平衡时间接近无穷大。显然,在一些实时性要求高的任务中,无穷大的稳定时间标准是不可取的。
因此,能够提供更快收敛速度和更好控制性能的有限时间控制器得到了广泛的关注。Wu(2012)针对挠性航天器姿态机动存在惯性不确定性和外部干扰问题,采用TSM控制方法设计了鲁棒有限时间控制器。然而,传统的TSM控制器有两个缺点:一是当系统远离平衡状态时,TSM控制器比传统的线性超平面的滑模控制收敛速度慢;另外就是奇异问题,奇异往往造成控制输入无穷大。
虽然许多有限时间控制器针对外部干扰和不确定的惯性参数问题已经有了很大改进,但其中大部分控制器只使系统稳定到一个包含原点的小区域,且不能保证系统的渐近稳定性。
此外,在航天器控制系统的实际应用中,执行器输出幅值大小约束是一个非常重要且不可避免的问题。实际航天器的执行器都有输入幅值限制,如果不考虑控制器的输入饱和问题,会导致整个控制系统的控制性能下降,甚至导致整个系统不稳定。
因此,有必要提出一种新的控制方法,使其能够克服执行器饱和情况下的无退绕有限时间控制和有限时间稳定问题。
发明内容
为了克服背景技术中的问题,本发明提出输入饱和的航天器姿态终端滑模跟踪控制方法,其能通过补偿已知有界的控制器,能够鲁棒性的控制已知界限的时变外部干扰,实现在有限时间内能够收敛到零;设计双曲线正切函数和辅助系统的控制器,处理外部干扰的输入饱和问题。
输入饱和的航天器姿态终端滑模跟踪控制方法,其包括两种控制方法:
(1).补偿已知有界控制法;
(2).双曲线正切函数和辅助系统控制法;
其中,补偿已知有界控制法包括以下步骤:
步骤1.建立航天器姿态动力学方程;
航天器姿态动力学方程定义如公式(1)-(3)所示:
ω∈R3×1为航天器在本体坐标系中的角速度,R∈SO(3)为将本体坐标系转化为惯性坐标系的旋转矩阵,u∈R3×1和d∈R3×1分别是控制力矩和外部干扰力矩,J∈R3×3为惯性矩阵;
步骤2.考虑外部干扰姿态误差:
利用所定义的旋转矩阵误差和角速度误差,可以得到姿态误差的相对微分方程公式(4)-(6)
和分别表示旋转矩阵误差和角速度误差,其中,Rd∈SO(3)和ωd∈R3×1表示参考坐标系中的参考姿态和参考角速度。
由于误差是一个矩阵,并不能直接用来设计控制器。构造了一个新的姿态误差函数
姿态误差函数和姿态误差向量如公式(7)-(8)定义;
采用姿态误差公式(7)-(8)可以重新表示为公式(9)-(11)的形式,
其中,符号∨表示将斜对称矩阵转移为向量,如(a×)∨=a和(A∨)×=A,其中,a∈R3×1是一个向量,A是一个斜对称矩阵;
当时,航天器姿态动力学方程是有效的;
并在集合中设计有限时间控制器,其中姿态误差向量和E采用Lee文献中的方法进行定义;
步骤3.为克服航天器外部干扰和惯性参数问题,引入航天器有限时间控制:
引理1:当||x||≤π和时,存在x∈R3,在集合Υ中,且E为可逆矩阵(Lee 2012);
引理2:考虑系统(Hu 2014)
x(t)=f(x(t)),x(0)=0,f(0)=0,x∈Rn (12)
其中,f:U0→Rn在原点U0的开放领域内是连续的,公式(12)描述的系统在前面所述的所有初始条件下具有一个唯一解,公式(12)描述系统的平衡点x=0是Lyapunov稳定,且在有限时间内收敛到原点的一个领域内,则该系统为局部有限时间稳定;
有限时间收敛意味着存在一个函数T:U\{0}→(0,∞),使得公式(12)的解表示为st(x0),其中x0为初始状态,当t∈[0,T(x0)]时st(x0)∈U\{0};当t>T(x0)时,st(x0)=0,当U=Rn时,可以获得航天器有限时间稳定的结果;
步骤4.进行有限时间设计:
假设1:假定d,ωd和分别满足||d||≤dmax和其中dmax和ωdmax是已知正常数;
基于TSM方法,采用有限时间控制的思想设计一个航天器鲁棒控制器,快速终端滑动表面如公式(13)所示,其中0<γ<1,α,β,和η均为正常数(Guo et al.2014);
r1=(2-γ)ηγ-1,r2=(γ-1)ηγ-2 (17)
得如公式(15)所示航天器基于终端滑模控制所设计的有限时间收敛控制率,其中k1,k2,k3和均为正常数;另外,k1和k3分别满足k1-ρ>0,k3-ρ1>0,其中,ρ为正常数,ιmax为||EJ-1d||的最大值;
对具有鲁棒性的有限时间稳定设计证明;
定理1:考虑满足步骤4中假设1条件且由公式(9)-(11)定义的航天器,如果按照公式(18)设计控制率,则有如下结论:
(i)吸引区域如公式(19)所示,其中*(0)是*的初始值;
(ii)S,和分别在有限时间内收敛到0;
证明:考虑设计公式(20)所示李雅普诺夫函数
沿系统(9)-(11)对所设计的李雅普诺夫函数(20)求导可得:
为了保证姿态误差向量在集合Υ中,设计函数必须满足公式(22)
那么,我们就得到了公式(19),则(i)证明完毕;
从t0到t对进行积分,可得:
解不等式(23),得正定变量V1满足
其中,
由于V1(t)=0,当t≥t*时,滑模面S和收敛到0,从公式(13)可得,在有限时间内收敛到0;
则(ii)证明完毕,定理1证明完毕;
步骤6.将步骤5中的公式(18)的设计航天器控制器,用于补偿已知有界的外部干扰,解决外部扰动和输入饱和。
(2).双曲线正切函数和辅助系统控制法
其包括,以下步骤:
步骤1.建立航天器姿态动力学方程;
航天器姿态动力学方程定义如公式(23)-(25)所示:
ω∈R3×1为航天器在本体坐标系中的角速度,R∈SO(3)为将本体坐标系转化为惯性坐标系的旋转矩阵,u∈R3×1和d∈R3×1分别是控制力矩和外部干扰力矩,J∈R3×3为惯性矩阵;
步骤2.引入外部干扰姿态误差:
利用所定义的旋转矩阵误差和角速度误差,可以得到姿态误差的相对微分方程公式(26)-(28)
和分别表示旋转矩阵误差和角速度误差,其中,Rd∈SO(3)和ωd∈R3×1表示参考坐标系中的参考姿态和参考角速度。
由于误差是一个矩阵,并不能直接用来设计控制器。构造了一个新的姿态误差函数;
姿态误差函数和姿态误差向量如公式(29)-(30)定义;
采用姿态误差公式(29)-(30)可以重新表示为公式(31)-(32)的形式,
其中,符号∨表示将斜对称矩阵转移为向量,如(a×)∨=a和(A∨)×=A,其中,a∈R3×1是一个向量,A是一个斜对称矩阵;
当时,航天器姿态动力学方程是有效的;
并在集合中设计有限时间控制器,其中姿态误差向量和E采用Lee文献中的方法进行定义;
步骤3.为克服航天器外部干扰和惯性参数问题,引入航天器有限时间控制:
引理1:当||x||≤π和时,存在x∈R3,在集合Υ中,且E为可逆矩阵(Lee 2012);
引理2:考虑系统(Hu 2014)
x(t)=f(x(t)),x(0)=0,f(0)=0,x∈Rn (34)
其中,f:U0→Rn在原点U0的开放领域内是连续的,公式(34)描述的系统在前面所述的所有初始条件下具有一个唯一解,公式(34)描述系统的平衡点x=0是Lyapunov稳定,且在有限时间内收敛到原点的一个领域内,则该系统为局部有限时间稳定;
有限时间收敛意味着存在一个函数T:U\{0}→(0,∞),使得公式(34)的解表示为st(x0),其中x0为初始状态,当t∈[0,T(x0)]时st(x0)∈U\{0};当t>T(x0)时,st(x0)=0,当U=Rn时,可以获得航天器有限时间稳定的结果;
步骤4.为克服执行器饱和输入的问题,引入双曲线正切函数和辅助系统控制
假设1:假定d,ωd和分别满足||d||≤dmax和其中dmax和ωdmax是已知正常数;
基于TSM方法,采用有限时间控制的思想设计一个航天器鲁棒控制器,快速终端滑动表面如公式(35)所示,其中0<γ<1,α,β,和η均为正常数(Guo et al.2014);
r1=(2-γ)ηγ-1,r2=(γ-1)ηγ-2 (39)
利用双曲线正切函数和辅助系统控制法,由公式(40)-(42)给出了航天器在输入饱和情况下的控制律,k1,k2,k3,k4,ε1和ε2均为正常值,且k5>||EJ-1d||;
u=-k1tanh(ε1ζ)-k2tanh(ε2S) (40)
η=S-ζ (41)
定理2:考虑满足假设1条件下且由公式(31)-(33)定义的航天器,按照公式(40)-(42)设计控制率,则可有如下结论:
(i)吸引域如公式(43)所示
(ii)S,和分别在有限时间内收敛到0
证明:设计如公式(44)所示李雅普诺夫函数
沿系统(31)-(33)对所设计的李雅普诺夫函数(45)求导可得:
为了保证姿态误差向量在集合Υ中,设计函数同时满足公式(46);
由公式(46)可得公式(43):
则(i)证明完毕:
从t0到t对积分,可得
解不等式(47)可得:
其中,
由于V2(t)=0,当t≥t*时,滑模面S和收敛到0;从公式可得,在有限时间内收敛到0:
则(ii)得证,定理2证明完毕,
步骤5.将步骤4中的公式(40)-(42)设计航天器控制器,以解决外部扰动和输入饱和问题。
本发明的有益效果:
本发明为航天器设计了两个无退绕鲁棒有限时间控制器,第一个为补偿已知有界控制法,对已知界限时变外部干扰具有鲁棒性,实现在有限时间内收敛到零;而通过采用双曲线正切函数和辅助系统控制法,可以处理外部干扰的输入饱和问题。
附图说明
图1为本发明的仿真示意图Ⅰ;
图2为本发明的仿真示意图Ⅰ;
图3位本发明的仿真示意图Ⅰ;
图4控制力矩结构示意图;
图5为本发明的仿真示意图Ⅱ;
图6为本发明的仿真示意图Ⅱ;
图7位本发明的仿真示意图Ⅱ;
图8控制力矩结构示意图
图9为ζ的仿真示意图;
图10为S的仿真曲线示意图。
具体实施方式
为了使本发明的目的、技术方案和有益效果更加清楚、明白,下面将结合附图,对本发明的优选实施例进行详细的说明,以方便技术人员理解。
输入饱和的航天器姿态终端滑模跟踪控制方法,其包括两种控制方法:
(1).补偿已知有界控制法;
(2).双曲线正切函数和辅助系统控制法;
实施例1
其中,补偿已知有界控制法包括以下步骤:
步骤1.建立航天器姿态动力学方程;
航天器姿态动力学方程定义如公式(1)-(3)所示:
ω∈R3×1为航天器在本体坐标系中的角速度,R∈SO(3)为将本体坐标系转化为惯性坐标系的旋转矩阵,u∈R3×1和d∈R3×1分别是控制力矩和外部干扰力矩,J∈R3×3为惯性矩阵;
步骤2.考虑外部干扰姿态误差:
利用所定义的旋转矩阵误差和角速度误差,可以得到姿态误差的相对微分方程公式(4)-(6)
和分别表示旋转矩阵误差和角速度误差,其中,Rd∈SO(3)和ωd∈R3×1表示参考坐标系中的参考姿态和参考角速度。
由于误差是一个矩阵,并不能直接用来设计控制器。所以,构造了一个新的姿态误差函数
姿态误差函数和姿态误差向量如公式(7)-(8)定义;
采用姿态误差公式(7)-(8)可以重新表示为公式(9)-(11)的形式,
其中,符号∨表示将斜对称矩阵转移为向量,如(a×)∨=a和(A∨)×=A,其中,a∈R3×1是一个向量,A是一个斜对称矩阵;
当时,航天器姿态动力学方程是有效的;
并在集合中设计有限时间控制器,其中姿态误差向量和E采用Lee文献中的方法进行定义;
步骤3.为克服航天器外部干扰和惯性参数问题,引入航天器有限时间控制:
引理1:当||x||≤π和时,存在x∈R3,在集合Υ中,且E为可逆矩阵(Lee 2012);
引理2:考虑系统(Hu 2014)
x(t)=f(x(t)),x(0)=0,f(0)=0,x∈Rn (12)
其中,f:U0→Rn在原点U0的开放领域内是连续的,公式(12)描述的系统在前面所述的所有初始条件下具有一个唯一解,公式(12)描述系统的平衡点x=0是Lyapunov稳定,且在有限时间内收敛到原点的一个领域内,则该系统为局部有限时间稳定。
有限时间收敛意味着存在一个函数T:U\{0}→(0,∞),使得公式(12)的解表示为st(x0),其中x0为初始状态,当t∈[0,T(x0)]时st(x0)∈U\{0};当t>T(x0)时,st(x0)=0,当U=Rn时,可以获得航天器有限时间稳定的结果。
步骤4.进行有限时间设计:
假设1:假定d,ωd和分别满足||d||≤dmax和其中dmax和ωdmax是已知正常数;
基于TSM方法,采用有限时间控制的思想设计一个航天器鲁棒控制器,快速终端滑动表面如公式(13)所示,其中0<γ<1,α,β,和η均为正常数(Guo et al.2014);
r1=(2-γ)ηγ-1,r2=(γ-1)ηγ-2 (17)
得如公式(15)所示航天器基于终端滑模控制所设计的有限时间收敛控制率,其中k1,k2,k3和均为正常数;另外,k1和k3分别满足k1-ρ>0,k3-ρ1>0,其中,ρ为正常数,ιmax为||EJ-1d||的最大值;
对具有鲁棒性的有限时间稳定设计证明;
定理1:考虑满足步骤4中假设1条件且由公式(9)-(11)定义的航天器,如果按照公式(18)设计控制率,则有如下结论:
(iii)吸引区域如公式(19)所示,其中*(0)是*的初始值;
(iv)S,和分别在有限时间内收敛到0。
证明:考虑设计公式(20)所示李雅普诺夫函数
沿系统(9)-(11)对所设计的李雅普诺夫函数(20)求导可得:
为了保证姿态误差向量在集合Υ中,设计函数必须满足公式(22)
那么,我们就得到了公式(19),则(i)证明完毕;
从t0到t对进行积分,可得:
解不等式(23),得正定变量V1满足
其中,
由于V1(t)=0,当t≥t*时,滑模面S和收敛到0,从公式(13)可得,在有限时间内收敛到0;
则(ii)证明完毕,定理1证明完毕;
步骤6.将步骤5中的公式(18)的设计航天器控制器,用于补偿已知有界的外部干扰,解决外部扰动和输入饱和。
在本节中,通过仿真对理论结果进行分析说明。
为了验证所提出的有限时间控制器的有效性,设计航天器跟踪一个普通随时间变化的参考信号,数值仿真结果如下:
实施例1仿真分析:
补偿已知有界控制法的参数设置为:
航天器姿态动力学方程:ω(0)=[0.1,0.1,0.1]rad/s;d=2×10-3[sin(0.1t),cos(0.2t),sin(0.2t)]TN·m;
R∈SO(3)为将本体坐标系转化为惯性坐标系的旋转矩阵,J∈R3×3为惯性矩阵;ω∈R3×1=[ω1,ω2,ω3]T为航天器在本体坐标系中的角速度,u∈R3×1和d∈R3×1分别是控制力矩和外部干扰力矩。
引入外部干扰误差:满足吸引域公式(19);
为克服航天器外部干扰和惯性参数问题,引入航天器有限时间控制:
k1=1,k2=0.02 γ=0.7,α=0.005,β=0.075,(控制器中的参数)k1和k3分别满足k1-ρ>0,k3-ρ1>0,其中,ρ为正常数,ιmax为||EJ-1d||的最大值
u取值范围是根据航天器所携带的执行器来确定的,针对小型航天器一般可以选取5N以内;
航天器的期望姿态和速度定义如下:ωd=[0.1sin(t/40),-0.1cos(t/50),-0.1sin(t/60)]Trad/s,Rd(0)=I。
公式(10)中描述的外部干扰取值为:d=2×10-3[sin(0.1t),cos(0.2t),sin(0.2t)]TN·m。
当STS<0.01时,为了减少抖震,采用来代替
图1-3分别给出了和的仿真曲线,图4给出了控制力矩曲线,由图4可知,初始时刻控制力矩比较大。
从图1姿态误差和时间图中,可以看出知航天器收敛到稳定状态,机动调整时间可在10秒左右完成,并且由图1可以看出,i=1,i=2,i=3,(i=1,i=2,i=3分别表示图中姿态误差的三个分量的曲线)
航天器三个方向上的姿态误差在10秒钟左右趋近与0,说明姿态机动调整控制在10秒内完成。
从图2姿态误差导数和时间图中,可以看出航天器机动在10s内收敛到稳定状态;(i=1,i=2,i=3分别表示图中姿态误差导数的三个分量的曲线)
航天器三个方向上的姿态误差导数在10秒内趋近于0,说明航天器机动在10秒内收敛到稳定。
从图3角速度误差和时间图中,可以看出航天器机动在10s内收敛到稳定状态;(i=1,i=2,i=3分别表示图中角速度的三个分量的曲线)
航天器三个方向上的角速度误差在10秒内趋近于0,说明航天器机动在10秒内收敛到稳定。
从图4控制力矩和时间图,可以看出航天器机动在10s内收敛到稳定状态;(i=1,i=2,i=3分别表示图中控制力矩的三个分量的曲线)
航天器三个方向上的控制力矩在10秒内趋近于0,说明航天器机动在10秒内收敛到稳定状态。
实施例2
双曲线正切函数和辅助系统控制法
其包括,以下步骤:
步骤1.建立航天器姿态动力学方程;
航天器姿态动力学方程定义如公式(23)-(25)所示:
ω∈R3×1为航天器在本体坐标系中的角速度,R∈SO(3)为将本体坐标系转化为惯性坐标系的旋转矩阵,u∈R3×1和d∈R3×1分别是控制力矩和外部干扰力矩,J∈R3×3为惯性矩阵。
步骤2.引入外部干扰姿态误差:
利用所定义的旋转矩阵误差和角速度误差,可以得到姿态误差的相对微分方程公式(26)-(28);
和分别表示旋转矩阵误差和角速度误差,其中,Rd∈SO(3)和ωd∈R3×1表示参考坐标系中的参考姿态和参考角速度。
由于误差是一个矩阵,并不能直接用来设计控制器。Lee构造了一个新的姿态误差函数;
姿态误差函数和姿态误差向量如公式(29)-(30)定义;
采用姿态误差公式(29)-(30)可以重新表示为公式(31)-(32)的形式,
其中,符号∨表示将斜对称矩阵转移为向量,如(a×)∨=a和(A∨)×=A其中,a∈R3×1是一个向量,A是一个斜对称矩阵;
当时,航天器姿态动力学方程是有效的;
并在集合中设计有限时间控制器,其中姿态误差向量和E采用Lee文献中的方法进行定义;
步骤3.为克服航天器外部干扰和惯性参数问题,引入航天器有限时间控制:
引理1:当||x||≤π和时,存在x∈R3,在集合Υ中,且E为可逆矩阵(Lee 2012);
引理2:考虑系统(Hu 2014)
x(t)=f(x(t)),x(0)=0,f(0)=0,x∈Rn (34)
其中,f:U0→Rn在原点U0的开放领域内是连续的,公式(34)描述的系统在前面所述的所有初始条件下具有一个唯一解,公式(34)描述系统的平衡点x=0是Lyapunov稳定,且在有限时间内收敛到原点的一个领域内,则该系统为局部有限时间稳定;
有限时间收敛意味着存在一个函数T:U\{0}→(0,∞),使得公式(34)的解表示为st(x0),其中x0为初始状态,当t∈[0,T(x0)]时st(x0)∈U\{0};当t>T(x0)时,st(x0)=0,当U=Rn时,可以获得航天器有限时间稳定的结果;
步骤4.为克服执行器饱和输入的问题,引入双曲线正切函数和辅助系统控制
假设1:假定d,ωd和分别满足||d||≤dmax和其中dmax和ωdmax是已知正常数;
基于TSM方法,采用有限时间控制的思想设计一个航天器鲁棒控制器,快速终端滑动表面如公式(35)所示,其中0<γ<1,α,β,和η均为正常数(Guo et al.2014);
r1=(2-γ)ηγ-1,r2=(γ-1)ηγ-2 (39)
利用双曲线正切函数和辅助系统控制法,由公式(40)-(42)给出了航天器在输入饱和情况下的控制律,k1,k2,k3,k4,ε1和ε2均为正常值,且k5>||EJ-1d||;
u=-k1tanh(ε1ζ)-k2tanh(ε2S) (40)
η=S-ζ (41)
定理2:考虑满足假设1条件下且由公式(31)-(33)定义的航天器,按照公式(40)-(42)设计控制率,则可有如下结论:
(i)吸引域如公式(43)所示
(ii)S,和分别在有限时间内收敛到0
证明:设计如公式(44)所示李雅普诺夫函数
沿系统(31)-(33)对所设计的李雅普诺夫函数(45)求导可得:
为了保证姿态误差向量在集合Υ中,设计函数同时满足公式(46);
由公式(46)可得公式(43):
则(i)证明完毕:
从t0到t对积分,可得
解不等式(47)可得:
其中,
由于V2(t)=0,,当t≥t*时,滑模面S和收敛到0;从公式可得,在有限时间内收敛到0:
则(ii)得证,定理2证明完毕,
步骤5.将步骤4中的公式(40)-(42)设计航天器控制器,以解决外部扰动和输入饱和问题。
为了验证第二个控制器的效果,进行如下数值仿真。
航天器三个轴均有连续执行机构,且最大力矩为4N·m
航天器姿态动力学方程:ω(0)=[0.1,0.1,0.1]rad/s;d=2×10-3[sin(0.1t),cos(0.2t),sin(0.2t)]TN·m;
R∈SO(3)为将本体坐标系转化为惯性坐标系的旋转矩阵,J∈R3×3为惯性矩阵;ω∈R3×1=[ω1,ω2,ω3]T为航天器在本体坐标系中的角速度,u∈R3×1和d∈R3×1分别是控制力矩和外部干扰力矩。
引入外部干扰误差:满足吸引域(43)
为克服执行器饱和输入的问题,引入双曲线正切函数和辅助系统控制
利用双曲线正切函数和辅助系统控制法,由公式(40)-(42)给出了航天器在输入饱和情况下的控制律,k1,k2,k3,k4,ε1和ε2均为正常值,且k5>||EJ-1d||
为k1=2,k2=2,k3=10,k4=0.0001,k5=0.01,ε1=20,ε2=20,α=0.5,β=0.75,η=0.0001,
u取值范围是根据航天器所携带的执行器来确定的,针对小型航天器一般可以选取5N以内;
为了降低抖震,当ηTη<0.01时,采用代替
航天器在双曲线正切和辅助系统下的数值仿真如图5-10所示,由仿真结果可知航天器姿态机动在20秒内完成,且最大力矩为4N·m。图5-7分别给出了和的仿真曲线。
图5姿态误差与时间图,由图可知航天器姿态机动在20秒内完成;(i=1,i=2,i=3分别表示图中姿态误差的三个分量的曲线)
三个方向上的姿态误差在20秒钟左右趋近与0,说明姿态机动调整控制在20秒内完成。
图6姿态误差导数和时间图,由图可知航天器姿态机动在20秒内完成;(i=1,i=2,i=3分别表示图中姿态误差导数的三个分量的曲线)
航天器三个方向上的姿态误差导数在20秒内趋近于0,说明航天器机动在20秒内收敛到稳定。
图7角速度误差和时间图,由图可知航天器姿态机动在20秒内完成;(i=1,i=2,i=3分别表示图中角速度误差的三个分量的曲线)
航天器三个方向上的角速度误差在20秒内趋近于0,说明航天器机动在20秒内收敛到稳定。
图8控制力矩和时间图,由图可知航天器姿态机动在20秒内完成;(i=1,i=2,i=3分别表示图中控制力矩的三个分量的曲线)
图9ζ和时间图可知,由图可知航天器姿态机动在20秒内完成;(i=1,i=2,i=3分别表示图中ζ的三个分量的曲线)
ζ的三个分量曲线20秒内趋近于0,说明航天器机动在20秒内收敛到稳定。
图10S和时间图可知,由图可知航天器姿态机动在20秒内完成;(i=1,i=2,i=3分别表示图中S的三个分量的曲线)
ζ的三个分量曲线20秒内趋近于0,说明航天器机动在20秒内收敛到稳定。
与图1-4所得的仿真结果相比较可知,由于存在输入饱和,双曲线正切函数和辅助系统的动态特性比补偿已知有界控制法差。图8给出了控制力矩曲线,图9和图10分别给出了ζ和S的仿真曲线,由仿真结果可知,ζ和S可以在有限时间内收敛到0。
备注1:引理一的证明及各参数意义可以在Lee(2012)文献命题1中找到。
备注2:由定理1和定理2,可知吸引区域分别由公式(19)和(29)所定义,可以选择较大的函数来扩大吸引区域。
1.(引理1)Lee,T.(2012).“Exponential stability of an attitude trackingcontrol system on SO(3)for large-angle rotational maneuvers.”Syst.ControlLett.,61(1),231-237。
2.(引理2)Hu,Q.,Li,B.,and Qi,J.(2014).“Disturbance observer basedfinite-time attitude control for rigid spacecraft under input saturation.”Aerosp.Sci.Technol.,39,13-21。
3.(定理1,定理2)GuoY,Song S M,Li X H,et al.Terminal Sliding ModeControl forAttitude Tracking of Spacecraft under Input Saturation[J].JournalofAerospace Engineering,2016:06016006
最后说明的是,以上所述为本发明的优选实施方式,尽管通过上述优选实施例,已经对本发明进行了详细的说明,但本领域技术人员应当理解,可以在形式上和细节上对其作出各种改变,而不偏离本发明的权利要求书所要求的范围。
Claims (1)
1.输入饱和的航天器姿态终端滑模跟踪控制方法,其特征在于:其包括两种控制方法:
(1).补偿已知有界控制法;
(2).双曲线正切函数和辅助系统控制法;
其中,补偿已知有界控制法包括以下步骤:
步骤1.建立航天器姿态动力学方程;
航天器姿态动力学方程定义如公式(1)-(3)所示:
<mrow>
<mover>
<mi>R</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<msup>
<mi>R&omega;</mi>
<mo>&times;</mo>
</msup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>J</mi>
<mover>
<mi>&omega;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mo>-</mo>
<msup>
<mi>&omega;</mi>
<mo>&times;</mo>
</msup>
<mi>J</mi>
<mi>&omega;</mi>
<mo>+</mo>
<mi>u</mi>
<mo>+</mo>
<mi>d</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msup>
<mi>&omega;</mi>
<mo>&times;</mo>
</msup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&omega;</mi>
<mn>3</mn>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>&omega;</mi>
<mn>2</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>&omega;</mi>
<mn>3</mn>
</msub>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&omega;</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&omega;</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>&omega;</mi>
<mn>1</mn>
</msub>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
ω∈R3×1=[ω1,ω2,ω3]T为航天器在本体坐标系中的角速度,ω1,ω2,ω3为ω的三个元素;R∈SO(3)为将本体坐标系转化为惯性坐标系的旋转矩阵,u∈R3×1和d∈R3×1分别是控制力矩和外部干扰力矩,J∈R3×3为惯性矩阵;
步骤2.引入外部干扰姿态误差:
姿态误差函数和姿态误差向量如公式(4)-(5)定义;
<mrow>
<mi>&psi;</mi>
<mrow>
<mo>(</mo>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mn>2</mn>
<mo>-</mo>
<msqrt>
<mrow>
<mn>1</mn>
<mo>+</mo>
<mi>t</mi>
<mi>r</mi>
<mrow>
<mo>(</mo>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>)</mo>
</mrow>
</mrow>
</msqrt>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>4</mn>
<mo>)</mo>
</mrow>
</mrow>
采用姿态误差利用所定义的旋转矩阵误差和角速度误差可以表示为公式(6)-(8)的形式,
<mrow>
<msub>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
</msub>
<mo>=</mo>
<mi>E</mi>
<mover>
<mi>&omega;</mi>
<mo>~</mo>
</mover>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>6</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>J</mi>
<mover>
<mover>
<mi>&omega;</mi>
<mo>~</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mi>F</mi>
<mo>+</mo>
<mi>u</mi>
<mo>+</mo>
<mi>d</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>E</mi>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mrow>
<mn>2</mn>
<msqrt>
<mrow>
<mn>1</mn>
<mo>+</mo>
<mi>t</mi>
<mi>r</mi>
<mrow>
<mo>(</mo>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>)</mo>
</mrow>
</mrow>
</msqrt>
</mrow>
</mfrac>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mi>r</mi>
<mo>(</mo>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>)</mo>
<mi>I</mi>
<mo>-</mo>
<msup>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mi>T</mi>
</msup>
<mo>+</mo>
<mn>2</mn>
<msub>
<mi>e</mi>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
</msub>
<msubsup>
<mi>e</mi>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mi>T</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>8</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,符号∨表示将斜对称矩阵转移为向量;
当时,航天器姿态动力学方程是有效的;
步骤3.为克服航天器外部旋转矩阵误差和角速度误差和惯性参数问题,引入航天器有限时间控制
引理1:当||x||≤π和时,存在x∈R3,在集合Υ中, 且E为可逆矩阵;
引理2:考虑系统
x(t)=f(x(t)),x(0)=0,f(0)=0,x∈Rn (9)
其中,f:U0→Rn在原点U0的开放领域内是连续的,公式(9)描述的系统在前面所述的所有初始条件下具有一个唯一解,公式(9)描述系统的平衡点x=0是Lyapunov稳定,且在有限时间内收敛到原点的一个领域内,则该系统为局部有限时间稳定;
有限时间收敛意味着存在一个函数T:U\{0}→(0,∞),使得公式(9)的解表示为st(x0),其中x0为初始状态,当t∈[0,T(x0)]时st(x0)∈U\{0};当t>T(x0)时,limt→T(x0)st(x0)=0,st(x0)=0,当U=Rn时,可以获得航天器有限时间稳定的结果;
步骤4.进行有限时间稳定收敛设计:
假设1:d,ωd和分别满足||d||≤dmax和其中dmax和ωdmax是已知正常数;
快速终端滑动表面如公式(10)所示,其中0<γ<1,α,β,和η均为正常数;
<mrow>
<mi>S</mi>
<mo>=</mo>
<msub>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
</msub>
<mo>+</mo>
<msub>
<mi>&alpha;e</mi>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
</msub>
<mo>+</mo>
<mi>&beta;</mi>
<mi>f</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>e</mi>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>10</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>f</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>e</mi>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
</msub>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msup>
<mrow>
<mo>&lsqb;</mo>
<mi>f</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>e</mi>
<mrow>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>,</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>,</mo>
<mi>f</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>e</mi>
<mrow>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>,</mo>
<mn>2</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>,</mo>
<mi>f</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>e</mi>
<mrow>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>,</mo>
<mn>3</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
</mrow>
<mi>T</mi>
</msup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>11</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>f</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>e</mi>
<mrow>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>,</mo>
<mi>i</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<msub>
<mi>e</mi>
<mrow>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>,</mo>
<mi>i</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>r</mi>
<mn>2</mn>
</msub>
<mi>s</mi>
<mi>i</mi>
<mi>g</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>e</mi>
<mrow>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>,</mo>
<mi>i</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<msubsup>
<mi>e</mi>
<mrow>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>,</mo>
<mi>i</mi>
</mrow>
<mn>2</mn>
</msubsup>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>|</mo>
<msub>
<mi>e</mi>
<mrow>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>,</mo>
<mi>i</mi>
</mrow>
</msub>
<mo>|</mo>
<mo>&le;</mo>
<mi>&eta;</mi>
<mo>,</mo>
<mi>i</mi>
<mo>=</mo>
<mn>1</mn>
<mo>,</mo>
<mn>2</mn>
<mo>,</mo>
<mn>3</mn>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>s</mi>
<mi>i</mi>
<mi>g</mi>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>e</mi>
<mrow>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>,</mo>
<mi>i</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mi>&gamma;</mi>
</msup>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>o</mi>
<mi>t</mi>
<mi>h</mi>
<mi>e</mi>
<mi>r</mi>
<mi>s</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>12</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>s</mi>
<mi>i</mi>
<mi>g</mi>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>e</mi>
<mrow>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>,</mo>
<mi>i</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mi>&gamma;</mi>
</msup>
<mo>=</mo>
<mo>|</mo>
<msub>
<mi>e</mi>
<mrow>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>,</mo>
<mi>i</mi>
</mrow>
</msub>
<msup>
<mo>|</mo>
<mi>&gamma;</mi>
</msup>
<mi>s</mi>
<mi>i</mi>
<mi>g</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>e</mi>
<mrow>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>,</mo>
<mi>i</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>13</mn>
<mo>)</mo>
</mrow>
</mrow>
r1=(2-γ)ηγ-1,r2=(γ-1)ηγ-2 (14)
得如公式(15)基于终端滑模控制所设计的有限时间收敛控制率,其中k1,k2,k3和均为正常数;另外,k1和k3分别满足k1-ρ>0,k3-ρ1>0,其中,ρ为正常数,ιmax为||EJ-1d||的最大值;
步骤5.将步骤4中的公式(15)控制率用于设计航天器控制器,用于补偿已知有界的外部干扰,解决外部扰动,保证有限时间收敛稳定;
(2)、双曲线正切函数和辅助系统控制法,其包括以下步骤:
步骤1.建立航天器姿态动力学方程;
航天器姿态动力学方程定义如公式(16)-(18)所示:
<mrow>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>=</mo>
<msup>
<mi>R&omega;</mi>
<mo>&times;</mo>
</msup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>16</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>J</mi>
<mover>
<mi>&omega;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mo>-</mo>
<msup>
<mi>&omega;</mi>
<mo>&times;</mo>
</msup>
<mi>J&omega;</mi>
<mo>+</mo>
<mi>u</mi>
<mo>+</mo>
<mi>d</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>17</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msup>
<mi>&omega;</mi>
<mo>&times;</mo>
</msup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&omega;</mi>
<mn>3</mn>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>&omega;</mi>
<mn>2</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>&omega;</mi>
<mn>3</mn>
</msub>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&omega;</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&omega;</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>&omega;</mi>
<mn>1</mn>
</msub>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>18</mn>
<mo>)</mo>
</mrow>
</mrow>
ω∈R3×1=[ω1,ω2,ω3]T为航天器在本体坐标系中的角速度,ω1,ω2,ω3为ω的三个元素;R∈SO(3)为将本体坐标系转化为惯性坐标系的旋转矩阵,u∈R3×1和d∈R3×1分别是控制力矩和外部干扰力矩,J∈R3×3为惯性矩阵;
步骤2.引入外部干扰姿态误差:
姿态误差函数和姿态误差向量如公式(19)-(20)定义;
<mrow>
<mi>&psi;</mi>
<mrow>
<mo>(</mo>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mn>2</mn>
<mo>-</mo>
<msqrt>
<mrow>
<mn>1</mn>
<mo>+</mo>
<mi>t</mi>
<mi>r</mi>
<mrow>
<mo>(</mo>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>)</mo>
</mrow>
</mrow>
</msqrt>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>19</mn>
<mo>)</mo>
</mrow>
</mrow>
采用姿态误差利用所定义的旋转矩阵误差和角速度误差可以表示为公式(21)-(23)的形式,
<mrow>
<msub>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
</msub>
<mo>=</mo>
<mi>E</mi>
<mover>
<mi>&omega;</mi>
<mo>~</mo>
</mover>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>21</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>J</mi>
<mover>
<mover>
<mi>&omega;</mi>
<mo>~</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mi>F</mi>
<mo>+</mo>
<mi>u</mi>
<mo>+</mo>
<mi>d</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>22</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>E</mi>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mrow>
<mn>2</mn>
<msqrt>
<mrow>
<mn>1</mn>
<mo>+</mo>
<mi>t</mi>
<mi>r</mi>
<mrow>
<mo>(</mo>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>)</mo>
</mrow>
</mrow>
</msqrt>
</mrow>
</mfrac>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mi>r</mi>
<mo>(</mo>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>)</mo>
<mi>I</mi>
<mo>-</mo>
<msup>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mi>T</mi>
</msup>
<mo>+</mo>
<mn>2</mn>
<msub>
<mi>e</mi>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
</msub>
<msubsup>
<mi>e</mi>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mi>T</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>23</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,符号∨表示将斜对称矩阵转移为向量;
当时,航天器姿态动力学方程是有效的;
步骤3.为克服航天器外部旋转矩阵误差和角速度误差和惯性参数问题,引入航天器有限时间控制
引理1:当||x||≤π和时,存在x∈R3,在集合Υ中, 且E为可逆矩阵;
引理2:考虑系统
x(t)=f(x(t)),x(0)=0,f(0)=0,x∈Rn (24)
其中,f:U0→Rn在原点U0的开放领域内是连续的,公式(24)描述的系统在前面所述的所有初始条件下具有一个唯一解,公式(24)描述系统的平衡点x=0是Lyapunov稳定,且在有限时间内收敛到原点的一个领域内,则该系统为局部有限时间稳定;
有限时间收敛意味着存在一个函数T:U\{0}→(0,∞),使得公式(24)的解表示为st(x0),其中x0为初始状态,当t∈[0,T(x0)]时st(x0)∈U\{0};当t>T(x0)时,st(x0)=0,当U=Rn时,可以获得航天器有限时间稳定的结果;
步骤4.进行有限时间稳定收敛设计:
假设1:d,ωd和分别满足||d||≤dmax和其中dmax和ωdmax是已知正常数;
快速终端滑动表面如公式(10)所示,其中0<γ<1,α,β,和η均为正常数;
<mrow>
<mi>S</mi>
<mo>=</mo>
<msub>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
</msub>
<mo>+</mo>
<msub>
<mi>&alpha;e</mi>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
</msub>
<mo>+</mo>
<mi>&beta;</mi>
<mi>f</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>e</mi>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>25</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>f</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>e</mi>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
</msub>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msup>
<mrow>
<mo>&lsqb;</mo>
<mi>f</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>e</mi>
<mrow>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>,</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>,</mo>
<mi>f</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>e</mi>
<mrow>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>,</mo>
<mn>2</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>,</mo>
<mi>f</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>e</mi>
<mrow>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>,</mo>
<mn>3</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
</mrow>
<mi>T</mi>
</msup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>26</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>f</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>e</mi>
<mrow>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>,</mo>
<mi>i</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<msub>
<mi>e</mi>
<mrow>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>,</mo>
<mi>i</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>r</mi>
<mn>2</mn>
</msub>
<mi>s</mi>
<mi>i</mi>
<mi>g</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>e</mi>
<mrow>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>,</mo>
<mi>i</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<msubsup>
<mi>e</mi>
<mrow>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>,</mo>
<mi>i</mi>
</mrow>
<mn>2</mn>
</msubsup>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>|</mo>
<msub>
<mi>e</mi>
<mrow>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>,</mo>
<mi>i</mi>
</mrow>
</msub>
<mo>|</mo>
<mo>&le;</mo>
<mi>&eta;</mi>
<mo>,</mo>
<mi>i</mi>
<mo>=</mo>
<mn>1</mn>
<mo>,</mo>
<mn>2</mn>
<mo>,</mo>
<mn>3</mn>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>s</mi>
<mi>i</mi>
<mi>g</mi>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>e</mi>
<mrow>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>,</mo>
<mi>i</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mi>&gamma;</mi>
</msup>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>o</mi>
<mi>t</mi>
<mi>h</mi>
<mi>e</mi>
<mi>r</mi>
<mi>s</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>27</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>s</mi>
<mi>i</mi>
<mi>g</mi>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>e</mi>
<mrow>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>,</mo>
<mi>i</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mi>&gamma;</mi>
</msup>
<mo>=</mo>
<mo>|</mo>
<msub>
<mi>e</mi>
<mrow>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>,</mo>
<mi>i</mi>
</mrow>
</msub>
<msup>
<mo>|</mo>
<mi>&gamma;</mi>
</msup>
<mi>s</mi>
<mi>i</mi>
<mi>g</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>e</mi>
<mrow>
<mover>
<mi>R</mi>
<mo>~</mo>
</mover>
<mo>,</mo>
<mi>i</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>28</mn>
<mo>)</mo>
</mrow>
</mrow>
r1=(2-γ)ηγ-1,r2=(γ-1)ηγ-2 (29)
步骤5.为克服执行器饱和输入的问题,引入双曲线正切函数和辅助系统控制:
由于公式(29)中u是没有物理限制的量,当输入饱和情况下,外部干扰对航天器的影响较大;
由公式(30)-(32)给出了航天器在输入饱和情况下的控制律,k1,k2,k3,k4,ε1和ε2均为正常值,且k5>||EJ-1d||;
u=-k1tanh(ε1ζ)-k2tanh(ε2S)
(30)
η=S-ζ
(31)
步骤6.将步骤5中的公式(30)-(32)用于设计航天器的控制器,以解决外部扰动和输入饱和问题。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710743352.XA CN107608210B (zh) | 2017-08-25 | 2017-08-25 | 输入饱和的航天器姿态终端滑模跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710743352.XA CN107608210B (zh) | 2017-08-25 | 2017-08-25 | 输入饱和的航天器姿态终端滑模跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107608210A true CN107608210A (zh) | 2018-01-19 |
CN107608210B CN107608210B (zh) | 2020-06-23 |
Family
ID=61055725
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710743352.XA Active CN107608210B (zh) | 2017-08-25 | 2017-08-25 | 输入饱和的航天器姿态终端滑模跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107608210B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108363840A (zh) * | 2018-01-23 | 2018-08-03 | 中国人民解放军战略支援部队航天工程大学 | 一种基于电磁力的集群航天器磁矩最优分配方法 |
CN110007604A (zh) * | 2019-05-14 | 2019-07-12 | 哈尔滨工程大学 | 基于滑模技术的有缆水下机器人海底定点着陆饱和控制方法 |
CN112000006A (zh) * | 2020-07-06 | 2020-11-27 | 南京邮电大学 | 基于有限时间快速非奇异终端滑模的自主航天器交会控制方法 |
CN113619814A (zh) * | 2021-06-29 | 2021-11-09 | 北京控制工程研究所 | 一种交会对接最后逼近段相对姿轨耦合控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103425135A (zh) * | 2013-07-30 | 2013-12-04 | 南京航空航天大学 | 一种具有输入饱和的近空间飞行器鲁棒控制方法 |
CN104950899A (zh) * | 2015-06-10 | 2015-09-30 | 北京理工大学 | 一种固定时间收敛的飞行器姿态控制方法 |
CN105629732A (zh) * | 2016-01-29 | 2016-06-01 | 北京航空航天大学 | 一种考虑控制受限的航天器姿态输出反馈跟踪控制方法 |
CN106802660A (zh) * | 2017-03-09 | 2017-06-06 | 北京航天自动控制研究所 | 一种复合强抗扰姿态控制方法 |
CN106886149A (zh) * | 2017-02-23 | 2017-06-23 | 哈尔滨工业大学 | 一种航天器鲁棒有限时间饱和姿态跟踪控制方法 |
-
2017
- 2017-08-25 CN CN201710743352.XA patent/CN107608210B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103425135A (zh) * | 2013-07-30 | 2013-12-04 | 南京航空航天大学 | 一种具有输入饱和的近空间飞行器鲁棒控制方法 |
CN104950899A (zh) * | 2015-06-10 | 2015-09-30 | 北京理工大学 | 一种固定时间收敛的飞行器姿态控制方法 |
CN105629732A (zh) * | 2016-01-29 | 2016-06-01 | 北京航空航天大学 | 一种考虑控制受限的航天器姿态输出反馈跟踪控制方法 |
CN106886149A (zh) * | 2017-02-23 | 2017-06-23 | 哈尔滨工业大学 | 一种航天器鲁棒有限时间饱和姿态跟踪控制方法 |
CN106802660A (zh) * | 2017-03-09 | 2017-06-06 | 北京航天自动控制研究所 | 一种复合强抗扰姿态控制方法 |
Non-Patent Citations (4)
Title |
---|
HU,QINGLEI ET AL.: "Disturbance observer based finite-time attitude control for rigidspacecraft under input saturation", 《AEROSPACE SCIENCE AND TECHNOLOGY》 * |
LEE,TAEYOUNG: "Exponential stability of an attitude tracking control system on SO(3) for large-angle rotational maneuvers", 《SYSTEMS & CONTROL LETTERS》 * |
张剑桥 等: "SE_3_上姿轨耦合航天器高精度快速终端滑模控制", 《宇航学报》 * |
赵琳 等: "基于快速终端滑模的航天器自适应容错控制", 《宇航学报》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108363840A (zh) * | 2018-01-23 | 2018-08-03 | 中国人民解放军战略支援部队航天工程大学 | 一种基于电磁力的集群航天器磁矩最优分配方法 |
CN110007604A (zh) * | 2019-05-14 | 2019-07-12 | 哈尔滨工程大学 | 基于滑模技术的有缆水下机器人海底定点着陆饱和控制方法 |
CN112000006A (zh) * | 2020-07-06 | 2020-11-27 | 南京邮电大学 | 基于有限时间快速非奇异终端滑模的自主航天器交会控制方法 |
CN112000006B (zh) * | 2020-07-06 | 2022-06-03 | 南京邮电大学 | 基于有限时间快速非奇异终端滑模的自主航天器交会控制方法 |
CN113619814A (zh) * | 2021-06-29 | 2021-11-09 | 北京控制工程研究所 | 一种交会对接最后逼近段相对姿轨耦合控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107608210B (zh) | 2020-06-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107608210A (zh) | 输入饱和的航天器姿态终端滑模跟踪控制方法 | |
Shao et al. | High-order ESO based output feedback dynamic surface control for quadrotors under position constraints and uncertainties | |
CN103728882B (zh) | 微陀螺仪的自适应反演非奇异终端滑模控制方法 | |
Bu et al. | Tracking differentiator design for the robust backstepping control of a flexible air-breathing hypersonic vehicle | |
CN100527024C (zh) | 三参数最速自抗扰控制器装置及自抗扰控制方法 | |
CN107015562B (zh) | 一种满足预设跟踪性能的欠驱动水面船舶控制方法 | |
Liu et al. | Robust dynamic output feedback control for attitude stabilization of spacecraft with nonlinear perturbations | |
Guo et al. | Terminal sliding mode control for attitude tracking of spacecraft under input saturation | |
Liang et al. | Adaptive dynamic surface control for integrated missile guidance and autopilot in the presence of input saturation | |
CN105843244A (zh) | 一种基于输出反馈的挠性航天器精细姿态控制方法 | |
Hu et al. | Adaptive fuzzy integral sliding mode control for flexible air-breathing hypersonic vehicles subject to input nonlinearity | |
CN107577145A (zh) | 编队飞行航天器反步滑模控制方法 | |
Bu et al. | Novel auxiliary error compensation design for the adaptive neural control of a constrained flexible air-breathing hypersonic vehicle | |
CN105138001A (zh) | 一种四旋翼飞行器姿态控制方法 | |
Zhang et al. | Exponential sliding mode tracking control via back-stepping approach for a hypersonic vehicle with mismatched uncertainty | |
Hu et al. | Adaptive synchronization for surface vessels with disturbances and saturated thruster dynamics | |
CN109507890A (zh) | 一种基于eso的无人机动态逆广义预测控制器 | |
Santibanez et al. | Control of the inertia wheel pendulum by bounded torques | |
Dong et al. | Anti-unwinding terminal sliding mode attitude tracking control for rigid spacecraft | |
Jingrui et al. | Adaptive spacecraft attitude tracking and parameter estimation with actuator uncertainties | |
Wu et al. | Antisaturation attitude and orbit-coupled control for spacecraft final safe approach based on fast nonsingular terminal sliding mode | |
Gou et al. | Constrained adaptive neural network control of an MIMO aeroelastic system with input nonlinearities | |
Wang et al. | Integral sliding mode based finite-time trajectory tracking control of unmanned surface vehicles with input saturations | |
Zhu et al. | Stability-based SDRE controller for spacecraft momentum management | |
CN107943097A (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 |