1.一种基于扰动观测器控制的四旋翼无人机抗干扰控制方法,其特征在于,包括以下步骤:
(1)建立六自由度的四旋翼无人机动力学等效模型;
(2)针对任一自由度建立包含不匹配扰动和执行器故障的二阶数学模型;
(3)针对二阶数学模型中的不匹配扰动设计对应的扰动观测器,在有限时间内估计出扰动出现的时间和数值大小;
(4)将由于执行器故障引起的不确定项视为特殊扰动,建立观测器估计不确定项的大小;
(5)基于非奇异终端滑模控制方法设计控制律以保证四旋翼无人机的飞行性能;
(6)在无人机的控制律中加入步骤(3)和(4)所得的扰动估计值,在飞行过程中针对不匹配扰动和执行器故障进行补偿,保证飞行的稳定。
2.根据权利要求1所述的基于扰动观测器控制的四旋翼无人机抗干扰控制方法,其特征在于,所述步骤(1)中动力学等效模型如下:其中,x,y,z代表四旋翼无人机相对于惯性系的位置坐标;φ,θ,ψ代表四旋翼无人机的欧拉角,即侧倾角,俯仰角和偏航角;u1,u2,u3,u4分别代表推力,侧倾力矩,俯仰力矩和偏航力矩;Ix,Iy,Iz,m分别代表围绕四旋翼的x轴,y轴,z轴惯性常数和四旋翼无人机的质量;l是从每个转子的中心到四旋翼的重心的距离,Jr是螺旋桨的惯性,c是力对力矩的比例因子。
3.根据权利要求1所述的基于扰动观测器控制的四旋翼无人机抗干扰控制方法,其特征在于,所述步骤(2)中对高度z建立的二阶数学模型为:其中 f为由于执行器故引起的不确定项,dz为不匹配扰动。
4.根据权利要求1所述的基于扰动观测器控制的四旋翼无人机抗干扰控制方法,其特征在于,所述步骤(3)中,扰动观测器形式如下:
1/(r+1) r/(r+1)vz0=‑λ0L |τz0‑x1| sgn(τz0‑x1)+τz1
1/(r) (r‑1)/r
vz1=‑λ1L |τz1‑vz0| sgn(τz1‑vz0)+τz2
1/2 1/2
vz(r‑1)=‑λr‑1L |τz(r‑1)‑vz(r‑2)| sgn(τz(r‑1)‑vz(r‑2))+τzrvzr=‑λrLsgn(τzr‑vz(r‑1))其中λ0,λ1,...,λr为观测器设计系数, vzi为辅助变量,r为根据观测器设计的最大阶数,按实际控制需求取值。
5.根据权利要求3所述的基于扰动观测器控制的四旋翼无人机抗干扰控制方法,其特征在于,所述步骤(4)包括:
其中κ1,κ2为观测器变量,e2=κ2‑f,l1,l2为满足以下条件的观测器增益系数:
6.根据权利要求1所述的基于扰动观测器控制的四旋翼无人机抗干扰控制方法,其特征在于,所述步骤(5)包括如下步骤:结合非奇异终端滑模控制方法,引入扰动估计值 定义四旋翼无人机系统在失配扰动下的滑模面,其表达式如下:
基于上述滑模面,设计对应的控制律,其表达式如下:其中sgn为符号函数,其取值如下所示: