1.一种飞行器的有限时间输出反馈姿态跟踪控制方法,其特征在于,包括如下步骤:
I.飞行器在惯性系中的姿态参数向量 根据修正罗德里格参数定义为:
式中, 表示姿态参数向量 的第一个分量, 表示 的第二个分量, 表示 的第三个分量;θ∈(‑2π,2π)表示主旋转角的角度,α表示主旋转轴;
根据修正罗德里格参数,飞行器的运动学方程定义为:
3×3
其中,I3×3∈R 为单位矩阵; 定义为T 3
ω=[ω1,ω2,ω3]∈R表示飞行器的角速度,其中ω1表示ω的第一个分量,ω2表示ω的第二个分量,ω3表示ω的第三个分量; 表示姿态参数向量 的斜对称矩阵,表达式为飞行器的动力学方程定义为:×
Jω=‑ω Jω+sat(u)+d (3)× 3×3 ×
其中,ω ∈R 表示角速度向量ω的斜对称矩阵,表达式为ω =[0,‑ω3,ω2;ω3,0,‑T 3×3ω1;‑ω2,ω1,0];J∈R 表示惯性矩阵;
3
J包括标称部分 和不确定部分ΔJ; 满足 ε∈R是任意向* *
量, 和 是已知的正常数;ΔJ满足||ΔJ||≤ΔJ,ΔJ是未知的正常数;
3
d∈R表示由外部干扰产生的控制扭矩,且满足||d||≤d1,d1是未知的正常数;
T 3
u=[u1,u2,u3]∈R表示控制力矩;
T
sat(u)=[sat(u1),sat(u2),sat(u3)]是关于u的输入饱和函数矢量;
函数sat(ui)定义为 是已知的常数;
根据飞行器的运动学方程(2)和动力学方程(3),得到描述飞行器的姿态运动方程为:* T T
其中, 表示 的逆矩阵;J =W JW,W 表示W的转置矩阵;
表示矩阵 的斜对称矩
阵,其中η1表示 的第一个分量,η2表示 的第二个分量,η3表示 的第三个分量,表示为* T
进一步,将 代入公式(4)化简,重新定义变量 ΔJ=WΔJW,公式(4)表示为:
其中, 指 的逆矩阵, 表示矩阵的斜对称矩阵,其中σ1表示 的第一个分量,σ2表示 的第二个分量,σ3表示 的第三个分量, 表示为‑1
J 是 指J 的 逆矩 阵 ;
‑1
是指 的逆矩阵,J 是指J的逆矩阵 ,定义新的变量
则公式(5)用新的变量表示为:T T
其中,x=[x1,x2] ;F(x)=‑P(y,x2)x2=[f1(x),f2(x),f3(x)] ,f1(x)表示F(x)的第一个分量,f2(x)表示F(x)的第二个分量,f3(x)表示F(x)的第三个分量;
表达式中的sat(u)表示为T
其中,g(u)=[g(u1),g(u2),g(u3)],其中,i=1,2,3,tanh表示双曲正切函数;
II.下面构造飞行器的有限时间输出反馈姿态跟踪控制方法,以使飞行器的姿态参数向量 与期望的姿态位置向量 的跟踪误差收敛于期望邻域内;
为了估算飞行器不可测量的角速度,将建立状态观测器用于后续控制器的构建;
首先将公式(6)重写为:其中,
K表示观测器的增益矩阵,k1>0、k2>0为设计的观测器增益;是状态x的估计值;
ΔF是函数的估计误差,定义为通过选取增益矩阵K,使得矩阵A成为严格的赫尔维茨矩阵;
T T T
给出对称正矩阵Q=Q>0,必然存在一个满足AP+PA=‑Q的对称正矩阵P=P>0;
根据公式(7)构建状态观测器,即:构造紧集Ω1:
其中, 是x1的估计值, 是x2的估计值,Θ是任意正常数,||·||表示向量的2范数;
根据利普西斯条件,如果上述紧集Ω1存在,则存在正常数h,使得 成立;
*
进一步,存在正常数d,使得 也成立;
定义状态观测器的估计误差在反步控制方法的每一步中都将采用下面的有限时间命令滤波器;
其中,i=1,2,3;
μ2,1,i表示有限时间命令滤波器的状态;μ2,2,i表示有限时间命令滤波器的状态;
Ψ2,1,i表示有限时间命令滤波器的参数,Ψ2,2,i表示有限时间命令滤波器的参数;
ι2,1,i表示μ2,1,i的导数; 表示虚拟控制信号 的第i个分量,sign表示符号函数;
在控制器设计中,定义以下姿态跟踪误差:其中,z1表示姿态跟踪误差向量;
z2表示观测的状态向量与有限时间命令滤波器输出向量的误差;
T
l2=[μ2,1,1,μ2,1,2,μ2,1,3]为有限时间命令滤波器的输出;
虚拟控制信号 为有限时间命令滤波器的输入, 表示 的第一个分量, 表示 的第二个分量, 表示 的第三个分量;
由公式(10)构造虚拟控制信号 为:其中,c1>0为常数增益;φ1>0为常数增益;γ定义为 c和d是正奇数;xd3
∈R表示飞行器的目标姿态轨迹;
补偿的误差信号 和消除饱和影响的辅助信号ζ的定义将在下面给出;
构造控制力矩 其中 表示的 逆矩阵, 定义为:其中,c2>0为常数增益;φ2>0为常数增益;e1表示状态观测器的估计误差e的第一个分量,补偿的误差信号 的定义将在下面给出;
选取误差补偿信号:
其中, 表示误差补偿信号, 表示 的初始条件, s=1,2;
补偿的误差信号 定义为:消除饱和影响的辅助信号ζ定义为:选择状态观测器(8)、虚拟控制信号 和控制力矩 使得飞行器的姿态参数向量 与期望的姿态位置向量 的跟踪误差收敛于期望邻域内;
选取Lyapunov函数:由公式(7)和公式(8)得到:则有:
由不等式放缩得到:
其中,
将公式(18)、公式(19)代入公式(16)得:其中,λmin(Q)表示矩阵Q的最小的特征值,选取Lyapunov函数:对V1求导得:
其中,
将公式(11)、公式(13)和公式(14)代入公式(22),并根据不等式 得到:
选取Lyapunov函数:对V2求导:
将公式(12)、公式(13)、公式(14)、公式(15)代入公式(25),得到:为误差补偿系统选取Lyapunov函数:对 求导得:
其中, 表示 的第i个分量,s=1,2,i=1,2,3;
定义李雅普诺夫函数:
对公式(29)求导得到:其中,S1表示任意的常数;λmax(P)表示矩阵P的最大的特征值;
将上面公式求解得到的 代入公式(30)得到:*
在有限时间T内,存在 为未知常数;
根据下面给出的不等关系:其中, 表示 的第i个分量,s=1,2,i=1,2,3,则不等式(31)等价于:其中,
如果存在实数χ满足0<χ<1,则不等式(32)等价于:或
如果 则不等式(33)即能够化为 从而得到:状态观测器的估计误差e、误差信号 补偿误差信号 将在有限时间T1收敛到原点附近的期望邻域有限时间 表示 的初始条件;
如果 则不等式(34)即能够化为 从而得到:观测器误差e、误差信号 补偿误差信号 将在有限时间T2收敛到原点附近的期望邻域有限时间 表示 的初始条件;
综上,误差信号 补偿误差信号 将在有限时间T=max{T1,T2}内收敛到邻域根据公式(14),姿态跟踪误差向量z1将在有限时间T收敛到原点附近的邻域