文章快速检索  
  高级检索
四旋翼无人机动态面控制
方旭 , 刘金琨     
北京航空航天大学 自动化科学与电气工程学院, 北京 100083
摘要: 针对四旋翼无人机(UAV)飞行器系统欠驱动特点,引入动态面控制方法,对四旋翼UAV的位置和姿态进行控制。考虑到飞行器速度和角速度难以测量,设计高增益观测器得到UAV的速度和角速度的估计值。相对于反演法,动态面控制的设计更简洁,并且通过引入滤波器来求取控制信号中的系统状态的导数项。另外,常用的时标分离方法不能给出全局稳定性分析,本文引入动态面设计控制律保证系统所有信号半全局一致有界,同时给出系统全局稳定性证明。仿真结果表明,四旋翼UAV能快速精确完成目标跟踪。
关键词: 动态面控制     高增益观测器     四旋翼无人机(UAV)     分离定理     全局稳定性分析    
Dynamic surface control for quadrotor unmanned air vehicle
FANG Xu , LIU Jinkun     
School of Automation Science and Electrical Engineering, Beijing University of Aeronautics and Astronautics, Beijing 100083, China
Received: 2015-07-28; Accepted: 2015-10-23; Published online: 2015-11-29 10:58
Foundation item: Specialized Research Fund for the Doctoral Program of Higher Education of China (20121102110008)
Corresponding author. LIU Jinkun Tel.:010-82315354 E-mail:ljk@buaa.edu.cn
Abstract: A dynamic surface control method is proposed to control position and attitude of quadrotor unmanned air vehicle (UAV) against its characteristics of underactuation. Considering that velocity and angular velocity are hard to measure, we design a high-gain observer for UAV to estimate velocity and angular velocity. Compared with backstepping approach, the design of dynamic surface control is more concise. Dynamic surface control eliminates the problem of "explosion of complexity" by introducing filter. Traditional time scale separation principle cannot prove the stability of whole system. By introducing the dynamic surface control method, it is shown that the control strategy can guarantee semi-global stability of the closed-loop system and arbitrarily small tracking error by adjusting the controller parameters. The stability of whole system is also given. Simulation results indicate that the proposed control system can achieve accurate tracking control for quadrotor UAV.
Key words: dynamic surface control     high-gain observer     quadrotor unmanned air vehicle (UAV)     separation theory     global stability analysis    

最新四旋翼无人机(UAV)吸引了来自不同领域相关机构的兴趣,旋翼类飞机适合军事侦察、货物运输和其他一些对敏捷和精确性要求高的任务[1-2]。无人机具有6个自由度和4个输入,是典型的非线性欠驱动系统[3]。Mistler等[4]先将无人机线性化,再使用动态反馈法实现了对无人机的控制,Xu和Özgüner[5]通过变换分解,将整个飞行器系统分解为完全驱动系统和欠驱动系统,通过滑模控制实现精确控制。Dierks和Jagannathan[6]设计了估计速度的神经网络观测器,观测值用于控制输入的设计,Coza和Macnab[7]使用模糊系统实现了对无人机的控制。

四旋翼无人机的姿态子系统不包括位置子系统的信息,因此大部分文献采用的是时标分离方法,所谓时标分离方法是指无人机的姿态子系统和位置子系统分开设计控制器,时标分离方法的应用是在假设姿态子系统的收敛速度比位置子系统快的前提下提出的,但是姿态子系统的快速收敛是基于高增益的参数,在控制过程中,高增益参数可能会使控制输入过大,超过控制器的输出范围,此外,在整个系统的稳定性分析上缺乏明确的证明。

高增益观测器在非线性系统中应用广泛,其具有设计简单的特点,通过调节增益保证观测器全局指数渐进收敛[8-9]

反演法是将复杂的非线性系统分解成不超过系统阶数的子系统[10],为每个子系统设计李雅普诺夫函数和中间虚拟控制量,通过设计单个李雅普诺夫函数逐步完成整个系统的李雅普诺夫函数设计。Bouabdallah和Siegwart[11]将反演和滑模结合,用于控制室内小型直升机,Madani和 Benallegue[12]使用反演法和状态估计器来控制无人飞行器。反步法在实现不确定性非线性系统鲁棒控制和自适应控制方面效果很好,由于对虚拟控制求导的过程中可能会出现“微分爆炸”的现象,反步法在高阶系统的应用将会面临“微分爆炸”的不利影响。采用动态面可以消除微分项的膨胀[13],一般是引入一阶滤波器来获得虚拟控制的导数项[14],将滤波器的输出作为虚拟信号使控制律设计简化,消除控制律微分项的膨胀。此外,动态面控制的引入能给出四旋翼无人机整个系统稳定性分析。

1 无人机系统动态模型

图 1为四旋冀无人机结构图,其中Oxyz为惯性坐标系,飞行器由4个螺旋桨控制位置和欧拉角,l为飞行器半臂长,Fi(i=1,2,3,4)为螺旋桨推力形成的扭转力矩,m为无人机质量,g为重力加速度。

图 1 四旋翼无人机结构图 Fig. 1 Structure of quadrotor UAV
(1)

式中:x、yz为位置信息;θ、ф和φ分别为俯仰角、滚转角和偏航角;ci(i=1,2,…,6)为系统参数;ui(i=1,2,3,4)为系统输入。

UAV具有6个自由度和4个输入,是典型的非线性欠驱动系统。由于欠驱动特性的存在,因此不可能完成对6个自由度变量的全部控制。一般选择控制位置子系统的3个量(x,y,z)和在姿态子系统中选择1个变量进行控制,一般选择偏航角φ,最终实现对4个变量的控制,剩下的2个变量保持镇定即可。

时标分离方法的应用是在假设姿态子系统的收敛速度比位置子系统快的前提下提出的,但是姿态子系统的快速收敛是基于高增益的参数,在控制过程中,高增益参数可能会使控制输入过大,超过控制器的输出范围。另外,从理论上来说,在混合控制器结构中,2个子系统渐近稳定并不代表系统整体渐近稳定,而动态面的引入正好能解决系统整体全局稳定性的证明问题。

2 高增益观测器

飞行器UAV的位置和欧拉角可以通过传感器来测量,但是UAV 的速度和角速度难以测量,可以通过设计观测器来获取速度和角速度的估计值。令=。观测器设计如下:

(2)

式中:L为增益;ρ为收敛参数。

设系统所有的状态变量为

定义观测器误差:

由式(2)可得

(3)

式中:ρ为很小的正实数。

由式(3)可知,存在正数γ00,满足

(4)

式中:t0为初始时间。

3 动态面控制设计

动态面与反演法都是采用“递进式”设计方法,由于对虚拟控制求导的过程中可能会出现“微分爆炸”的现象,反演法在高阶系统的应用将会面临“微分爆炸”的不利影响。动态面通过引入一阶滤波器来获得虚拟控制的导数项,避免虚拟控制求导,使整个系统的控制律设计简洁化。动态面控制设计如下。

1) 定义第1个位置误差为

(5)

式中:x1dy1dz1d为位置跟踪信号,则。设计第1个Lyapunov函数为

(6)

可得

设计虚拟控制为

(7)

式中:k1k2k3>0,为了避免求时出现微分爆炸,将分别输入到如下低通滤波器中。

2) 定义第2个误差

(8)

可得

则设计第2个Lyapunov函数为

(9)

因为UAV为欠驱动系统,控制目标选取为跟踪位置和偏航角,保持俯仰角和滚转角有界。位置子系统只有一个控制输入u1,选取中间指令来间接控制位置变量,偏航角φ1跟踪目标角度φ1,设计虚拟控制为

其中:k4k5k6>0,设

求解方程可得

(10)

由式(10)可知,中间指令表达式由位置子系统变量和偏航角构成,整个系统的控制目标为控制位置子系统和偏航角跟踪目标信号,因此当位置子系统和偏航角跟踪上目标信号时,中间指令信号是有界的,进而能保证俯仰角和滚转角有界。

输入到如下低通滤波器中,

3)定义第3个误差

(11)

可得

设计第3个Lyapunov函数为

(12)

设计虚拟控制为

(13)

式中:k7k8k9>0,将输入到如下低通滤波器中:

4)定义第4个误差

(14)

可得

设计第4个Lyapunov函数为

设计控制律为

(15)

式中:k10k11k12>0。

稳定性分析:由于四旋翼无人机具有6个自由度,需要设计3组一阶滤波器,因此全局稳定性分析难度增加。定义边界层误差为

(16)

由低通滤波器表达式,可得

(17)

由于

由边界层误差,可得

(18)
(19)
(20)

由式(18)~式(20)可知,变量为误差和边界层误差的连续函数,设计整个系统的Lyapunov函数为

由式(18)~式(20)可知,存在非负连续函数B2x,B2y,B2z,B1ф,B1θ,B1φ,B2ф,B2θ,B2φ满足式(21)~式(23):

(21)
(22)
(23)

假设1 四旋翼的状态变量是可测的并可用于控制律设计。

假设2 跟踪目标x1d是有界的,存在正数χ1使得成立;跟踪目标y1d是有界的,存在正数χ2使得成立;跟踪目标z1d是有界的,存在正数χ3使得成立;跟踪目标是有界的,存在正数χ4使得成立。

定理1 对于四旋翼无人机系统,采用控制律对四旋翼无人机进行控制。在假设1和假设2的基础上,系统初始值V(0)≤pp为任意正常数。那么可以通过调节参数ki(i=1,2,…,12)、B2x,B2y,B2z,B1ф,B1θ,B1φ,B2ф,B2θ,B2φ使整个闭环系统半全局一致有界,并且跟踪误差收敛到任意小残集内。

证明V≤p成立的基础上,考虑以下紧集

可知Ω1×Ω2也是紧集。在V≤p成立时,B2x,B2y,B2z,B1ф,B1θ,B1φ,B2ф,B2θ,B2φΩ1×Ω2上有最大值,记为:M2x,M2y,M2z,M1фM1θ,M1φ,M2ф,M2θ,M2φ

V求导,可得

(24)

选取系统的控制参数如下:k1≥0.5+rk2

选取r≥(4.5η)/(2p)。当V=p时,由于B*M*(*=2x,2y,2z,1ф,1θ,1φ,2ф,2θ,2φ),可得。因此可知V≤p为不变集,另外当V(0)≤p,即对任意t>0都有V(t)≤p。由定理1可知V(0)≤p,可得

(25)

求解式(25)可得

(26)

因此闭环系统的所有信号是有界的,而且

(27)

由式(27)可知,可通过调节参数ki(i=1,2,…,12)、B2x,B2y,B2z,B1ф,B1θ,B1φ,B2ф,B2θ,B2φε使得r任意大,即跟踪误差任意小。

需要说明的是,由于本文高增益观测器和系统非线性函数满足分离定理条件[15-16],因此可把观测器的观测值直接作为状态反馈,可以保证控制系统的稳定性,即控制律设计中不能直接测量得到的速度和角速度变量用观测器估计值替换,而无需再次证明闭环系统的稳定性,即,仍然可以得到式(25)~式(27),即基于高增益观测器控制的闭环系统的所有信号是半全局一致有界的。

4 仿真研究

取动态面控制的参考航迹,设定初始位置为(0.5,0.5,0.5),初始姿态角为(0,0,0.5)。为了完成跟踪目标,参数选取τ2x=τ2y=τ2z=τ1ф=τ1θ=τ1φ=τ2ф=τ2θ=τ2φ=0.02,ki=5(i=1,2,…,12),取观测器的初值为0,观测器参数选取L11=L21=L31=L41=L51=L61=1,L12=L22=L32=L42=L52=L62=1,ρ=0.1。

图 2反映无人机跟踪效果图,图 3为参数ci(i=1,2,…,6)在10 s时刻迅速减小5倍,观测器和路径跟踪误差仍保持着较高的精度。

图 2 无人机路径跟踪控制 Fig. 2 Path tracking control of quadrotor UAV
图 3 参数变化下观测器和路径跟踪控制误差 Fig. 3 Tracking errors of observer and path with changed parameters

图 4x方向位置、速度观测值和跟踪效果,图 5y方向位置、速度观测值和跟踪效果,图 6z方向位置、速度观测值和跟踪效果,图 7为偏航角、角速度观测值和跟踪效果,图 8为俯仰角和滚转角变化。

图 4 水平方向位置、速度观测值和路径跟踪控制 Fig. 4 Path tracking control and observed values of position and velocity of horizon direction
图 5 纵向位置、速度观测值和路径跟踪控制 Fig. 5 Path tracking control and observed values of position and velocity of longitude direction
图 6 垂直方向位置、速度观测值和路径跟踪控制 Fig. 6 Path tracking control and observed values of position and velocity of vertical direction
图 7 偏航角、偏航角速度观测值和路径跟踪控制 Fig. 7 Path tracking control and observed values of gaw angle and angular velocity of yaw

图 3~图 8可以看出,在0.5 s后观测值逼近真实值,因此可在0.5 s后加入动态面控制,动态面控制可以使飞行器的位置和偏航角快速跟踪上期望轨迹,并保证滚转角和俯仰角是有界的。

图 8 俯仰角和滚转角变化 Fig. 8 Change of pitch and roll angles
5 结 论

本文针对四旋翼无人机飞行器系统,利用动态面技术设计控制器,保证了系统的全局稳定性:

1) 利用高增益观测器得到位置速度和姿态加速度估计值,解决了速度信号难以获得的问题。由于高增益观测器对未建模部分及系统参数不确定性具有鲁棒性,因此对模型参数精确性要求降低。

2) 利用动态面设计控制器,通过引入滤波器来求取控制信号中的系统状态的导数项,避免了出现系统状态导数项数值过大的现象。并且利用分离定理来解决观测器与控制器的联合使用问题。

3) 能够解决系统稳定性整体证明问题,不是基于常用的时标分离假设进行稳定性分析,而是从全局的角度给出了系统全局稳定性分析。

参考文献
[1] RAFFO G V, ORTEGA M G, RUBIO F R. An integral predictive/nonlinear H control structure for a quadrotor helicopter[J]. Automatica, 2010, 46 (1) : 29 –39. DOI:10.1016/j.automatica.2009.10.018
[2] PAN Y, LIU Y, WANG P, et al. Research of UAV control system based on DSP[J]. Electronic Measurement Technology, 2014, 15 (2) : 101 –121.
[3] LEE D B,NATARAJ C,BURG T C,et al.Adaptive tracking control of an underactuated aerial vehicle[C]//Proceedings of the 2011 American Control Conference (ACC 2011) American Control Conference.Piscataway,NJ:IEEE Press,2011:2326-2331.
[4] MISTLER V,BENALLEGUE A,M'SIRDI N K.Exact linearization and noninteracting control of a 4 rotors helicopter via dynamic feedback[C]]//10th IEEE International Workshop on Robot and Human Interactive Communication (ROMAN 2001).Piscataway,NJ:IEEE Press,2001:586-593.
[5] XU R, ÖZGÜNER Ü. Sliding mode control of a class of underactuated systems[J]. Automatica, 2008, 44 (1) : 233 –241. DOI:10.1016/j.automatica.2007.05.014
[6] DIERKS T, JAGANNATHAN S. Output feedback control of a quadrotor UAV using neural networks[J]. IEEE Transactions on Neural Networks, 2010, 21 (1) : 50 –66. DOI:10.1109/TNN.2009.2034145
[7] COZA C,MACNAB C J B.A new robust adaptive-fuzzy control method applied to quadrotor helicopter stabilization[C]//2006 Annual meeting of the North American on Fuzzy Information Processing Society.Piscataway,NJ:IEEE Press,2006:475-479.
[8] RAKHTALA S M. Control of oxygen excess ratio in a PEM fuel cell system using high-order sliding-mode controller and observer[J]. Turkish Journal of Electrical Engineering & Computer Sciences, 2015, 23 (1) : 255 –278.
[9] ZHOU Y, SOH Y C, SHEN J X. High-gain observer with higher order sliding mode for state and unknown disturbance estimations[J]. International Journal of Robust & Nonlinear Control, 2014, 24 (15) : 2136 –2151.
[10] CHEN M A, ZHAO G, FENG S. Design of integrated guidance and control based on wavelet neural network backsteppting method[J]. Journal of Projectiles Rockets Missiles & Guidance, 2015, 21 (1) : 36 –45.
[11] BOUABDALLAH S,SIEGWART R.Backstepping and sliding-mode techniques applied to an indoor micro quadrotor[C]//Proceedings of the 2005 IEEE International Conference on Robotics and Automation.Piscataway,NJ:IEEE Press,2005:2247-2252
[12] MADANI T,BENALLEGUE A.Backstepping control with exact 2-sliding mode estimation for a quadrotor unmanned aerial vehicle[C]//Proceedings of the 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems(IROS 2007).Piscataway,NJ:IEEE Press,2007:141-146.
[13] HUANG J T. Global adaptive neural dynamic surface control of strict-feedback systems[J]. Neurocomputing, 2015, 17 (1) : 403 –413.
[14] YU Z, LI S, LI F. Observer-based adaptive neural dynamic surface control for a class of non-strict-feedback stochastic nonlinear systems[J]. International Journal of Systems Science, 2015, 12 (2) : 122 –129.
[15] ATASSI A N, KHALIl H K. A separation principle for the stabilization of a class of nonlinear systems[J]. IEEE Transactions on Automatic Control, 1999, 44 (9) : 1672 –1687. DOI:10.1109/9.788534
[16] ZHOU Y, SOH Y C, SHEN J X. High-gain observer with higher order sliding mode for state and unknown disturbance estimations[J]. International Journal of Robust & Nonlinear Control, 2014, 24 (15) : 2136 –2151.
http://dx.doi.org/10.13700/j.bh.1001-5965.2015.0498
北京航空航天大学主办。
0

文章信息

方旭, 刘金琨
FANG Xu, LIU Jinkun
四旋翼无人机动态面控制
Dynamic surface control for quadrotor unmanned air vehicle
北京航空航天大学学报, 2016, 42(8): 1777-1784
Journal of Beijing University of Aeronautics and Astronsutics, 2016, 42(8): 1777-1784
http://dx.doi.org/10.13700/j.bh.1001-5965.2015.0498

文章历史

收稿日期: 2015-07-28
录用日期: 2015-10-23
网络出版时间: 2015-11-29 10:58

相关文章

工作空间