技术特征:1.一种基于观测器的四旋翼无人机容错控制方法,其特征是,步骤如下:首先定义惯性坐标系{I}、机体坐标系{B}和目标坐标系{Bd},通过分析执行器对四旋翼无人机的作用原理,用未知对角矩阵表示执行器故障对其动力学特性的影响,得到四旋翼无人机执行器发生故障时的非线性动力学模型:
式(1)中各变量定义如下:ω=[ω1 ω2 ω3]T∈R3×1表示机体坐标系{B}相对于惯性坐标系{I}的姿态角速度,ω1,ω2,ω3分别表示滚转角速度、俯仰角速度和偏航角速度,[·]T表示矩阵的转置,∈表示集合间的“属于”关系,R3×1表示3行1列的实数向量,表示求取ω的一阶时间导数,下同;J∈R3×3为转动惯量,S(ω)表示求取ω对应的反对称矩阵,L∈R3×4为与机身长度和反扭矩系数相关的常系数矩阵,F=diag{[f1 f2 f3 f4]T}∈R4×4表示升力矩阵,f1,f2,f3,f4分别表示四个电机产生的升力,diag{[f1 f2 f3 f4]T}表示向量[f1 f2 f3f4]张成的对角矩阵,λ=[λ1 λ2 λ3 λ4]T∈R4×1表示故障向量,λi=1,i=1,2,3,4表示第i个通道执行器正常,λi≠1,i=1,2,3,4表示第i个通道执行器发生故障,假设执行器故障为常增益型故障,因此故障向量λ满足:
为避免姿态表示奇异性问题,采用基于单位四元数的姿态表示方法,机体坐标系{B}在惯性坐标系{I}下的表达用“等效轴角坐标系”方法,将{B}和{I}重合,将{B}绕矢量k∈R3×1按右手定则旋转角,得到当前姿态单位四元数其中且满足k∈R3×1为定义在坐标系{I}中的任意单位矢量,为坐标系{B}绕矢量k旋转的任意角度;由机体坐标系{B}到惯性坐标系{I}的坐标变换矩阵用四元数表示为I3为3×3的单位矩阵,下同,S(qv)表示求取qv对应的反对称矩阵,同理,目标坐标系{Bd}在惯性坐标系{I}下的表达也可以用“等效轴角坐标系”方法,将{Bd}和{I}重合,将{Bd}绕矢量kd∈R3×1按右手定则旋转角,得到目标姿态单位四元数其中且满足kd∈R3×1为定义在坐标系{I}中的任意单位矢量,为坐标系{Bd}绕矢量kd旋转的任意角度;由目标坐标系{Bd}到惯性坐标系{I}的坐标变换矩阵用四元数表示为S(qvd)表示求取qvd对应的反对称矩阵,为了描述四旋翼无人机当前姿态与目标姿态之间的差异,定义姿态误差四元数
其中e0和ev同样满足由目标坐标系{Bd}到机体坐标系{B}的坐标变换矩阵示为S(ev)表示求取ev对应的反对称矩阵;
为了对四旋翼无人机执行器故障进行更有针对性的容错控制,采用基于浸入-不变集方法的观测器技术对执行器进行观测,定义观测器为:
其中ξ∈R4为观测器状态,表示求取ξ的一阶时间导数,为待求函数,为方便表示,用X代替ωd,eq,表示求取对ω的偏导数,表示求取对的偏导数,表示求取对X的偏导数,J-1表示J的逆矩阵,表示求取的一阶时间导数,表示求取X的一阶时间导数,表示对λ的估计向量,表示对ω的估计值,且满足:
其中为正增益函数,定义故障观测误差为z∈R4:
其中r∈R为动态增益,对z求一阶时间导数,得
假设存在正常数γ和连续可微矩阵:利用分别表示的列向量,使得:
定义其中W1,W2,W3分别为:
其中表示相对于σ从0到ω1的定积分,下同,式(8)中分别为:
其中表示在ω1=σ,时的取值,对W1求ω1的偏导数,整理得
其中表示求取对ω1的偏导数,同理可得,因此写为:
定义ω的估计误差为:由于连续可微,因此存在δij∈R4,i,j=1,2,3满足:
因此写为:
其中表示求取eω1Δ1+eω2Δ2+eω3Δ3的和,Δj=[δ1j δ2j δ3j]∈R4×3,δjj=0,j=1,2,3,将式(15)代入式(7),整理得
对eω求一阶时间导数,整理得
设计r,分别满足:
其中,r(0)表示r的初值,c,m,p均为正常数,且满足c≥3/(2γ),表示Δj的上界,||·||表示2范数,I3为3×3的单位矩阵,为3×3的对角矩阵,若式(16)和式(17)成立,则由式(16)和式(17)组成的系统有一个全局稳定的平衡点(z,eω)=(0,0),且z,r,eω均有界。
2.如权利要求1所述的基于观测器的四旋翼无人机容错控制方法,其特征是,由式(16)和式(17)组成的系统有一个全局稳定的平衡点(z,eω)=(0,0),且z(t),r(t),eω(t)均有界的证明步骤是采用基于Lyapunov的分析方法进行证明,具体地:
定义滑模面其中Ks为一3×3的正常数增益对角矩阵,证明当s渐近收敛到0时,和ev也渐近收敛到0的过程是:
对s求导,并将代入得
其中:
,
rLFz是有界的,因此假设||-rLFz||≤ρ,ρ为正常数,设计控制输入F为
其中LR=LT(LLT)-1表示矩阵L的伪逆矩阵,Γ为一3×3的正常数增益对角矩阵,sign为符号函数,将式(19)代入式(18),采用基于Lyapunov的分析方法可以证明闭环系统全局渐近稳定,即当时间趋于无穷时,滑模面s渐近收敛到0,则和ev也渐近收敛到0。