1.一种四旋翼飞行器的全局鲁棒自适应轨迹跟踪控制方法,其特征在于,其步骤包括:步骤1):建立四旋翼飞行器的非线性动力学模型,四旋翼飞行器动力学模型分为姿态环与位置环两个控制回路;
步骤2):引入虚拟变量来描述由系统内部不确定性因素和外界扰动组成的集总干扰,集总干扰项被转化为单一虚拟变量的线性化模型;
步骤3):采用反步法设计虚拟量的自适应控制律,采用自适应策略来在线估计虚拟变量,对集总干扰进行等效补偿;
所述步骤1)具体为:
步骤1.1):建立四旋翼飞行器的运动学模型:T 3 T
其中,P=[x,y,z]∈R 为四旋翼飞行器在惯性坐标系下的位置向量,Θ=[φ,θ,ψ] ∈
3 T 3
R为四旋翼飞行器在惯性坐标系下的欧拉角向量,v=[v1,v2,v3]∈R为四旋翼飞行器在机T 3体坐标系下线速度向量,ω=[ω1,ω2,ω3]∈R为四旋翼飞行器在机体坐标系下角速度向量,RBI与SBI分别为机体坐标系到惯性坐标系的变换矩阵,具体为:式中,s(·)=sin(·),c(·)=cos(·),t(·)=tan(·),φ为横滚角,θ为俯仰角,ψ为偏航角;
步骤1.2):四旋翼飞行器受到的总力Fs和总力矩Ts为:其中, 为每个旋翼产生的升力,Tr为旋翼产生的力矩和,Fair=Kfv和Tair=Ktω分别为空气阻力作用于机体上的阻力和阻力矩,Kf和Kt分别为空气阻力系数,Fd与Td分别为外部干扰力与外部干扰力矩;
步骤1.3):根据Newton‑Euler方程推导出四旋翼的刚体动力学模型为:
3×3
其中,J=diag(Jx,Jy,Jz)∈R 为机体转动惯量;
步骤1.4):建立四旋翼飞行器的非线性动力学模型:所述外部干扰力Fd与外部干扰力矩Td分别由阵风干扰、负载变化、近地效应和电机振动组成;
所述步骤2)具体为:
步骤2.1):将非线性动力学模型转化为二阶系统的形式:T T
其中,X1=[x,y,z,φ,θ,ψ] 和X2=[v1,v2,v3,ω1,ω2,ω3]分别为四旋翼飞行器系统的状态变量及其对时间的一阶导数,B=diag[1,1,1,1/Jx,cφ/Jx,cφ/cθ/Jx]为控制增益,R(Θ)为旋转矩阵,具体形式为:6
另外,D∈R为外部干扰向量,其具体形式为:Δf和ΔB分别表示未建模参数对系统的影响;
函数f(X1)的表达式为:
6
U∈R是系统的虚拟控制量,由四个真实控制量扩张而成:T
其中,u=[u1,u2,u3,u4]为真实控制量,m为四旋翼的总质量;
步骤2.2):定义集总干扰项L为:L=Δf+ΔBU+D
步骤2.3):联立步骤2.1)和步骤2.2),得线性化模型:所述步骤3)具体为:
定义四旋翼飞行器轨迹跟踪误差及其一阶导数分别为s1=X1‑Xr与s2=X2‑α,为虚拟控制量,则设计全局鲁棒控制律与其自适应律分别为:其中,k2>0、c>0、σ>0都是可调参数, 是δ的估计值。
2.根据权利要求1所述的四旋翼飞行器的全局鲁棒自适应轨迹跟踪控制方法,其特征在于,所述可调参数由樽海鞘算法进行整定。