[发明专利]基于观测器的四旋翼无人机容错控制方法

权利要求书

1.一种基于观测器的四旋翼无人机容错控制方法，其特征是，步骤如下：首先定义惯性坐标系{I}、机体坐标系{B}和目标坐标系{B_d}，通过分析执行器对四旋翼无人机的作用原理，用未知对角矩阵表示执行器故障对其动力学特性的影响，得到四旋翼无人机执行器发生故障时的非线性动力学模型：

式(1)中各变量定义如下：ω＝[ω₁ ω₂ ω₃]^T∈R^3×1表示机体坐标系{B}相对于惯性坐标系{I}的姿态角速度，ω₁,ω₂,ω₃分别表示滚转角速度、俯仰角速度和偏航角速度，[·]^T表示矩阵的转置，∈表示集合间的“属于”关系，R^3×1表示3行1列的实数向量，表示求取ω的一阶时间导数，下同；J∈R^3×3为转动惯量，S(ω)表示求取ω对应的反对称矩阵，L∈R^3×4为与机身长度和反扭矩系数相关的常系数矩阵，F＝diag{[f₁ f₂ f₃ f₄]^T}∈R^4×4表示升力矩阵，f₁,f₂,f₃,f₄分别表示四个电机产生的升力，diag{[f₁ f₂ f₃ f₄]^T}表示向量[f₁ f₂ f₃f₄]张成的对角矩阵，λ＝[λ₁ λ₂ λ₃ λ₄]^T∈R^4×1表示故障向量，λ_i＝1，i＝1,2,3,4表示第i个通道执行器正常，λ_i≠1，i＝1,2,3,4表示第i个通道执行器发生故障，假设执行器故障为常增益型故障，因此故障向量λ满足：

为避免姿态表示奇异性问题，采用基于单位四元数的姿态表示方法，机体坐标系{B}在惯性坐标系{I}下的表达用“等效轴角坐标系”方法，将{B}和{I}重合，将{B}绕矢量k∈R^3×1按右手定则旋转角，得到当前姿态单位四元数其中且满足k∈R^3×1为定义在坐标系{I}中的任意单位矢量，为坐标系{B}绕矢量k旋转的任意角度；由机体坐标系{B}到惯性坐标系{I}的坐标变换矩阵用四元数表示为I₃为3×3的单位矩阵，下同，S(q_v)表示求取q_v对应的反对称矩阵，同理，目标坐标系{B_d}在惯性坐标系{I}下的表达也可以用“等效轴角坐标系”方法，将{B_d}和{I}重合，将{B_d}绕矢量k_d∈R^3×1按右手定则旋转角，得到目标姿态单位四元数其中且满足k_d∈R^3×1为定义在坐标系{I}中的任意单位矢量，为坐标系{B_d}绕矢量k_d旋转的任意角度；由目标坐标系{B_d}到惯性坐标系{I}的坐标变换矩阵用四元数表示为S(q_vd)表示求取q_vd对应的反对称矩阵，为了描述四旋翼无人机当前姿态与目标姿态之间的差异，定义姿态误差四元数

其中e₀和e_v同样满足由目标坐标系{B_d}到机体坐标系{B}的坐标变换矩阵示为S(e_v)表示求取e_v对应的反对称矩阵；

为了对四旋翼无人机执行器故障进行更有针对性的容错控制，采用基于浸入-不变集方法的观测器技术对执行器进行观测，定义观测器为：

其中ξ∈R⁴为观测器状态，表示求取ξ的一阶时间导数，为待求函数，为方便表示，用X代替ω_d,e_q，表示求取对ω的偏导数，表示求取对的偏导数，表示求取对X的偏导数，J^-1表示J的逆矩阵，表示求取的一阶时间导数，表示求取X的一阶时间导数，表示对λ的估计向量，表示对ω的估计值，且满足：

其中为正增益函数，定义故障观测误差为z∈R⁴：

其中r∈R为动态增益，对z求一阶时间导数，得

假设存在正常数γ和连续可微矩阵：利用分别表示的列向量，使得：

定义其中W₁,W₂,W₃分别为：

其中表示相对于σ从0到ω₁的定积分，下同，式(8)中分别为：

其中表示在ω₁＝σ,时的取值，对W₁求ω₁的偏导数，整理得

其中表示求取对ω₁的偏导数，同理可得，因此写为：

定义ω的估计误差为：由于连续可微，因此存在δ_ij∈R⁴,i,j＝1,2,3满足：

因此写为：

其中表示求取e_ω1Δ₁+e_ω2Δ₂+e_ω3Δ₃的和，Δ_j＝[δ_1j δ_2j δ_3j]∈R^4×3,δ_jj＝0,j＝1,2,3，将式(15)代入式(7)，整理得

对e_ω求一阶时间导数，整理得

设计r，分别满足：

其中，r(0)表示r的初值，c,m,p均为正常数，且满足c≥3/(2γ)，表示Δ_j的上界，||·||表示2范数，I₃为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的分析方法进行证明，具体地：

定义滑模面其中K_s为一3×3的正常数增益对角矩阵，证明当s渐近收敛到0时，和e_v也渐近收敛到0的过程是：

对s求导，并将代入得

其中：

，

rLFz是有界的，因此假设||-rLFz||≤ρ，ρ为正常数，设计控制输入F为

其中L^R＝L^T(LL^T)-¹表示矩阵L的伪逆矩阵，Γ为一3×3的正常数增益对角矩阵，sign为符号函数，将式(19)代入式(18)，采用基于Lyapunov的分析方法可以证明闭环系统全局渐近稳定，即当时间趋于无穷时，滑模面s渐近收敛到0，则和e_v也渐近收敛到0。