1.一种旋翼飞行器的有限时间航迹跟踪控制方法,其特征在于,所述方法包括以下步骤:
步骤1,建立旋翼飞行器的数学模型,所述模型包括飞行器的位移系统模型、姿态系统模型与控制关系模型;
步骤2,设计旋翼飞行器的分层控制方案,将飞行器分为高度通道、平动系统与姿态系统,并针对每个通道单独设计控制器,所述控制方案将旋翼飞行器分解为若干个二阶子系统,简化设计过程;
步骤3,设计旋翼飞行器的高度控制器,基于有限时间控制策略设计高度控制器以产生飞行所需控制力,并引入辅助系统补偿输入饱和作用,保证高度通道的有限时间收敛特性和抗干扰能力;
步骤4,设计旋翼飞行器的平动控制器,采用有限时间控制策略设计平动控制器以产生飞行器姿态系统的期望滚转角与期望俯仰角,提高平动系统的收敛速度和跟踪精度,保证平动系统的有限时间稳定性;
步骤5,设计旋翼飞行器的姿态控制器,引入线性自抗扰算法设计姿态控制器以产生飞行所需控制力矩,提高姿态系统的鲁棒性;
步骤3中旋翼飞行器的高度控制器模块的输入是高度通道状态量z,期望轨迹zd和辅助系统状态量ξ1,ξ2,输出是理想控制力u,高度控制器的设计过程如下:首先设计有限时间收敛的辅助系统为:其中,ξ1,ξ2是辅助系统的状态变量,c1>0,c2>0,0<υ<1是辅助系统参数;
定义补偿误差为:
e1=z‑zd‑ξ1,
其中,zd是期望高度,α是待设计的虚拟控制量;
设计虚拟控制量为:
其中,k1>0,l1>0,0<σ<1是待设计的控制器参数;
设计理想控制力为:
其中, k2>0,l2>0,0<σ<1是待设计的控制器参数。
2.根据权利要求1所述的一种旋翼飞行器的有限时间航迹跟踪控制方法,其特征在于,步骤1中所述旋翼飞行器为共轴十二旋翼飞行器,飞行器的位移系统模型为:其中,φ,θ,ψ分别表示旋翼飞行器的滚转角、俯仰角与偏航角,x,y,z表示飞行器的位置坐标,u1表示飞行器的控制力,m表示飞行器的质量,dx,dy,dz分别表示作用于飞行器位移系统各个通道的扰动作用,g表示重力加速度,飞行所需控制力u1存在输入饱和约束如下:式中,u是待综合的理想控制力,umax是输入饱和约束的上界,umin是输入饱和约束的下界。
3.根据权利要求1所述的一种旋翼飞行器的有限时间航迹跟踪控制方法,其特征在于,步骤1中所述飞行器的姿态系统模型为:其中,p,q,r分别表示飞行器的滚转角速度、俯仰角速度与偏航角速度,u2,u3,u4表示飞行器的控制力矩,Ix,Iy,Iz表示飞行器对机体各轴的转动惯量,dφ,dθ,dψ分别表示作用于飞行器姿态系统各个通道的扰动作用。
4.根据权利要求1所述的一种旋翼飞行器的有限时间航迹跟踪控制方法,其特征在于,步骤1中所述飞行器的控制关系模型如下:T
其中M=[u2,u3,u4]表示作用于飞行器的总力矩,Ω1,Ω2,Ω3,Ω4,Ω5,Ω6,Ω7,Ω8,Ω9,Ω10,Ω11,Ω12表示旋翼1,2,3,4,5,6,7,8,9,
10,11,12的转速,l表示飞行器质心和旋翼中心之间的距离,k1表示升力因子,k2表示反扭力矩因子,Ir表示旋翼和电机转子的转动惯量,γ表示各个旋翼转轴与机体平面的夹角。
5.根据权利要求1所述的一种旋翼飞行器的有限时间航迹跟踪控制方法,其特征在于,步骤2中针对高度通道,结合辅助系统和有限时间控制策略设计飞行控制力,保证高度通道有限时间稳定的同时补偿输入饱和作用,针对平动通道,基于有限时间控制策略设计虚拟控制量,并基于此计算期望滚转角和期望俯仰角,针对姿态通道,设计线性自抗扰控制器产生飞行控制力矩,所述分层控制方案解决了旋翼飞行器欠驱动特性带来的控制难度。
6.根据权利要求1所述的一种旋翼飞行器的有限时间航迹跟踪控制方法,其特征在于,所设计的高度控制器,能够补偿输入饱和作用的同时保证飞行器高度通道的有限时间稳定性:
选取Lyapunov函数为:对V求导,并将所设计的α和u带入 中得到:其中,
γ1=2k1,γ2=2k2, γ=min{γ1,γ2},β=min{β1,β2},ι=(σ+1)/2,Dz>|dz|表示扰动作用dz的上界。
7.根据权利要求1所述的一种旋翼飞行器的有限时间航迹跟踪控制方法,其特征在于,T
步骤4中旋翼飞行器的平动控制器模块的输入是位移信息ζ=[x,y,z] ,期望轨迹xd,yd,zd,输出是虚拟控制量 平动控制器的设计过程如下:定义跟踪误差为:
T T
[χ11,χ12,χ13]=[x‑Υ1,y‑Υ2,z‑Υ3] ,T T T
其中,[xd,yd,zd] =[Υ1,Υ2,Υ3] 表示期望轨迹,[α1,α2,α3] 表示待设计的中间控制量;
设计中间控制量为:
其中,δ1i>0,λ1i>0,0<μi<1是待设计的控制器参数;
设计虚拟控制量为:
其中,δ2i>0,λ2i>0,0<μi<1是待设计的控制器参数;
那么,飞行器的期望滚转角和期望俯仰角可以由所设计的虚拟控制量 表示为:
8.根据权利要求7所述的一种旋翼飞行器的有限时间航迹跟踪控制方法,其特征在于,所设计的平动控制器能够保证飞行器平动通道的有限时间稳定性:选取Lyapunov函数为
对Vi求导,并将所设计的αi和 带入 中得到:T
其中,δi=min{2δ1i,2δ2i}, [dx,dy,dz]T
=[d1,d2,d3]表示作用于各个通道的扰动作用,Di>|di|是扰动作用di的上界。
9.根据权利要求1所述的一种旋翼飞行器的有限时间航迹跟踪控制方法,其特征在于,T
步骤5中旋翼飞行器的姿态控制器模块的输入是姿态信息η=[φ,θ,ψ] ,期望姿态角度φd,θd,ψd,姿态控制器设计如下:所述的旋翼飞行器姿态系统模块写成如下统一的二阶系统形式:T T
其中, τi=[u2,u3,u4] ,bi=[1/Ix,1/Iy,1/Iz] ,[ΔIx,ΔT
Iy,ΔIz]表示参数不确定,τid是包含耦合,参数不确定和外扰的总扰动,分别表示为τ1d=‑((Iz+ΔIz)‑(Iy+ΔIy))qr/(Ix+ΔIx)‑ΔIxτφ/Ix(Ix+ΔIx)+dφ,τ2d=‑((Ix+ΔIx)‑(Iz+ΔIz))pr/(Iy+ΔIy)‑ΔIyτθ/Iy(Iy+ΔIy)+dθ,τ3d=‑((Iy+ΔIy)‑(Ix+ΔIx))pq/(Iz+ΔIz)‑ΔIzτψ/Iz(Iz+ΔIz)+dψ;
将总扰动τid扩张为第三个状态变量 并针对扩张系统设计扩张状态观测器为:其中, 分别表示 τid的估计值, 表示估计误差,κi1>0,κi2>0,κi3>0是观测器增益;
基于上述观测器的估计值,设计姿态控制器为:其中, 是控制器增益, 是期望姿态角度。