2. 智能机器人技术天津市重点实验室(南开大学),天津 300350 ;
3. 中国民航大学 理学院,天津 300300
2. Key Laboratory of Intelligent Robotics(Nankai University), Tianjin 300350, China ;
3. College of Science, Civil Aviation University of China, Tianjin 300300, China
科学技术的不断发展,也要求控制的精确性、快速性以及对变化的适应性等控制性能指标不断提升. 经典PID控制器具有不依赖被控对象的精确模型的特点,在实际控制中得到了广泛的应用. 但在面对更为复杂的受控对象(例如多变量耦合、强非线性、参数时变、大时滞、以及其他内部及外部不确定因素)时,PID控制器仍存在一定的局限性,因此要发展具有更强适应能力的先进控制方法. 中国学者韩京清提出的自抗扰控制技术(ADRC)[1-3],是一种不依赖于精准对象模型的新型控制方法,能实时估计并补偿系统在工作时受到的各种外扰及自身内扰的综合作用,再结合特殊的误差反馈机制,就能得到优良的适应能力和的控制品质. ADRC技术具有抗干扰能力强、超调小、响应快等特点. 美国学者高志强提出了基于线性扩张状态观测器(LESO)的线性自抗扰控制(LADRC)[4],使得自抗扰控制算法更加简化、可调参数有效地减少,非常宜于数字化实现,推动了这种控制技术在实际工程中的应用[5]. 目前ADRC技术已经成为有效的控制工具,在理论上得到了极大的丰富与发展[6-11] ,而且在机电控制、航空航天控制、过程工业控制等多个领域的工程实践中获得成功的应用[12-13]. 但是ADRC在复杂非线性系统中的应用,如果要获得更优的控制性能,需要与其他先进控制方法有机结合.
广义预测控制(GPC)[14-15]是由英国学者Clarke等提出的,具有模型预测、滚动优化和在线反馈校正等特征,适合运用于模型不确定、大滞后、开环不稳定、非最小相位等系统. 但是GPC的缺点在于预测对于模型参数比较敏感,同时需要在线求解丢番图方程组,当预测步长较大时,计算量太大.
四旋翼无人飞行器是一种具有6个自由度(位置和姿态)和4个控制输入的欠驱动非线性系统,其具有多变量强耦合、强非线性、以及对扰动敏感等特性,这使得控制系统的设计十分困难,而整个飞行控制系统的关键就是姿态控制. 目前常见的控制方法包括四元反馈控制[16-17]、反步控制[18-19]、最优控制[20]、H∞鲁棒控制[21]、滑模控制[22-23]等. 这些控制系统的设计较多地依赖于对被控对象建模的精确性,而且控制算法复杂,不易实时地实现.
本文尝试将ADRC与GPC这两种先进控制方法有机地结合,推导出自抗扰广义预测控制算法(ADRC-GPC). 通过引入线性扩张状态观测器(LESO),对被控系统进行反馈补偿及化简,使每一个控制通道近似化为单积分器. 然后,针对单积分器这种简单线性对象设计GPC,通过分析丢番图方程的求解过程,可直接获得阶跃系数矩阵的解析解形式,未来输出的预测可由输出采样值直接计算得到,避免了在线求解丢番图方程组所带来的计算量大的问题. 最后通过在四旋翼飞行系统的实验装置上进行的实时控制结果,验证了ADRC-GPC对多变量欠驱动非线性系统具有良好的稳定性和控制性能.
1 自抗扰控制ADRC的基本原理ADRC是由跟踪微分器(TD)、扩张状态观测器(ESO)、非线性状态误差反馈律(NLSEF)这3部分所构成. 其中通过TD得到光滑的输入信号及其微分信号,为系统的输入安排过渡过程. 通过ESO来估计出系统的状态和受到的总扰动. 这里总扰动指系统的模型不确定性(内扰)和外扰的综合作用. 将估计出来的总扰动量补偿进入到控制器中,可将原非线性控制系统转化为线性化的串联型积分器系统. 这种动态估计并补偿总扰动的功能就是ADRC的核心技术. 非线性状态误差反馈律NLSEF是通过适当的非线性函数,将TD产生的跟踪信号及其微分与ESO估计出的系统的状态进行组合,得到系统的当前反馈控制量u0. 而最终的控制量u由虚拟控制量u0再加上总扰动估计的补偿值来确定.
2 自抗扰广义预测控制器(ADRC-GPC) 2.1 非线性系统的动态补偿线性化设一个被控回路的非线性系统为
$\hat{x}=f\left( x,\dot{x} \right)+bu.$ | (1) |
其中:x为系统状态,f(x,${\dot{x}}$)为未知函数,u为对应的控制量.
令x1=x,x2=${\dot{x}}$,x3=fx,${\dot{x}}$,得到状态方程
$\left\{ \begin{matrix} {{{\dot{x}}}_{1}}={{x}_{2}}, \\ {{{\dot{x}}}_{2}}={{x}_{3}}+bu, \\ {{{\dot{x}}}_{3}}=f\left( x,\dot{x} \right), \\ y={{x}_{1}}. \\ \end{matrix} \right.$ | (2) |
针对式(2)设计ESO为
$\left\{ \begin{matrix} {{{\dot{z}}}_{1}}={{z}_{2}}-{{\beta }_{01}}fal(\bar{y}-y,{{a}_{1}},\delta ), \\ {{{\dot{z}}}_{2}}={{z}_{3}}-{{\beta }_{02}}fal(y--y,{{a}_{2}},\delta )+{{b}_{0}}u, \\ {{{\dot{z}}}_{3}}=-{{\beta }_{03}}fal(y--y,{{a}_{3}},\delta ), \\ \bar{y}={{z}_{1}}. \\ \end{matrix} \right.$ | (3) |
其中:β01~β03为ESO的设计参数,fal(·)函数为
$fal\left( e,a,\delta \right)=\left\{ \begin{matrix} {{\left| e \right|}^{a}}sign\left( e \right) & ,\left| e \right|>\delta ; \\ \frac{e}{{{\delta }^{1-a}}} & ,\left| e \right|\le \delta . \\ \end{matrix} \right.$ | (4) |
选择合适的ESO增益β01~β03,可使
${{z}_{3}}\approx f\left( x,\dot{x} \right).$ | (5) |
令
$u=\frac{{{u}_{0}}-{{z}_{3}}}{{{b}_{0}}}\approx \frac{{{u}_{0}}-f\left( x,\dot{x} \right)}{{{b}_{0}}},$ | (6) |
其中:u0为虚拟控制量,b0为决定补偿作用大小的补偿因子. 将式(6)代入(1)式中,得到${\ddot{x}}$≈u0. 其传递函数为
$\frac{x\left( s \right)}{{{u}_{0}}\left( s \right)}\approx \frac{1}{{{s}^{2}}}~.$ | (7) |
于是,通过ESO的动态补偿线性化,将原非线性被控系统转化为线性积分器系统,为后续设计GPC提供了便利. GPC设计过程就与非线性模型的具体形式和参数取值无直接关系了,故而有效地降低了控制系统对于模型的敏感性.
2.2 非线性系统的ADRC-GPC算法基于模型(7)进行GPC设计,先对其离散化为
${{G}_{M}}={{z}^{-1}}\frac{B({{z}^{-1}})}{A({{z}^{-1}})}.$ | (8) |
式中A(z-1)=1-2z-1+z-2,B(z-1)=$\frac{{{h}_{2}}}{2}$(1+z-1),其中 h为采样步长.
GPC的性能指标为
$J=\sum\limits_{j=1}^{N}{\left[ y\left( k+j \right) \right.}{{\left. -{{y}_{r}}\left( k+j \right) \right]}^{2}}+\lambda \sum\limits_{j=1}^{{{N}_{u}}}{\Delta uk+j-{{1}^{2}}}.$ | (9) |
式中:λ>0为控制加权因子,N为预测步长,Nu≤N为控制步长.
当J>Nu时,控制量不再变化,u(k+j-1)=u(k+Nu-1),Δu(k+j-1)=0;y(k+j)为j步向前的预测输出,yr(k+j)为柔化后的参考轨迹,参考轨迹的形式为
$\left\{ \begin{matrix} {{y}_{r}}\left( k \right)=y\left( k \right), \\ {{y}_{r}}\left( k+j \right)=\alpha {{y}_{r}}\left( k+j-1 \right)+\left( 1-\alpha \right)w\left( k \right). \\ \end{matrix} \right.$ | (10) |
其中w(k) 为当前设定值,0≤α<1为柔化因子.
j步后输出y(k+j)的预测值为
$y\left( k+j \right)={{G}_{j}}({{z}^{-1}})\Delta u\left( k+j-1 \right)+{{F}_{j}}({{z}^{-1}})y\left( k \right)+{{H}_{j}}\Delta u\left( k-1 \right),$ | (11) |
式中Fj(z-1),Gj(z-1)和Hj(z-1)为关于z-1的多项式,可由如下两个方程求出:
$1={{E}_{j}}({{z}^{-1}})A({{z}^{-1}})\Delta +{{z}^{-j}}{{F}_{j}}({{z}^{-1}}),$ | (12) |
$B({{z}^{-1}}){{E}_{j}}({{z}^{-1}})={{G}_{j}}({{z}^{-1}})+{{z}^{-j}}{{H}_{j}}({{z}^{-1}}).$ | (13) |
其中Δ=1-z-1. 由于A(z-1)和B(z-1)的形式已由式(8)给出,可由数学归纳法算得Ej(z-1),Fj(z-1),Gj(z-1),Hj(z-1)分别为
$\left\{ \begin{matrix} {{E}_{j}}{{z}^{-1}}=1+2{{z}^{-1}}+\ldots +12jj+1{{z}^{-j+1}}, \\ {{F}_{j}}{{z}^{-1}}=12j+1j+2-{{j}^{2}}+2j{{z}^{-1}}+ \\ \frac{1}{2}j+1j+2{{z}^{-2}}, \\ {{G}_{j}}{{z}^{-1}}={{h}^{2}}21+4{{z}^{-1}}+\ldots +{{j}^{2}}{{z}^{-j+1}}, \\ {{H}_{j}}{{z}^{-1}}=\frac{{{h}^{2}}}{2}\frac{1}{2}j\left( j+1 \right). \\ \end{matrix} \right.$ | (14) |
定义:
$\begin{matrix} U={{[\Delta u\left( k \right),\Delta u\left( k+1 \right),\ldots ,\Delta u(k+{{N}_{u}}-1)]}^{T}}, \\ {{Y}_{r}}={{[{{y}_{r}}\left( k+1 \right),{{y}_{r}}\left( k+2 \right),\ldots ,{{y}_{r}}\left( k+N \right)]}^{T}}, \\ Y={{\left[ y\left( k+1 \right),y\left( k+2 \right),\ldots ,y\left( k+N \right) \right]}^{T}}. \\ \end{matrix}~$ |
将式(9)写成向量形式,并令$\frac{\partial J}{\partial U}$=0,有
U=(GTG+λI)-1GTYr-Fy(k)-HΔuk-1.
其中:F=[F1,…,FN]T; H=[H1,…,HN]T; G为由Gj(z-1)的系数构成的N×Nu维矩阵,其定义可参见文献[14-15]; 具体的虚拟控制量u0,是取U的第1行分量,即
u0=[1 0 … 0]U.
3 四旋翼飞行器姿态实时控制针对加拿大Quanser公司生产的四旋翼盘旋实验装置,本文采用ADRC-GPC方法,来研究其姿态控制问题.
3.1 四旋翼无人机姿态控制系统模型四旋翼系统姿态控制状态空间方程[24]为
$\left[ \begin{matrix} {\dot{y}} \\ {\dot{p}} \\ {\dot{r}} \\ {\ddot{y}} \\ {\ddot{p}} \\ {\ddot{r}} \\ \end{matrix} \right]=\left[ \begin{matrix} 0 & 0 & 0 & 1 & 0 & 0 \\ 0 & 0 & 0 & 0 & 1 & 0 \\ 0 & 0 & 0 & 0 & 0 & 1 \\ 0 & 0 & 0 & 0 & 0 & 0 \\ 0 & 0 & 0 & 0 & 0 & 0 \\ 0 & 0 & 0 & 0 & 0 & 0 \\ \end{matrix} \right]\left[ \begin{matrix} y \\ p \\ r \\ {\dot{y}} \\ {\dot{p}} \\ {\dot{r}} \\ \end{matrix} \right]+\left[ \begin{matrix} 0 & 0 & 0 & 0 \\ 0 & 0 & 0 & 0 \\ 0 & 0 & 0 & 0 \\ \frac{{{k}_{t,c}}}{{{J}_{y}}} & \frac{{{k}_{t,c}}}{{{J}_{y}}} & \frac{{{k}_{t,n}}}{{{J}_{y}}} & \frac{{{k}_{t,n}}}{{{J}_{y}}} \\ \frac{l{{k}_{f}}}{{{J}_{p}}} & -\frac{l{{k}_{f}}}{{{J}_{p}}} & 0 & 0 \\ 0 & 0 & \frac{l{{k}_{f}}}{{{J}_{r}}} & -\frac{l{{k}_{f}}}{{{J}_{r}}} \\ \end{matrix} \right]\left[ \begin{matrix} {{V}_{f}} \\ {{V}_{b}} \\ {{V}_{r}} \\ {{V}_{l}} \\ \end{matrix} \right]$ |
其中:y为偏航角,p为俯仰角,r为滚转角,Vf、Vb、Vr、Vl分别为控制4个方向旋翼转速的电压,kt,n为螺旋桨顺时针力矩系数,kt,c为螺旋桨逆时针力矩系数,kf为螺旋桨升力系数,Jy为偏航轴转动惯量,Jp为俯仰轴转动惯量,Jr为滚转轴转动惯量,l为旋转中心与螺旋桨中心距离.
将三自由度四旋翼盘旋系统分为偏航、俯仰和滚转3个通道,则姿态控制系统框图如图 1[25]所示,对每个通道本文分别采用一个ADRC-GPC控制器,算出3个通道的控制量u1、u2、u3,再通过控制量转换成Vf、Vb、Vr、Vl,作用到模型上.
采用第3节中的ADRC-GPC控制方案,对四旋翼盘旋实验装置进行实时控制. 实时控制系统的硬件包括机械部件(见图 2)、功率放大器和数据采集卡,软件用到了实时控制软件Quarc. 经调试选取ADRC-GPC控制器参数,其中3个通道均相同的参数为a1=0.8,a2=0.01,a3=0.65,δ=0.05,β01=75,β02=1 875,β03=15 625,N=40,Nu=15.
系统的初始状态均为0,自抗扰预测控制器参数如下. 偏航通道:b0 =0.001,h =0.001,λ= 0.000 05;俯仰通道:b0=0.01,h=0.015,λ=0.000 2. 由图 3可见,每个通道的设定值均为比较严苛的5°时,控制器也可使系统的上升时间保证在2 s内,充分体现了ADRC-GPC控制器的快速性,尽管有一定量的超调量,但是稳定控制的效果还是令人满意的. 图 4中,设定值是幅值为4°,频率为0.04 Hz的方波信号,实时结果表明,在3个通道的设定值同时具有较大突变的情况下,控制器也能取得优良的控制效果,超调量合理,这说明了控制器是具有一定稳定控制能力和动态解耦能力的.
图 5中,在实时控制10 s时给入一个幅值为5°,持续时长为1 s的脉冲干扰信号. 图 6中,在15 s时给入幅值为5°,持续时长为1 s的脉冲干扰信号. 可以看出,设定值越平和,ADRC-GPC使受到干扰的系统恢复到初始设定状态的速度就越快. 图 5和图 6的实验结果充分表明自抗扰预测控制器在四旋翼姿态实时控制中的强抗扰性和强鲁棒性.
本文在实时控制四旋翼姿态的过程中也发现:预测步长N取得越大,系统稳定性越好,但是计算量也就越大;控制加权因子λ增加,系统控制量越平稳,但是跟踪精度会降低;柔化因子α主要与系统跟踪特性有关,α越大,超调越小,跟踪速度越慢,反之超调越大,跟踪速度越快. 采样步长h需要根据性能的要求从一个合理的区间内进行选取,在这个区间内,h取值越小,系统的响应速度越快.
4 结 论1) 将ADRC与GPC相结合,推导了自抗扰广义预测控制器(ADRC-GPC),该控制器兼具ADRC和GPC两者优点,并且易于在线计算.
2) 针对四旋翼欠驱动系统,采用自ADRC-GPC进行控制,实时控制结果表明ADRC-GPC控制器具有很好的鲁棒稳定性、抗干扰性能、以及对多变量系统的解耦能力,是一种先进实用的控制方法.
3) 进一步研究工作是对这种控制方法进行理论上的定量分析,准备采用内模控制原理和频域方法对自抗扰预测控制进行鲁棒性和稳定性分析,并给出使系统达到一定鲁棒稳定性能的参数范围.
[1] |
韩京清. 自抗扰控制器及其应用[J].
控制与决策,1998, 13 (1) : 19-23.
HAN Jingqing. Auto-disturbances-rejection controller and its applications[J]. Control and Decision,1998, 13 (1) : 19-23. (0) |
[2] |
韩京清.
自抗扰控制技术:估计补偿不确定因素的控制技术[M]. 北京: 国防工业出版社, 2008 .
HAN Jingqing. Active disturbance rejection control technique: the technique for estimating and compensating the uncertainties[M]. Beijing: National Defense Industry Press, 2008 . (0) |
[3] | HAN Jingqing. From PID to active disturbance rejection control[J]. IEEE Trans on Industrial Electronics,2009, 56 (3) : 1-7. (0) |
[4] | GAO Zhiqiang. Scaling and bandwidth-parameterization based controller tuning[C]//Proceedings of the 2003 American Control Conference. Denver: IEEE, 2003: 4989-4996. (0) |
[5] | ZHENG Qing, GAO Zhiqiang. On practical applications of active disturbance rejection control[C]//Proceedings of the 29th Chinese Control Conference. Beijing: IEEE, 2010: 6095-6100. (0) |
[6] | HUANG Yi, XUE Wenchao. Active disturbance rejection control: methodology and theoretical analysis[J]. ISA Transactions,2014, 53 (4) : 963-976. DOI: 10.1016/j.isatra.2014.03.003 (0) |
[7] | XUE Wenchao, HUANG Yi. On performance analysis of ADRC for a class of MIMO lower-triangular nonlinear uncertain systems[J]. ISA Transactions,2014, 53 (4) : 955-962. DOI: 10.1016/j.isatra.2014.02.002 (0) |
[8] | GUO Baozhu, ZHAO Zhiliang. On the convergence of an extended state observer for nonlinear systems with uncertainty[J]. Systems and Control Letters,2011, 60 (6) : 420-430. DOI: 10.1016/j.sysconle.2011.03.008 (0) |
[9] | GUO Baozhu, ZHAO Zhiliang. On convergence of nonlinear active disturbance rejection control for MIMO systems[J]. SIAM J Control and Optimization,2013, 51 (2) : 1727-1757. DOI: 10.1137/110856824 (0) |
[10] | YANG Ruiguang, SUN Mingwei, CHEN Zengqiang. Active disturbance rejection control on first-order plant[J]. Journal of Systems Engineering and Electronics,2011, 22 (1) : 95-102. DOI: 10.3969/j.issn.1004-4132.2011.01.012 (0) |
[11] |
陈增强, 孙明玮, 杨瑞光. 线性自抗扰控制器的稳定性研究[J].
自动化学报,2013, 39 (5) : 574-580.
CHEN Zengqiang, SUN Mingwei, YANG Ruiguang. On the stability of linear active disturbance rejection control[J]. Acta Automatica Sinica,2013, 39 (5) : 574-580. (0) |
[12] | HUANG Yi, XUE Wenchao, GAO Zhiqiang et.al. Active disturbance rejection control: methodology, practice and analysis[C]//Proceedings of the 33rd Chinese Control Conference.Nanjing: IEEE,2014: 1-5. (0) |
[13] | QIU Demin, SUN Mingwei, WANG Zenghui, et al. Practical wind disturbance rejection for large deep space observatory antenna[J]. IEEE Trans on Control System Technology,2014, 22 (5) : 1983-1990. DOI: 10.1109/TCST.2013.2296935 (0) |
[14] | CLARKE D W, MOHTADI C, TUFFS P S. Generalized predictive control: part 1[J]. Automatica,1987, 23 (2) : 137-148. DOI: 10.1016/0005-1098(87)90087-2 (0) |
[15] | CLARKE D W, MOHTADI C, TUFFS P S. Generalized predictive control: part 2[J]. Automatica,1987, 23 (2) : 149-160. DOI: 10.1016/0005-1098(87)90088-4 (0) |
[16] | TAYEBI A, MCGILVRAY S. Attitude stabilization of a four-rotor aerial robot[C]//Proceedings of the 43rd IEEE International Conference on Decision and Control. Paradise Island: IEEE, 2004, 2:1216-1221. (0) |
[17] | JOSHI S M, KELKAR A G, WEN J T Y. Robust attitude stabilization of spacecraft using nonlinear quaternion feedback[J]. IEEE Trans on Automatic Control,1995, 40 (10) : 1800-1803. DOI: 10.1109/9.467669 (0) |
[18] | 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. Barcelona: IEEE, 2005, 2247-2252. (0) |
[19] | BOUCHOUCHA M, SEGHOUR S, OSMANI H, et al. Integral backstepping for attitude tracking of a quadrotor system[J]. Electronics & Electrical Engineering,2011, 10 (116) : 75-81. (0) |
[20] | BOUABDALLAH S, NOTH A, SIEGWART R. PID vs LQ control techniques applied to an indoor micro quadrotor[C]//Proceedings of the 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems. Sendal: IEEE, 2004, 3:2451-2456. (0) |
[21] | GUILHERME V R, MANUEL G O, FRANCISCO R 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 (0) |
[22] | BESNARD L, YURI B S, LANDRUM B. Quadrotor vehicle control via sliding mode controller driven by sliding mode disturbance observer[J]. Journal of the Franklin Institute,2012, 349 (2) : 658-684. DOI: 10.1016/j.jfranklin.2011.06.031 (0) |
[23] | ZHENG Enhui, XIONG Jingjing, LUO jiliang. 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 (0) |
[24] |
于卫卫. 三自由度四旋翼盘旋系统控制问题研究[D]. 沈阳:东北大学, 2007.
YU Weiwei. Research on control of the three DOF hovering system with quadrotor[D]. Shenyang: Northeastern University, 2007. (0) |
[25] |
李杰, 齐晓慧, 韩帅涛. 基于自抗扰技术的四旋翼姿态解耦控制方法[J].
电光与控制,2013, 20 (3) : 44-48.
LI Jie, QI Xiaohui, HAN Shuaitao. Attitude decoupling control for quadrotor aircraft based on active disturbance rejection control technique[J]. Electronics Optics & Control,2013, 20 (3) : 44-48. (0) |