CN106406325A - 基于模糊扩张状态观测器的四旋翼无人机反馈线性化控制方法 - Google Patents

Abstract

一种基于模糊扩张状态观测器的四旋翼无人机反馈线性化控制方法。包括：建立四旋翼无人机系统模型，初始化系统状态以及控制器参数；设计跟踪微分器；设计非线性扩张状态观测器；建立模糊规则；设计反馈线性化控制器。设计扩张状态观测器，用于估计系统模型不确定以及外部扰动，通过极点配置法来确定扩张状态观测器参数的初值，引进模糊规则，对扩张状态观测器参数进行在线整定；通过反馈线性化，使得闭环系统近似为线性系统，提高了系统的稳定性，保证系统跟踪误差快速稳定并收敛至零点，实现四旋翼无人机快速稳定的位置跟踪及姿态调整。本发明解决了系统存在模型不确定及外部扰动，改善了系统性能，实现了系统快速稳定的位置跟踪及姿态调整。

Description

基于模糊扩张状态观测器的四旋翼无人机反馈线性化控制 方法

技术领域

本发明涉及一种基于模糊扩张状态观测器的四旋翼无人机反馈线性化控制方法，针对存在耦合非线性项，易受到外部干扰的四旋翼无人机系统，实现具有良好精度的位置跟踪和姿态控制。

背景技术

近年来旋翼无人机成为国内外前沿学者的研究热点之一，四旋翼无人机作为一种典型的旋翼式无人机，以其体积小、机动性能好、设计简单、无人员伤亡风险、制造成本低廉等优点，广泛应用于航模产业、航空拍摄、电力安防、海洋监测、气象探测、城市消防、农林作业、森林防火、缉毒和应急救援等民用和军用领域，应用前景极为广阔。因此，加强无人机领域的科研力度，设计出高性能的无人机的控制方案具有十分重要的现实意义。四旋翼无人机作为旋翼无人机的一种，具有非线性、欠驱动、强耦合以及静不稳定特点。对于这类复杂系统，实现高效稳定的控制存在一定难度。同时，旋翼无人机体积小且重量轻，飞行中易受外部干扰，状态信息难以准确获取，将使控制难度加大。此外，目前无人机的飞行控制仍需要操作人员参与，无法实现真正的无人化。因此，多个耦合变量之间的解耦方案设计，对系统受到的外部干扰进行估计并补偿等问题，实现四旋翼无人机的高性能自主控制，已经成为一个亟待解决的问题。

为了估计系统的模型不确定及外部干扰，韩京清提出了自抗扰控制技术，其核心部分扩张状态观测器(Extended State Observer，ESO)，是在状态观测器的基础上扩张了一个状态变量，该状态变量用于估计作用于系统的所有外部扰动。因此，扩张状态观测器能估计系统中所有的模型不确定项以及外部干扰，从而这些干扰进行有效的补偿，减弱甚至消除外部干扰对系统性能的影响。由于扩张状态观测器的有效性和实用性，国内外很多学者的研究成果都是基于ESO估计的状态估计。其中线性扩张状态观测器由于其简单的结构，得到了广泛的应用。但目前为止，扩张状态观测器的参数主要基于工程经验来进行选择。

发明内容

为了克服现有技术系统部分状态及扰动不可测、扩张状态观测器参数难以整定等问题，本发明提出一种基于模糊扩张状态观测器的四旋翼无人机反馈线性化控制方法，设计扩张状态观测器(Extended State Observer,ESO)估计系统状态及外部扰动等不可测项并对其进行补偿，同时引入模糊规则，对扩张状态观测器参数进行在线整定，最后设计反馈线性化控制器，实现四旋翼无人机快速稳定的位置跟踪及姿态调整。

为了解决上述技术问题提出的技术方案如下：

一种基于模糊扩张状态观测器的四旋翼无人机反馈线性化控制方法，包括以下步骤：

步骤1：建立如式(1)所示的系统运动方程；

其中，x,y,z为在地面坐标系下无人机相对于原点的坐标φ,θ,ψ分别代表无人机的俯仰角，横滚角，偏航角。U₁表示作用在四旋翼无人机上的合外力。p为无人机的俯仰角角速度，为俯仰角角加速度，q为无人机的横滚角角速度，为横滚角角加速度，r为无人机的偏航角角速度，为偏航角角加速度，m为无人机的质量，I_x，I_y，I_z分别为x,y,z轴上的惯性张量，τ_x，τ_y，τ_z分别为x,y,z轴上的力矩。

步骤2：将式(1)改写为便于观测器实现的形式；

其中， Δf(·)项、d(·)项分别代表模型不确定以及外部干扰；

将式(2)进一步改写为

其中，

定义状态变量：z₁＝χ，式(1)改写为

其中，状态变量χ存在连续的一阶导数、二阶导数,模型不确定ΔF(χ,t),外部扰动D(t)满足|ΔF(χ,t)+D(t)|<h₀，h₀为某一常值；

步骤3：设计二阶跟踪微分器；

其中，V_d＝[x_d y_d z_d φ_d θ_d ψ_d]^T，(·)_d为期望信号，为输入信号V_d的跟踪信号，为输入信号V_d的一阶微分信号，r>0为速度因子；

步骤4:设计线性扩张状态观测器，过程如下：

4.1基于扩张观测器的设计思想，定义扩张状态z₃＝ΔF(χ,t)+D(t)，则式(4)改写为以下等效形式：

其中，N＝(ΔF(χ,t)+D(t))；

4.2令w_i，i＝1,2,3分别为式(5)中状态变量z_i的观测值，定义跟踪误差其中为期望信号，观测误差为e_oi＝w_i-z_i，则设计线性扩张状态观测器表达式为：

其中，β_i＝[β_xi，β_yi，β_zi，β_φi，β_θi，β_ψi]^T，i＝1,2,3为观测器增益参数，需用极点配置法及模糊控制律确定；

步骤5：运用极点配置法确定观测器增益参数β₁，β₂，β₃的初值，过程如下：

5.1令δ₁＝z₁-w₁，δ₂＝z₂-w₂，δ₃＝h-w₃，则式(5)减去式(6)得

将式(7)写为以下状态空间方程形式

其中，的单位矩阵，的零矩阵；

5.2设计补偿矩阵：

则式(8)写为

使式(9)在扰动h的作用下渐近稳定的必要条件是补偿矩阵A的特征值全部落在复平面的左半平面上，即式(9)的极点充分的负，由此，根据极点配置法，选定期望的极点p_i(i＝1～18)，使参数β₁，β₂，β₃满足：

其中，I为与矩阵A同维数的单位矩阵，令左右两边关于s的多项式的各项系数相等，则分别求出参数β₁，β₂，β₃的值；

步骤6：引入模糊规则；

以观测误差e_o1，e_o2为性能指标，设计模糊控制规则在线整定β₁、β₂、β₃；；

步骤7：根据反馈线性化的思想设计控制器U，过程如下：

7.1，反馈线性化扰控制器如下：

其中，K_i＝[K_xi，K_yi，K_zi，K_φi，K_θi，K_ψi]^T，i＝1,2为控制器增益，运用极点配置法确定观测器增益参数K₁,K₂的取值；

7.2，闭环系统稳定性分析：

由式(4)和式(13)得到闭环系统的状态方程：

其中，Z_s＝[z₁ z₂]^T，

令e_c＝R-Z_s，其中可由下式表达：

控制器U可改写为：

由式(12)，式(13)，式(14)得：

由式(9)和式(15)得到：

由式(21)看出，由于h是有界的，闭环系统的稳定性由A_s-B_s*K_s和A这两个矩阵的特征值决定。只要通过极点配置使A_s-B_s*K_s和A这两个矩阵的特征值位于合适的位置，就能保证系统稳定且系统跟踪误差和观测误差收敛至零；

7.3，运用极点配置法确定控制器增益参数K₁,K₂的取值：

使式(16)渐近稳定的必要条件是A_s-B_s*K_s和A这两个矩阵的特征值全部落在复平面的左半平面上，即式(16)的极点充分的负，其中A矩阵已经进行过极点配置。由此，根据极点配置法，选定期望的极点p_i(i＝1～12)，使参数K₁,K₂满足

其中，I₀为与矩阵(A_s-B_s)同维数的单位矩阵，令左右两边关于s的多项式的各项系数相等，则分别求出参数K₁,K₂的值。

进一步，所述步骤6中，以观测误差e_o1，e_o2为性能指标，设计模糊控制规则在线整定β₁、β₂、β₃；其中，模糊变量分别为e_o1，e_o2；Δβ₁、Δβ₂、Δβ₃代表模糊规则输出量，并在其各自论域上分别定义5个语言子集为{“负大(NB)”，“负小(NS)”,“零(ZO)”，“正小(PS)”，“正大(PB)”}；选择输入量e_o1，e_o2的隶属度函数为高斯型(gaussmf)，输出量Δβ₁、Δβ₂、Δβ₃的隶属度函数为三角形(trimf)，取e_o1，e_o2的基本论域分别为[-1，+1]和[-1，+1]，取Δβ₁、Δβ₂、Δβ₃的基本论域分别为[-1，1]、[-0.5，0.5]和[-0.1，0.1]；模糊推理采用Mamdani型，去模糊化算法为加权平均法；表1为β₁、β₂、β₃模糊规则表；

表1

建立修正参数β₁、β₂、β₃的模糊整定规则，则得到以下参数修正表达式

其中，为极点配置得到的扩张状态观测器初始值。

本发明的技术构思为：极点配置法(Pole Assignment)是通过比例环节的反馈把线性定常系统的极点移到预定位置的一种方法，其实质是用比例反馈去改变原系统的自由运动模式，以满足设计的要求。因此，可以通过极点配置法来确定扩张状态观测器参数的初值。

由于四旋翼无人机通常工作在强干扰环境下，为了实现在不同扰动情况下观测器都具有最佳的估计效果，在极点配置的基础上引进模糊规则，利用规则的自适应推理以及在一定范围内能对参数进行最佳估计的能力，达到在线整定扩张状态观测器参数的目的。

线性系统具有结构简单，系统的输出特性只决定于系统本身的结构等特点，便于系统稳定性分析和控制器设计。反馈线性化是通过设计合适的控制器结构，使得闭环系统近似为线性系统，增强了系统的稳定性，并且控制器结构简单，具有良好的鲁棒性。针对模型不确定以及对外部扰动敏感的四旋翼无人机，涉及了模糊扩张状态观测器和反馈线性化的四旋翼无人机控制方法，尽可能地消除外部扰动对系统控制的影响。通过建立新的扩张状态，设计扩张状态观测器估计控制通道耦合量及外部干扰，采用极点配置法确定扩张状态观测器参数的初值，同时引进模糊规则，针对扰动情况下扩张状态观测器参数进行在线整定，最后设计反馈线性化控制器得出控制量，实现四旋翼无人机快速稳定的位置跟踪及姿态调整。

本发明的优点为：通过运用线性扩张状态观测器，能对四旋翼无人机系统状态、模型不确定及外部扰动进行有效观测，采用极点配置法确定扩张状态观测器参数的初值，通过引入模糊规则，在线优化扩张状态观测器参数，提高了状态估计值的可靠性，通过反馈线性化控制器，使得闭环系统近似为线性系统，增强了系统稳定性，并且控制器结构简单，实现了对四旋翼无人机精确的位置跟踪及姿态调整。

附图说明：

图1为位置跟踪响应曲线，其中，(a)为在x方向上的位置跟踪响应曲线，(b)为在y方向上的位置跟踪响应曲线，(c)为在z方向上的位置跟踪响应曲线；

图2为姿态调整响应曲线，其中，(a)为俯仰角φ的调整响应曲线，(b)为横滚角θ的调整响应曲线，(c)为偏航角ψ的调整响应曲线；

图3为位置控制力矩响应曲线，其中，(a)为在x方向上的位置控制力矩响应曲线，(b)为在y方向上的位置控制力矩响应曲线，(c)为在z方向上的位置控制力矩响应曲线；

图4为姿态控制力矩响应曲线，其中，(a)为俯仰角φ的控制力矩响应曲线，(b)为横滚角θ的控制力矩响应曲线，(c)为偏航角ψ的控制力矩响应曲线；

图5为位置观测误差的响应曲线，其中，(a)为x方向上的观测误差响应曲线，(b)为y方向上的观测误差响应曲线，(c)为z方向上的观测误差响应曲线；

图6为姿态观测误差的响应曲线，其中，(a)为俯仰角φ的观测误差响应曲线，(b)为横滚角θ的观测误差响应曲线，(c)为偏航角ψ的观测误差响应曲线；

图7为本发明的算法的基本流程。

具体实施方式：

下面结合附图对本发明做进一步说明。

参照图1-图7，一种基于模糊扩张状态观测器的四旋翼无人机反馈线性化控制方法，包括以下步骤：

步骤1：建立如式(1)所示的系统运动方程；

其中，x,y,z为在地面坐标系下无人机相对于原点的坐标φ,θ,ψ分别代表无人机的俯仰角，横滚角，偏航角。U₁表示作用在四旋翼无人机上的合外力。p为无人机的俯仰角角速度，为俯仰角角加速度，q为无人机的横滚角角速度，为横滚角角加速度，r为无人机的偏航角角速度，为偏航角角加速度，m为无人机的质量，I_x，I_y，I_z分别为x,y,z轴上的惯性张量，τ_x，τ_y，τ_z分别为x,y,z轴上的力矩；

步骤2：将式(1)改写为便于观测器实现的形式；

其中， Δf(·)项、d(·)项分别代表模型不确定以及外部干扰；

为了便于控制器实现，将式(2)进一步改写为

其中，

定义状态变量：z₁＝χ，式(1)改写为

其中，状态变量χ存在连续的一阶导数、二阶导数,模型不确定ΔF(χ,t),外部扰动D(t)满足|ΔF(χ,t)+D(t)|<h₀，h₀为某一常值；

步骤3：设计二阶跟踪微分器；

其中，V_d＝[x_d y_d z_d φ_d θ_d ψ_d]^T，(·)_d为期望信号，分别为输入信号V_d的第i-1阶导数，r>0为速度因子；步骤4:设计线性扩张状态观测器，过程如下：

4.1基于扩张观测器的设计思想，定义扩张状态z₃＝ΔF(χ,t)+D(t)，则式(4)改写为以下等效形式：

其中，N＝(ΔF(χ,t)+D(t))；

4.2令w_i，i＝1,2,3分别为式(5)中状态变量z_i的观测值，定义跟踪误差其中为期望信号，观测误差为e_oi＝w_i-z_i，则设计线性扩张状态观测器表达式为：

其中，β_i＝[β_xi，β_yi，β_zi，β_φi，β_θi，β_ψi]^T，i＝1,2,3为观测器增益参数，需用极点配置法及模糊控制律确定；

步骤5：运用极点配置法确定观测器增益参数β₁，β₂，β₃的初值，过程如下：

5.1令δ₁＝z₁-w₁，δ₂＝z₂-w₂，δ₃＝h-w₃，则式(5)减去式(6)得

将式(7)写为以下状态空间方程形式

其中，的单位矩阵，的零矩阵；

5.2设计补偿矩阵：

则式(8)写为

使式(9)在扰动h的作用下渐近稳定的必要条件是补偿矩阵A的特征值全部落在复平面的左半平面上，即式(9)的极点充分的负，由此，根据极点配置法，选定期望的极点p_i(i＝1～18)，使参数β₁，β₂，β₃满足：

其中，I为与矩阵A同维数的单位矩阵，令左右两边关于s的多项式的各项系数相等，则分别求出参数β₁，β₂，β₃的值；

步骤6：引入模糊规则；

以观测误差e_o1，e_o2为性能指标，设计模糊控制规则在线整定β₁、β₂、β₃。其中，模糊变量分别为e_o1，e_o2；Δβ₁、Δβ₂、Δβ₃代表模糊规则输出量，并在其各自论域上分别定义5个语言子集为{“负大(NB)”，“负小(NS)”,“零(ZO)”，“正小(PS)”，“正大(PB)”}。选择输入量e_o1，e_o2的隶属度函数为高斯型(gaussmf)，输出量Δβ₁、Δβ₂、Δβ₃的隶属度函数为三角形(trimf)，本文取e_o1，e_o2的基本论域分别为[-1，+1]和[-1，+1]，取Δβ₁、Δβ₂、Δβ₃的基本论域分别为[-1，1]、[-0.5，0.5]和[-0.1，0.1]。模糊推理采用Mamdani型，去模糊化算法为加权平均法；表1为β₁、β₂、β₃模糊规则表。

表1

建立修正参数β₁、β₂、β₃的模糊整定规则，则得到以下参数修正表达式

其中，为极点配置得到的扩张状态观测器初始值。

步骤7：根据反馈线性化的思想设计控制器U，过程如下：

7.1，反馈线性化扰控制器如下：

其中，K_i＝[K_xi，K_yi，K_zi，K_φi，K_θi，K_ψi]^T，i＝1,2为控制器增益，运用极点配置法确定观测器增益参数K₁,K₂的取值；

7.2，闭环系统稳定性分析：

由式(4)和式(13)得到闭环系统的状态方程：

其中，Z_s＝[z₁ z₂]^T，

令e_c＝R-Z_s，其中可由下式表达：

控制器U可改写为：

由式(12)，式(13)，式(14)得：

由式(9)和式(15)得到：

由式(21)看出，由于h是有界的，闭环系统的稳定性由A_s-B_s*K_s和A这两个矩阵的特征值决定；只要通过极点配置使A_s-B_s*K_s和A这两个矩阵的特征值位于合适的位置，就能保证系统稳定且系统跟踪误差和观测误差收敛至零；

7.3，运用极点配置法确定控制器增益参数K₁,K₂的取值：

使式(16)渐近稳定的必要条件是A_s-B_s*K_s和A这两个矩阵的特征值全部落在复平面的左半平面上，即式(16)的极点充分的负，其中A矩阵已经进行过极点配置，由此，根据极点配置法，选定期望的极点p_i(i＝1～12)，使参数K₁,K₂满足

其中，I₀为与矩阵(A_s-B_s)同维数的单位矩阵，令左右两边关于s的多项式的各项系数相等，则分别求出参数K₁,K₂的值。

为验证所提方法的有效性和优越性，进行仿真实验，设置仿真实验中的初始条件与部分参数，即：设置系统初始状态参数m＝0.625，I_x＝0.0023，I_y＝0.0024，I_z＝0.0026，μ＝1。控制器参数为K₁＝[5，5，5，0.08，0.08，0.08]^T，K₂＝[4，4，4，0.05，0.05，0.05]^T；此外，设定扩张状态观测器中的各增益参数初值，分别取 系统各状态初始值，跟踪微分器的初始值，扩张状态观测器状态初始值，控制器U初始值，扩张状态初始值均设为0。

图1和图2分别给出了无人机的位置和姿态跟踪效果。从图1和图2可以看出，无人机在3秒内跟踪上期望的位置信号，在4秒内完成了对姿态的调整，并且稳态后的位置误差和姿态误差均为0，表明该方法具有良好的跟踪精度。位置环和姿态环的控制器输出分别如图3和图4所示，从图3和图4可以看出，无人机的位置及姿态的控制量均在4秒内快速收敛较小的值，体现了系统控制的有效性。图5和图6位置和姿态的观测误差，从图5和图6可以看出，位置观测误差保持在0.008范围内，姿态观测误差保持在0.15的范围内，说明扩张状态观测器具有较好的观测精度。综上所述,反馈线性化控制器具有较好的跟踪精度和鲁棒性。

从仿真结果上来看，本发明的方法能有效估计和补偿系统存在的模型不确定以及外部扰动，并且通过设计控制器实现反馈线性化，保证了控制器的性能及系统稳定性，使四旋翼无人机能快速稳定地进行位置跟踪及姿态调整。本发明不只是限于上述实例，在本发明的基础上对其他类似的系统也可以进行有效的控制。

Claims (2)

1.一种基于模糊扩张状态观测器的四旋翼无人机反馈线性化控制方法，其特征在于：包括以下步骤：

步骤1：建立如式(1)所示的系统运动方程；

$\left\{\begin{array}{c}\stackrel{\&CenterDot;\&CenterDot;}{x}=\left(\sin \mathrm{\&psi;}\sin \mathrm{\&phi;}+\cos \mathrm{\&psi;}\sin \mathrm{\&theta;}\cos \mathrm{\&phi;}\right)\frac{U_1}{m}\\ \stackrel{\&CenterDot;\&CenterDot;}{y}=\left(-\cos \mathrm{\&psi;}\sin \mathrm{\&phi;}+\sin \mathrm{\&psi;}\sin \mathrm{\&theta;}\cos \mathrm{\&phi;}\right)\frac{U_1}{m}\\ \stackrel{\&CenterDot;\&CenterDot;}{z}=\left(\cos \mathrm{\&theta;}\cos \mathrm{\&phi;}\right)\frac{U_1}{m}-g\\ \stackrel{\&CenterDot;}{p}=\frac{I_y-I_z}{I_x}qr+\frac{{\mathrm{\&tau;}}_x}{I_x}\\ \stackrel{\&CenterDot;}{q}=\frac{I_z-I_x}{I_y}pr+\frac{{\mathrm{\&tau;}}_y}{I_y}\\ \stackrel{\&CenterDot;}{r}=\frac{I_x-I_y}{I_z}pq+\frac{{\mathrm{\&tau;}}_z}{I_z}\end{array}\right.---\left(1\right)$

其中，x,y,z为在地面坐标系下无人机相对于原点的坐标φ,θ,ψ分别代表无人机的俯仰角，横滚角，偏航角；U₁表示作用在四旋翼无人机上的合外力；p为无人机的俯仰角角速度，为俯仰角角加速度，q为无人机的横滚角角速度，为横滚角角加速度，r为无人机的偏航角角速度，为偏航角角加速度，m为无人机的质量，I_x，I_y，I_z分别为x,y,z轴上的惯性张量，τ_x，τ_y，τ_z分别为x,y,z轴上的力矩；

步骤2：将式(1)改写为便于观测器实现的形式；

$\left\{\begin{array}{c}\stackrel{\&CenterDot;\&CenterDot;}{x}=U_x+{\mathrm{\&Delta;f}}_x+d_x\\ \stackrel{\&CenterDot;\&CenterDot;}{y}=U_y+{\mathrm{\&Delta;f}}_y+d_y\\ \stackrel{\&CenterDot;\&CenterDot;}{z}=U_z+{\mathrm{\&Delta;f}}_z+d_z\\ \stackrel{\&CenterDot;\&CenterDot;}{\mathrm{\&phi;}}=a_1\stackrel{\&CenterDot;}{\mathrm{\&theta;}}\stackrel{\&CenterDot;}{\mathrm{\&psi;}}+\frac{{\mathrm{\&tau;}}_x}{I_x}+{\mathrm{\&Delta;f}}_{\mathrm{\&phi;}}+d_{\mathrm{\&phi;}}\\ \stackrel{\&CenterDot;\&CenterDot;}{\mathrm{\&theta;}}=a_2\stackrel{\&CenterDot;}{\mathrm{\&phi;}}\stackrel{\&CenterDot;}{\mathrm{\&psi;}}+\frac{{\mathrm{\&tau;}}_y}{I_y}+{\mathrm{\&Delta;f}}_{\mathrm{\&theta;}}+d_{\mathrm{\&theta;}}\\ \stackrel{\&CenterDot;\&CenterDot;}{\mathrm{\&psi;}}=a_3\stackrel{\&CenterDot;}{\mathrm{\&theta;}}\stackrel{\&CenterDot;}{\mathrm{\&phi;}}+\frac{{\mathrm{\&tau;}}_z}{I_z}+{\mathrm{\&Delta;f}}_{\mathrm{\&psi;}}+d_{\mathrm{\&psi;}}\end{array}\right.---\left(2\right)$

其中， Δf(·)项、d(·)项分别代表模型不确定以及外部干扰；

将式(2)进一步改写为

$\left\{\begin{array}{c}\stackrel{\&CenterDot;\&CenterDot;}{\mathrm{\&chi;}}=B*U+\mathrm{\&Delta;}F(\mathrm{\&chi;},t)+D\left(t\right)\\ Y=\mathrm{\&chi;}\end{array}\right.---\left(3\right)$

其中，

定义状态变量：z₁＝χ，式(1)改写为

$\left\{\begin{array}{c}{\stackrel{\&CenterDot;}{z}}_1=z_2\\ {\stackrel{\&CenterDot;}{z}}_2=B*U+\mathrm{\&Delta;}F(\mathrm{\&chi;},t)+D\left(t\right)\end{array}\right.---\left(4\right)$

其中，状态变量χ存在连续的一阶导数、二阶导数,模型不确定ΔF(χ,t),外部扰动D(t)满足|ΔF(χ,t)+D(t)|<h₀，h₀为某一常值；

步骤3：设计二阶跟踪微分器；

$\left\{\begin{array}{c}{\stackrel{\&CenterDot;}{z}}_1^{*}=z_2^{*}\\ {\stackrel{\&CenterDot;}{z}}_2^{*}=f\\ f=-r\left(\right(r\left(z_1^{*}-V_d\right)+z_2^{*}\left)\right)\end{array}\right.$

其中，V_d＝[x_d y_d z_d φ_d θ_d ψ_d]^T，(·)_d为期望信号，为输入信号V_d的跟踪信号，为输入信号V_d的一阶微分信号，r>0为速度因子；

步骤4:设计线性扩张状态观测器，过程如下：

4.1基于扩张观测器的设计思想，定义扩张状态z₃＝ΔF(χ,t)+D(t)，则式(4)改写为以下等效形式：

$\left\{\begin{array}{c}{\stackrel{\&CenterDot;}{z}}_1=z_2\\ {\stackrel{\&CenterDot;}{z}}_2=z_3+B*U\\ {\stackrel{\&CenterDot;}{z}}_3=h\end{array}\right.---\left(5\right)$

其中，N＝(ΔF(χ,t)+D(t))；

4.2令w_i，i＝1,2,3分别为式(5)中状态变量z_i的观测值，定义跟踪误差其中为期望信号，观测误差为e_oi＝w_i-z_i，则设计线性扩张状态观测器表达式为：

$\left\{\begin{array}{c}{\stackrel{\&CenterDot;}{w}}_1=w_2+{\mathrm{\&beta;}}_1*e_{o1}\\ {\stackrel{\&CenterDot;}{w}}_2=w_3+{\mathrm{\&beta;}}_2*e_{o1}+B*U\\ {\stackrel{\&CenterDot;}{w}}_3={\mathrm{\&beta;}}_3*e_{o1}\end{array}\right.---\left(6\right)$

其中，β_i＝[β_xi，β_yi，β_zi，β_φi，β_θi，β_ψi]^T，i＝1,2,3为观测器增益参数，需用极点配置法及模糊控制律确定；

步骤5：运用极点配置法确定观测器增益参数β₁，β₂，β₃的初值，过程如下：

5.1令δ₁＝z₁-w₁，δ₂＝z₂-w₂，δ₃＝h-w₃，则式(5)减去式(6)得

$\left\{\begin{array}{c}{\stackrel{\&CenterDot;}{\mathrm{\&delta;}}}_1={\mathrm{\&delta;}}_2-{\mathrm{\&beta;}}_1*e_{o1}\\ {\stackrel{\&CenterDot;}{\mathrm{\&delta;}}}_2={\mathrm{\&delta;}}_3-{\mathrm{\&beta;}}_2*e_{o1}\\ {\stackrel{\&CenterDot;}{\mathrm{\&delta;}}}_3=h-{\mathrm{\&beta;}}_3*e_{o1}\end{array}\right.---\left(7\right)$

将式(7)写为以下状态空间方程形式

$\left[\begin{array}{c}{\stackrel{\&CenterDot;}{\mathrm{\&delta;}}}_1\\ {\stackrel{\&CenterDot;}{\mathrm{\&delta;}}}_2\\ {\stackrel{\&CenterDot;}{\mathrm{\&delta;}}}_3\end{array}\right]=\left[\begin{array}{ccc}-{\mathrm{\&beta;}}_1*H& H& O\\ -{\mathrm{\&beta;}}_2*H& O& H\\ -{\mathrm{\&beta;}}_3*H& O& O\end{array}\right]\left[\begin{array}{c}{\mathrm{\&delta;}}_1\\ {\mathrm{\&delta;}}_2\\ {\mathrm{\&delta;}}_3\end{array}\right]+\left[\begin{array}{c}O\\ O\\ H\end{array}\right]h---\left(8\right)$

其中，的单位矩阵，的零矩阵；

5.2设计补偿矩阵：

$A=\left[\begin{array}{ccc}-{\mathrm{\&beta;}}_1*H& H& O\\ -{\mathrm{\&beta;}}_2*H& O& H\\ -{\mathrm{\&beta;}}_3*H& O& O\end{array}\right],E=\left[\begin{array}{c}O\\ O\\ H\end{array}\right],\mathrm{\&delta;}=\left[\begin{array}{c}{\mathrm{\&delta;}}_1\\ {\mathrm{\&delta;}}_2\\ {\mathrm{\&delta;}}_3\end{array}\right]$

则式(8)写为

$\stackrel{\&CenterDot;}{\mathrm{\&delta;}}=A*\mathrm{\&delta;}+E*h---\left(9\right)$

使式(9)在扰动h的作用下渐近稳定的必要条件是补偿矩阵A的特征值全部落在复平面的左半平面上，即式(9)的极点充分的负，由此，根据极点配置法，选定期望的极点p_i，i＝1～18，使参数β₁，β₂，β₃满足：

$|sI-A|={\mathrm{\&Pi;}}_{i=1}^{18}(sI-p_i)---\left(10\right)$

其中，I为与矩阵A同维数的单位矩阵，令左右两边关于s的多项式的各项系数相等，则分别求出参数β₁，β₂，β₃的值；

步骤6：引入模糊规则，以观测误差e_o1，e_o2为性能指标，设计模糊控制规则在线整定β₁、β₂、β₃；

步骤7：根据反馈线性化的思想设计控制器U，过程如下：

7.1，反馈线性化扰控制器如下：

$U=\frac{1}{B}(K_1*(z_1^{*}-w_1)+K_2*(z_2^{*}-w_2)-w_3+{\stackrel{\&CenterDot;}{z}}_2^{*})---\left(11\right)$

其中，K_i＝[K_xi，K_yi，K_zi，K_φi，K_θi，K_ψi]^T，i＝1,2为控制器增益，运用极点配置法确定观测器增益参数K₁,K₂的取值；

7.2，闭环系统稳定性分析：

由式(4)和式(13)得到闭环系统的状态方程：

${\stackrel{\&CenterDot;}{Z}}_s=A_s*Z_s+B_s*U+B_d*N---\left(12\right)$

其中，Z_s＝[z₁ z₂]^T，

令e_c＝R-Z_s，其中由下式表达：

$\stackrel{\&CenterDot;}{R}=A_s*R+B_d*{\stackrel{\&CenterDot;}{z}}_2^{*}---\left(13\right)$

控制器U改写为：

$U=K_s*R-K_s*W_s+\frac{1}{B}*z_2^{*}-\frac{1}{B}*w_3---\left(14\right)$

由式(12)，式(13)，式(14)得：

$\begin{array}{c}{\stackrel{\&CenterDot;}{e}}_c=\stackrel{\&CenterDot;}{R}-(A_s*Z_s+B_s*K_s*R-B_s*K_s*W_s+B_d*z_2^{*}-B_d*w_3+B_d*N)\\ =\left(A_s-B_s*K_s\right)*e_c-\left[\begin{array}{cc}{B}_s*K_s& B_d\end{array}\right]*\mathrm{\&delta;}\end{array}---\left(15\right)$

由式(9)和式(15)得到：

$\left[\begin{array}{c}{\stackrel{\&CenterDot;}{e}}_c\\ \stackrel{\&CenterDot;}{\mathrm{\&delta;}}\end{array}\right]=\left[\begin{array}{cc}{A}_s-B_s*K_s& -\left[\begin{array}{cc}{B}_s*K_s& B_d\end{array}\right]\\ 0& A\end{array}\right]+\left[\begin{array}{c}0\\ E\end{array}\right]*h---\left(16\right)$

由式(21)看出，由于h是有界的，闭环系统的稳定性由A_s-B_s*K_s和A这两个矩阵的特征值决定；只要通过极点配置使A_s-B_s*K_s和A这两个矩阵的特征值位于合适的位置，就能保证系统稳定且系统跟踪误差和观测误差收敛至零；

7.3，运用极点配置法确定控制器增益参数K₁,K₂的取值：

使式(16)渐近稳定的必要条件是A_s-B_s*K_s和A这两个矩阵的特征值全部落在复平面的左半平面上，即式(16)的极点充分的负，其中A矩阵已经进行过极点配置；由此，根据极点配置法，选定期望的极点p_i(i＝1～12)，使参数K₁,K₂满足

$|{\mathrm{sI}}_0-(A_s-B_s)|={\mathrm{\&Pi;}}_{i=1}^{12}({\mathrm{sI}}_0-p_i)---\left(17\right)$

其中，I₀为与矩阵(A_s-B_s)同维数的单位矩阵，令左右两边关于s的多项式的各项系数相等，则分别求出参数K₁,K₂的值。

2.如权利要求1所述的一种基于模糊扩张状态观测器的四旋翼无人机反馈线性化控制方法，其特征在于：所述步骤6中，以观测误差e_o1，e_o2为性能指标，设计模糊控制规则在线整定β₁、β₂、β₃；其中，模糊变量分别为e_o1，e_o2；Δβ₁、Δβ₂、Δβ₃代表模糊规则输出量，并在其各自论域上分别定义5个语言子集为{“负大(NB)”，“负小(NS)”,“零(ZO)”，“正小(PS)”，“正大(PB)”}；选择输入量e_o1，e_o2的隶属度函数为高斯型，输出量Δβ₁、Δβ₂、Δβ₃的隶属度函数为三角形，取e_o1，e_o2的基本论域分别为[-1，+1]和[-1，+1]，取Δβ₁、Δβ₂、Δβ₃的基本论域分别为[-1，1]、[-0.5，0.5]和[-0.1，0.1]；模糊推理采用Mamdani型，去模糊化算法为加权平均法；表1为β₁、β₂、β₃模糊规则表；

表1

建立修正参数β₁、β₂、β₃的模糊整定规则，则得到以下参数修正表达式

$\left\{\begin{array}{c}{\mathrm{\&beta;}}_1={\mathrm{\&Delta;\&beta;}}_1+{\mathrm{\&beta;}}_1^{*}\\ {\mathrm{\&beta;}}_2={\mathrm{\&Delta;\&beta;}}_2+{\mathrm{\&beta;}}_2^{*}\\ {\mathrm{\&beta;}}_3={\mathrm{\&Delta;\&beta;}}_3+{\mathrm{\&beta;}}_3^{*}\end{array}\right.$

其中，为极点配置得到的扩张状态观测器初始值。