四旋翼无人机具有在局限的环境中完成悬停、垂直起降和高机动性飞行等优异性能,以使其广泛应用到军事和民用领域,同时近些年来对其研究工作已成为国际热点.但是四旋翼无人机是典型的欠驱动系统,具有非线性、强耦合、对干扰敏感等特性,这些都增加了飞控系统设计的难度.虽然基本飞行性能已经实现,但是一些高难度应用需要娴熟和高超的飞行操作技能来完成.尤其是在考虑到模型不确定性和干扰情况下保证系统的鲁棒性,仍是一项富有挑战性的研究工作.
在简化四旋翼无人机系统模型及不偏离平衡点条件下,PID[1],H∞[2]等线性控制方法可满足四旋翼无人机的基本飞行操作控制.但是在偏离平衡点或存在扰动时,控制性能将无法得到保障.
针对上述情况,滑模控制[3]、反步控制[4]、神经网络控制[5]、输出反馈[6]、自适应控制[7]等非线性方法已被应用来解决控制问题.在应用这些非线性方法时,四旋翼无人机的模型不确定性和干扰对飞行器的影响也被关注和研究,例如文献[8]设计了基于神经网络的两种观测器,其中一个用来观察系统的状态,另一个用来估计干扰量.Kostas等[9]设计了转换模型预测姿态控制器,并验证了在强风扰动情况下控制器的性能.
上述文献提及的控制方法,虽然提高了四旋翼无人机系统的鲁棒性和飞行性能,但是这些方法对系统模型精度要求很高,或者要求系统的状态量能够全反馈,这使得在实际应用中受到限制.
自抗扰控制算法(ADRC)是韩京清教授提出的一种控制方案[10].该方案具有不依赖系统模型、对干扰实时补偿、控制精度高等特点,并已在不同领域得到应用[11-12].由于ADRC的控制算法部分类似于PD控制结构,影响了整个方案的可控性和鲁棒性.为此,本文提出了基于反步滑模自抗扰控制器的四旋翼无人机姿态控制系统.将反步控制和滑模控制技术引入自抗扰控制器中,提高了系统的可控性和鲁棒性;对系统的稳定性分析知,通过合理调整控制参数可使闭环系统渐近稳定.仿真分析结果表明,同经典自抗扰控制器相比,本文提出的控制器具有超调量小、稳定精度高、抗扰能力强及稳定性好等特点.
1 动力学模型设计四旋翼无人机是一个四输入六输出的典型欠驱动模型.采用牛顿-欧拉法对四旋翼无人机进行建模.四旋翼无人机坐标系如图 1所示.设定机体坐标系为B(oxyz),惯性坐标系为E(OXYZ).
视四旋翼无人机为刚体运动,且飞行器的重心位于机体坐标原点,为避免欧拉角表示姿态时出现奇异点,限定姿态角变化范围为(-π/2, π/2),四旋翼无人机动力学模型为[4]
(1) |
式中:M为四旋翼无人机质量;x,y,z为惯性坐标系下的位置;φ,θ,ψ为惯性坐标下滚转角、俯仰角、偏航角;L为旋翼中心到机体坐标原点的距离;Ii为转动惯量,i=x, y, z;U1~U4为控制输入:
$ $ | (2) |
其中:Ωi(i=1, 2, 3, 4)分别为四个电机转速;k1,k2分别为旋翼的升力和阻力系数.
2 控制器设计四旋翼无人机的姿态控制是整个飞行控制的核心部分,其控制效果直接影响飞行质量.考虑带有扰动的四旋翼姿态系统方程形式如下:
(3) |
式中Δi(i=φ, θ, ψ)表示未建模部分和外部扰动.
2.1 扩张状态观测器设计扩张状态观测器不仅能够估计系统的状态量,还可对系统内部和外部干扰部分进行实时估计[10].
为了方便观察器设计,将式(3)改写为
(4) |
式中:ξ1=[φ, θ, ψ]T;ξ2=
f(t)为各种扰动总和(包含未建模、建模动态和外扰),f(t)的导数存在且有界,并设定|(ḟt)|≤l,其中l > 0;U=[U2, U3, U4]T.
对式(4)建立扩张状态观测器:
(5) |
式中:
通过适当选择增益Di,使多项式s3+D1s2+D2s+D3满足Hurwitz条件.采用扩张观测器,当t→∞时,
设定姿态追踪期望值ξd,且一阶导数和二阶导数存在.结合扩张状态观测器,控制器设计步骤如下.
步骤1 设定跟踪误差为
$ $ | (6) |
则式(6)的导数为
(7) |
定义跟踪误差z1的Lyapunov函数为
(8) |
定义
(9) |
V1的导数为
(10) |
定义滑模切换函数为
(11) |
式中,K=diag (kφ, kθ, kψ)为正的控制增益.
将式(9)代入式(11):
(12) |
由于K+C1为正实矩阵,如果s=0,则
步骤2 定义Lyapunov函数
(13) |
对V2求导:
(14) |
因此,系统的控制器可设计为
(15) |
式中, H=diag (hφ, hθ, hψ), N=diag (nφ, nθ, nψ)为正的控制增益.
将式(12),式(15)代入式(14),可得
(16) |
式中:
通过合理选取矩阵C1,H,N和K的数值,保证G为正定矩阵.从而有
(17) |
因此,V2是一个正定的Lyapunov函数,由V2表达式可知z1,z2,s是有界的.进而根据式(6),式(9)和式(11)可知,ż1,ż2,ṡ也是有界的,从而可以推断2有界.根据Barbalat引理可知,当t→∞,z1→0,s→0,控制系统是渐进稳定的.
四旋翼无人机姿态系统的反步滑模自抗扰控制方案拓扑结构如图 2所示.
定义ξ3=f(t),且
(18) |
(19) |
(20) |
由式(3),式(4),式(18)~式(20)得扩张观测器的估计误差状态方程为
(21) |
式中:
对于矩阵A,任意一个对称正定常数矩阵Q,必存在且为对称正定的矩阵P满足
(22) |
定义Lyapunov函数为
(23) |
则
(24) |
式中,λmin(Q)是Q的最小特征值.
当
(25) |
因此可知,VE是正定的,且VE(
针对闭环系统式(4),闭环系统的稳定性分析由对估计误差(
定义Lyapunov函数为
(26) |
则
(27) |
将式(17)和式(24)代入式(27),可得
(28) |
在保证
(29) |
因此该闭环系统是渐进稳定的.
4 仿真对比分析根据姿态系统模型和反步滑模自抗扰控制器的拓扑图,利用Matlab进行仿真分析.四旋翼无人机系统参数设置见表 1.
控制方案中各扩张状态观测器的参数整定为
d1φ=12,d2φ=62.5,d3φ=100;
d1θ=15,d2θ=70,d3θ=110;
d1ψ=20,d2ψ=50,d3ψ=80.
为了避免产生峰值现象,造成观测器收敛效果差,ω0的数值设计详见文献[13].
各子系统的控制器参数选择为
c1φ=70,kφ=15,hφ=1.25,βφ=1.5;
c1θ=50,kθ=30,hθ=0.1,βθ=3;
c1ψ=120,kψ=60,hψ=1.2,βψ=0.5.
设定滚转角、俯仰角、偏航角的期望轨迹均为5sin (t).设置系统的三个姿态角初始值[φ, θ, ψ]=[3°, 3°, 3°],且其一阶导数均为零.
为了验证系统的鲁棒性,在时间t > 5 s时,在系统的滚转通道和俯仰通道分别施加50sin (t)的干扰力矩;为了验证各闭环系统的独立性,施加在偏航通道的干扰为零.
图 3~图 5为滚转、俯仰、偏航各子系统的状态值和扰动值,以及扩张状态观察器对其估计值.由图可知,扩张状态观测器很好地对各子系统的系统状态量进行了观察估计.在施加干扰后,能够快速估计出状态量和干扰的变化;同时不影响其他子系统观察器的估计效果.
图 6为扩张观察器的估计误差.从图中可知,角度和角速度的估计误差快速收敛减小到零值附近;虽然系统扰动量变化剧烈,但估计误差量仍能快速收敛减小.
图 7为系统的控制输入量的变化情况.图 8为经典自抗扰控制算法与本文设计的控制算法的控制效果对比情况.在扩张状态观察器参数不变的情况下,本文设计的反步滑模自抗扰控制器比传统的ADRC进一步减小了ESO估计误差的影响,对姿态角的期望轨迹追踪效果更好,提高了系统的自适应性能,同时超调量更小.在施加干扰后,产生的波动范围很小,能够以较小误差跟踪期望值,而且干扰不影响其他通道的追踪效果,证明在施加不同干扰情况下,反步滑模自抗扰控制器表现出良好的可控性、鲁棒性,以及抗干扰能力.该算法适应具有非线性强耦合的四旋翼无人机姿态系统的控制要求.
本文引入反步滑模自抗扰控制技术,设计了针对四旋翼无人机姿态系统的反步滑模自抗扰控制器.稳定性分析证明了系统是渐近稳定的.仿真分析结果表明,本文控制器的可控性及鲁棒性更好,同时抗扰能力更强,能有效保障四旋翼无人机姿态系统飞行性能.
[1] | Pounds P, Mahony R, Corke P. Modeling and control of a large quadrotor robot[J]. Control Engineering Practice , 2010, 18 (7) : 691–699. DOI:10.1016/j.conengprac.2010.02.008 |
[2] | Sadeghzadeh I, Chamseddine A, Theilliol D, et al.Linear parameter varying control synthesis:state feedback versus H∞ technique with application to quadrotor UAV[C]//2014 International Conference on Unmanned UAV Systems.Orlando, 2014:1099-1104. |
[3] | Zheng E H, Xiong J J, Luo J L. Second order sliding mode control for a quadrotor UAV[J]. ISA Transactions , 2014, 53 (4) : 1350–1356. DOI:10.1016/j.isatra.2014.03.010 |
[4] | Ha C, Zuo Z Y, Choi F B, et al. Passivity-based adaptive backstepping control of quadrotor-type UAVs[J]. Robotics and Autonomous Systems , 2014, 62 (9) : 1305–1315. DOI:10.1016/j.robot.2014.03.019 |
[5] | Efe M O. Neural network assisted computationally simple PIλDμ control of a quadrotor UAV[J]. IEEE Transactions on Industrial Informatics , 2011, 7 (2) : 354–361. DOI:10.1109/TII.2011.2123906 |
[6] | Xian B, Diao C, Zhao B, et al. Nonlinear robust output feedback tracking control of a quadrotor UAV using quaternion representation[J]. Nonlinear Dynamics , 2015, 79 (4) : 2735–2752. DOI:10.1007/s11071-014-1843-x |
[7] | Islam S, Liu P X, Sanddik A. Nonlinear adaptive control for quadrotor flying vehicle[J]. Nonlinear Dynamics , 2014, 78 (1) : 117–133. DOI:10.1007/s11071-014-1425-y |
[8] | Boudjedir H, Bouhali O, Rizoug N. Adaptive neural network control based on neural observer for quadrotor unmanned aerial vehicle[J]. Advanced Robotics , 2014, 28 (17) : 1151–1164. DOI:10.1080/01691864.2014.913498 |
[9] | Kostas A, George N, Anthony T. Switching model predictive attitude control for a quadrotor helicopter subject to atmospheric disturbances[J]. Control Engineering Practice , 2011, 19 (10) : 1195–1207. DOI:10.1016/j.conengprac.2011.06.010 |
[10] |
韩京清.
自抗扰控制技术[M]. 北京: 国防工业出版社, 2008 : 243 -280.
( Han Jing-qing. Active disturbance rejection control tec-hnique[M]. Beijing: National Defense Industry Press, 2008 : 243 -280. ) |
[11] | Manojlovic S M, Barbaric Z P, Mitrovic S T. A novel active disturbance rejection based tracking design for laser system with quadrant photodetector[J]. International Journal of Control , 2015, 88 (6) : 1246–1256. DOI:10.1080/00207179.2014.1002426 |
[12] | Sira-Ramirez H, Linares-Flores J, Garacia-Rodriguez C, et al. On the control of the permanent magnet synchronous motor:an active disturbance rejection control approach[J]. IEEE Transactions on Control Systems Technology , 2014, 22 (5) : 2056–2063. DOI:10.1109/TCST.2014.2298238 |
[13] |
王新华, 刘金琨.
微分器设计与应用--信号滤波与求导[M]. 北京: 电子工业出版社, 2010 : 144 -155.
( Wang Xin-hua, Liu Jin-kun. Differentiator design and application-signal filtering and differentiation[M]. Beijing: Publishing House of Electronics Industry, 2010 : 144 -155. ) |