基于扩张状态观测器的四旋翼无人机滑模控制*

赵红超,周洪庆,王书湖

(1.烟台南山学院,山东龙口 265713;2.海军航空大学,山东烟台 264001)

四旋翼无人机具有垂直起降、空中悬停、飞行灵活、操作简单等优势特性,引起了人们越来越多的关注和重视。近年来,四旋翼无人机已经在航拍、物流快递、线路巡检、消防抢险、农业植保、灾害救援、军事侦察等许多领域得到了广泛的应用。

四旋翼无人机是一种典型的欠驱动、非线性、静不稳定系统,同时因其惯性质量较小、抗干扰能力较差、飞行环境要求较高等特性,使四旋翼无人机对控制系统算法有着较高的要求。在工程中,无法对无人机所受的空气动力建立精确的数学模型,无人机的转动惯量、空气动力参数等测量值与实际值之间也存在偏差,另外还有外界干扰的影响,这些都增加了无人机的控制难度。因此,需要为无人机设计抗干扰能力强(鲁棒性强)的控制系统。

为了保证四旋翼无人机控制系统具有较强的鲁棒性,国内外研究者将一些先进控制方法应用于无人机控制系统设计。常用的控制方法包括PID控制改进形式、鲁棒控制、滑模控制、反步控制、自适应控制、自抗扰控制等。经典PID控制方法是工程中四旋翼无人机采用最多的一种控制方法,但是其鲁棒性不强。为了增强鲁棒性,一些研究者将其与先进控制方法相结合,设计出多种改进形式,比如模糊自适应PID控制[1]、基于遗传算法的非线性PID控制[2]、基于Kalman滤波的PID控制[3]、模糊串级PID控制[4]、基于神经网络的PID控制[5]等。文献[6]将四旋翼无人机动力学解耦为外环位置控制系统和内环角度控制系统,分别针对两个子系统设计了干扰观测器和鲁棒H∞控制器。文献[7]采用反步控制和滑模控制设计了分数阶控制器,利用分数阶滑模提高系统的收敛速度和精度。文献[8]对传统滑模控制进行了改进,设计了一种基于双幂次趋近律的积分滑模控制器,增强了系统鲁棒性以及轨迹跟踪能力。文献[9]分别采用自适应滑模控制方法、基于神经网络干扰观测器和基于非线性干扰观测器的线性滤波降阶方法设计了四旋翼无人机控制器,通过仿真验证了几种控制器保证了系统跟踪性能和鲁棒性。文献[10]设计了基于模型参考自适应的容错控制器,在存在外界扰动和执行器故障的情况下四旋翼飞行器也具有较好的姿态控制效果。文献[11-13]采用了自抗扰控制方法设计四旋翼无人机控制器,并利用自抗扰控制中的扩张状态观测器(ESO)在线实时估计系统的总扰动,使控制系统具有较强的鲁棒性。文献[14-15]在四旋翼无人机控制系统设计中也采用ESO来估计系统的内、外总扰动,提高了控制系统的跟踪精度。

四旋翼无人机对实时性与能耗有较高要求,除动力设备能耗程度高以外,控制算法的运行功耗也是主要耗能因素之一。选择简单有效的控制算法能够降低能耗、减轻机载计算机的运算负担,有利于在四旋翼无人机上进行应用。滑模控制方法具有鲁棒性强的优点,而且算法简单,因此本文采用滑模控制替代PID控制来设计四旋翼无人机的控制器。众所周知,滑模控制的主要缺陷是存在抖振现象，其产生的主要原因是不连续的符号函数项的增益需要足够大,大于总扰动项的上界,以保证鲁棒性。为了克服抖振现象,采用ESO对各种不确定项和外界干扰等构成的总扰动项进行估计和补偿,并将输出加入滑模控制器中,因此不需要较大的符号函数项,在保证鲁棒性的同时显著削弱抖振问题。此外,我们研究发现,ESO在对总扰动项进行补偿的同时,也可以作为运动速度和角速度的观测器,从而不需要设计额外的状态观测器或者滤波器来解算运动速度和角速度信息,也保证了控制算法具有简单实用,能耗低的优点。

1 四旋翼无人机建模

四旋翼无人机是一个4输入、6输出的欠驱动系统,并且各通道之间具有较强的耦合度。假设四旋翼无人机为结构对称、质量分布均匀的刚体,忽略无人机的机体及螺旋桨的形变和弹性振动等复杂动态。将无人机的空中运动分为质心运动和姿态运动两个部分,并考虑各种干扰项的影响,建立四旋翼无人机的数学模型如下:

(1)

式中(x、y、z)为在地面坐标系的无人机质心位置;φ、θ、ψ分别为滚转角、俯仰角和偏航角;U1为4个螺旋桨的总升力;m为无人机的质量;g为重力加速度;Ix、Iy、Iz为三轴转动惯量;U2、U3、U4为三轴控制力矩;dx、dy、dz是包含不确定项、空气阻力及外界干扰等因素的总扰动项;dφ、dθ、dψ是包含不确定项、空气阻尼力矩、螺旋桨陀螺力矩及外界干扰等因素的总扰动项。

2 基于扩张状态观测器的滑模控制器设计

由四旋翼无人机的数学模型可知,其控制方式是利用U2、U3和U4来改变无人机的3个姿态角,而U1和3个姿态角共同作用改变无人机的位置,即位置变化是借助姿态角变化来实现的。为了解决4个输入控制6个输出的欠驱动问题,将无人机控制系统分解为外环位置控制和内环姿态控制两部分分别控制。

2.1 外环位置控制器设计

为了实现位置控制器的解耦设计,引入3个虚拟控制量如下:

(2)

此时位置系统模型变换为

(3)

由于x子系统、y子系统和z子系统的模型是基本一致的,下面以x子系统为例设计扩张状态观测器和滑模控制器,进而可以容易地推广到y子系统和z子系统的设计。

针对x子系统设计第1个扩张状态观测器,记为“ESO1”,定义观测误差变量如下:

(4)

ESO1设计为

(5)

式中:β1>0,β2>0,β3>0,0<δ<1,fal(·)函数的一般表达式为

(6)

其中:sign(·)为符号函数。根据韩京清老师的研究[16],观测误差最终收敛于零的小邻域内,设|dx|≤dmax,则

(7)

设x的期望指令为xd,跟踪误差为ex=xd-x。选取滑模面为

(8)

基于ESO的滑模控制器设计表述为如下定理。

定理1:对于x子系统,设计扩张状态观测器ESO1,选取滑模面为式(8),设计滑模控制器如下:

(9)

式中:k1>0,ρ1≥|c1e12+e13|。那么,系统跟踪误差渐近收敛到零。

证明:选取Lyapunov函数为

(10)

对V求导,并将式(4)、式(9)代入,整理可得,

(11)

由于ESO1保证了e12、e13都会足够小,因此,只要选取ρ1适当大就能够保证ρ1≥|c1e12+e13|,由此可得,

(12)

同理,对于y子系统,设计ESO2为

(13)

观测误差变量为

(14)

设y的期望指令为yd,跟踪误差为ey=yd-y。选取滑模面为

(15)

设计滑模控制器如下:

(16)

式中k2>0,ρ2≥|c2e22+e23|。则跟踪误差ey渐近收敛到零。

对于z子系统,设计ESO3为

(17)

观测误差变量为

(18)

设z的期望指令为zd,跟踪误差为ez=zd-z。选取滑模面为

(19)

设计滑模控制器如下:

(20)

式中k3>0,ρ3≥|c3e32+e33|。则跟踪误差ez渐近收敛到零。

由式(2)进行反解,可以求得实际控制输入U1和实现ux、uy、uz所需的期望姿态角指令:

(21)

2.2 内环姿态控制器设计

(22)

对比式(22)和式(3)可知,姿态角系统模型和位置系统模型是基本一致的,因此,外环位置控制器的设计过程可以同理推广到内环姿态控制器的设计。

对于φ子系统,设计ESO4为

(23)

观测误差变量为

(24)

(25)

设计滑模控制器如下:

z43+k4s4+ρ4sign(s4)]

(26)

式中:k4>0,ρ4≥|c4e42+e43|。则跟踪误差eφ渐近收敛到零。

对于θ子系统,设计ESO5为

(27)

观测误差变量为

(28)

(29)

设计滑模控制器如下:

(30)

式中k5>0,ρ5≥|c5e52+e53|。则跟踪误差eθ渐近收敛到零。

对于ψ子系统,设计ESO6为

(31)

观测误差变量为

(32)

(33)

设计滑模控制器如下:

z63+k6s6+ρ6sign(s6)]

(34)

式中k6>0,ρ6≥|c6z62+z63|。则跟踪误差eψ渐近收敛到零。

总结一下,本部分运用解耦控制思想,针对6个输出量分别设计了6个基于ESO的滑模控制器,保证了系统输出跟踪误差渐近收敛到零。四旋翼无人机控制系统的结构如图1所示。

图1 四旋翼无人机控制系统结构框图

3 仿真分析

为了检验本文提出的控制方法的有效性,根据图1采用Matlab/Simulink软件平台构建四旋翼无人机控制系统的仿真模型。以文献[15]的四旋翼无人机模型为研究对象进行仿真分析,并将本文算法的控制算法与文献[15]的控制算法进行对比。为了保证对比的准确性、可靠性,设置无人机参数、期望轨迹以及总干扰项等都与文献[15]相同。期望轨迹为

(35)

偏航角的期望指令为ψd=0。位置环施加的总干扰项均为2 sint;姿态环施加的总干扰项为[sin 2t0 sin 2t]T。

经过仿真调试,选取控制器参数为:

β1=100、β2=500、β3=2000、δ=0.01、c1=c2=3.6、k1=k2=4.2、ρ1=ρ2=1.5、c3=35、k3=75、ρ3=10、β4=200、β5=800、β6=3000、δ4=0.001、c4=c5=c6=25、k4=k5=k6=36、ρ4=ρ5=ρ6=4.5。

无人机初始位置[xyz]T=[0 0 0]T,初始姿态角[φθψ]T=[0 0 0]T。由静止状态起飞沿螺旋上升轨迹运动,仿真步长为0.001 s,仿真时间为30 s,仿真结果分别如图2～6所示。

图2 螺旋上升轨迹跟踪效果

图3 轨迹跟踪误差曲线

图4 姿态角跟踪误差曲线

图5 ESO对运动速度的观测误差

图6 ESO对姿态角速度的观测误差

仿真结果分析:由图2和图3可得,基于ESO的滑模控制器能够控制四旋翼无人机快速准确地跟踪期望轨迹,在施加干扰的情况下,达到稳态时轨迹跟踪误差最大仅有0.001 5 m;而在文献[15]中,轨迹跟踪误差最大为0.06 m。对比可得,本文算法将轨迹跟踪精度提高了一个数量级,跟踪精度高,抗干扰能力强。

由图4可得,达到稳态时姿态角跟踪误差最大为0.003 rad，姿态角跟踪误差虽然存在抖振现象,但是振幅很小。由图5和图6可得,6个ESO在估计总干扰项的同时,也完成了对运动速度和姿态角速度的估计,在0.74 s以后ESO对运动速度的观测误差都收敛到0.01 m/s以内,在1.1 s以后对姿态角速度的观测误差都收敛到0.004 rad/s以内,估计精度较高。仿真结果表明,文中所设计的基于ESO的滑模控制器保证了四旋翼无人机控制系统具有较强的抗干扰能力,提高了轨迹跟踪精度。

4 结束语

本文针对四旋翼无人机的欠驱动特性,将控制系统分解为外环位置控制和内环姿态控制两部分分别控制。考虑了不确定项、内部耦合以及外界干扰等因素的影响,将它们集中在一起构成汇总干扰项,设计了扩张状态观测器对汇总干扰项进行估计。另外,采用扩张状态观测器也对运动速度和角速度进行估计。在此基础上设计了滑模控制器控制跟踪误差渐近收敛到零。仿真结果表明,所设计的基于扩张状态观测器的滑模控制器保证了四旋翼无人机控制系统具有较强的抗干扰能力,在存在各种干扰的情况下对四旋翼无人机的运动速度和角速度进行了准确估计,提高了四旋翼无人机的轨迹跟踪精度,表现出较好的控制性能。下一步工作是分析四旋翼无人机动力系统饱和问题,进而研究四旋翼无人机控制系统抗饱和算法。