邹立颖 苗凤娟 陶柏睿
(*齐齐哈尔大学通信与电子工程学院 齐齐哈尔 161006) (**齐齐哈尔大学现代教育技术中心 齐齐哈尔 161006)
基于自适应浸入与不变的VTOL飞行器跟踪控制①
邹立颖②*苗凤娟*陶柏睿**
(*齐齐哈尔大学通信与电子工程学院 齐齐哈尔 161006) (**齐齐哈尔大学现代教育技术中心 齐齐哈尔 161006)
针对输入存在不确定干扰的垂直起降(VTOL)飞行器的跟踪控制问题,提出了一种基于自适应系统浸入与不变(I&I)的控制方案:对于不确定性输入干扰,采用自适应I&I方法对干扰进行实时估计补偿;为便于控制器设计,采用系统分解技术将原系统解耦成一个最小相位误差子系统和一个非最小相位子系统,将原系统的输出跟踪问题转换为两个误差子系统的镇定问题。基于自适应I&I估计律和滑模变结构控制方法分别设计了两个子系统的控制器,所设计的控制器能够保证两个闭环子系统指数稳定。仿真结果表明,上述控制方案在干扰估计精度和收敛速度方面明显优于传统自适应估计方法,能够实现飞行器对给定轨迹的准确跟踪,同时抑制输入干扰对系统性能的不良影响。
垂直起降(VTOL)飞行器, 输出跟踪, 浸入与不变(I&I), 干扰抑制
垂直起降(vertical take-off and landing,VTOL)飞行器是一种典型的强耦合、欠驱动、非最小相位系统[1-3],其控制器的设计极具挑战性,得到了国内外研究人员的极大重视。现有的VTOL飞行器的研究主要有两个方向:镇定控制和轨迹跟踪控制,已有大量文献对其进行了深入研究[1-11]。文献[4,5]在忽略飞行器滚动控制输入和横向加速度间耦合关系的情况下,采用近似输入-输出线性化方法克服了零动态不稳定的难题。文献[6]采用模型分解的方法研究了输出轨迹跟踪问题。文献[7,8]采用观测器重构速度信号,采用反步法实现了VTOL飞行器全局输出渐近跟踪。文献[8]应用饱和函数法进一步解决了输入受限情况下VTOL飞行器的轨迹跟踪问题。上述文献都没有考虑真实系统受到的输入干扰问题,而输入干扰会严重影响系统的控制性能。
为了解决输入干扰抑制问题,本研究采用自适应浸入与不变(immersion and invariance,I&I)方法进行在线干扰估计补偿。自适应I&I方法由文献[12-14]提出,是一种新的基于系统浸入与不变的非线性自适应控制方法。相对于传统自适应估计律,该方法不依赖于确定性等价原则,使参数估计和控制器设计分开进行,因此闭环系统暂态性能不受估计律动态的影响,同时估计律动态可调节,可明显提高估计精度和收敛速度。对于存在输入干扰的VTOL飞行器的输出跟踪控制问题,本文提出了一种将自适应I&I方法与滑模变结构控制方法相结合的控制策略。为了克服输入干扰对系统的不利影响,采用自适应I&I干扰估计律对干扰进行实时估计,通过选择合适的光滑函数,来保证干扰误差估计系统指数收敛。本研究基于自适应I&I干扰估计律和滑模控制方法设计了鲁棒跟踪控制器,利用Lyapunov稳定性理论证明了闭环系统的稳定性。仿真结果表明本文提出的方法在输入受扰情况下,能够保证系统快速、稳定地跟踪给定参考轨迹,并且自适应I&I估计律在估计精度和收敛速度方面明显优于传统自适应估计方法。
根据文献[5],VTOL飞行器动力学模型表示为
(1)
其中,(x1,x3)是VTOL飞行器质心的水平和垂直方向位置,x5为滚转角,u1和u2为飞行器底部推力控制输入和滚动控制输入,g为重力加速度,ε是描述滚动控制输入和横向加速度关系的耦合系数,系统输出为y1=x1, y2=x3, y3=x5。 ξ1(t)和ξ2(t)分别为推力不确定性干扰和滚动输入不确定性干扰。由式(1)可见,VTOL飞行器为非最小相位系统。
假设1:假设干扰ξ1(t)和ξ2(t)未知有界且它们的导数也是有界的。
定义
d1(t)=-ξ1(t)sinx5+εξ2(t)cosx5
d2(t)=ξ1(t)cosx5+εξ2(t)sinx5
d3(t)=ξ2(t)
则di(t)及其一阶导数也是有界的。系统(1)变为
(2)
本文解决的是VTOL飞行器的鲁棒输出跟踪问题,给定飞行器的位置参考轨迹为Yd=(y1d,y2d),控制目标为设计控制律u1和u2使得系统式(2)在不确定性输入干扰存在的情况下,使y1(t)和y2(t)分别渐近跟踪y1d和y2d,同时保证内部动态(x5,x6)稳定到(0,0)。
1.1 输入变换
对系统式(2),选择可逆的控制变换
(3)
其中:v1和v2为新的控制输入,则系统式(2)变为
(4)
1.2 系统解耦
为便于控制器设计,利用以下坐标变换将系统式(4)进行解耦。定义坐标变换
η2=εx6-e2cosx5-e4sinx5
(5)
把式(5)代入式(4)中,得到跟踪误差系统
(6)
误差系统式(6)的不稳定零动态为
(7)
由于零动态与跟踪误差有如下关系
(8)
可知,系统零动态与(e1,e2)无关,与(e3,e4)相关,因此,误差系统可以分解为最小相位部分
(9)
和非最小相位部分
(10)
因此,原系统(2)的跟踪问题就转换成跟踪误差子系统式(9)和式(10)的镇定控制问题。基于以上分解方法,我们分别对两个子系统式(9)和式(10)设计控制律。
对于系统不确定性干扰d1(t)和d2(t),本文采用自适应I&I方法进行估计。 根据自适应I&I方法,为不确定性干扰d1(t)和d2(t)构造自适应估计律。
令干扰估计误差分别为
(11)
(12)
对式(11)、(12)求导,得到估计误差系统
(13)
(14)
选取自适应I&I估计律:
(15)
(16)
将自适应I&I估计律代入估计误差系统式(13)和(14)中,干扰估计误差系统变为
(17)
(18)
为了使干扰估计误差z1和z2按指数规律收敛于零,分别选择光滑函数β1和β2为
β1(e1,e2)=λ1e2
(19)
β2(e3,e4)=λ2e4
(20)
其中:λ1>0, λ2>0为可调参数。
引理1:对于干扰估计误差系统式(17),采用形如式(19)的光滑函数β1(e1,e2),在假设1成立的条件下,干扰估计误差系统式(17)是全局指数稳定的。
引理2:对于干扰估计误差系统式(18),采用形如式(20)的光滑函数β2(e3,e4),在假设1成立的条件下,干扰估计误差系统(18)是全局指数稳定的。
证明:同引理1。
为实现对给定轨迹的鲁棒跟踪,本节基于干扰观测器,采用滑模方法分别对误差子系统式(9)和(10)设计了控制器,在控制器中对干扰进行了有效补偿。
对最小相位子系统式(9),定义滑模函数
s1=e4+ke3
其中,k为待设计的正常数。
设计滑模控制律
(21)
式中h2为待设计的正常数。
考虑Lyapunov函数
则沿系统式(9)的轨迹求导得
对非最小相位子系统式(10),令μ1=e2, μ2=[e1,η1,η2]T,则式(10)变为
(22)
其中:
将式(22)的第二个方程线性化得
(23)
式中:
对系统式(23)定义滑模函数为
s2=μ1-Mμ2
(24)
设计滑模控制律v1为
(25)
考虑Lyapunov函数
则有
(26)
下面以定理形式总结本文提出的主要成果。
仿真结果如图1至图5所示。图1表示输出轨迹跟踪曲线,图2表示飞行器滚转角及其角速度变化曲线。图1和图2表明,VTOL飞行器能够快速、准确地跟踪给定输出参考轨迹,同时保证滚转角及其角速度渐近稳定地收敛到零。本文设计的控制器跟踪效果良好。图3和图4分别表示自适应I&I干扰估计曲线和传统I&I干扰估计曲线,由图3和图4可以看出,传统自适应估计器仅能保证估计误差有界,而自适应I&I估计器在估计误差精度和收敛速度方面明显优于传统自适应估计方法,能够有效补 偿干扰。图5为VTOL飞行器控制输入曲线,可以看出控制器响应迅速、稳定收敛。上述结果表明,本文设计的控制器对输入干扰具有鲁棒性和自适应性。
图1 输出轨迹跟踪曲线
图2 滚转角及滚转角速度
图3 自适应I&I干扰估计曲线
图4 传统自适应干扰估计曲线
图5 基于自适应I&I方法的控制输入
对于存在不确定干扰的VTOL飞行器的输出跟踪问题,本文提出了一种基于自适应I&I的控制方案。对于输入干扰,采用自适应I&I干扰估计律在线估计。通过选取合适的光滑函数,能够保证干扰估计误差系统指数收敛。将自适应I&I与滑模控制方法相结合设计了自适应I&I滑模控制器,利用Lyapunov理论分析了闭环系统的渐近稳定性。仿真结果表明该控制器表现出良好的跟踪性能,能够有效抑制输入干扰对系统的影响。因此,本方法是有效可行的。
[1] Zhu B, Cai K Y. Approximate trajectory tracking of input-disturbed PVTOL aircraft with delayed attitude measurements.InternationalJournalofRobustandNonlinearControl, 2010, 20(14): 1610-1621
[2] Al-Hiddabi S A, McClamroch N H. Output tracking for nonlinear nonminimum phase VTOL aircraft. In: Proceedings of the 37th IEEE Conference on Decision and Control, Tampa, USA, 1998. 4573-4578
[3] Olfati-Saber R. Global configuration stabilization for the VTOL aircraft with strong input coupling.IEEETransactionsonAutomaticControl, 2002, 47(11): 1949-1952
[4] Hauser J, Sastry S, Meyer G. Nonlinear control design for slightly nonminimum phase systems.Automatica, 1992, 28(4): 665-679
[5] Huang C S, Yuan K. Output tracking of a nonlinear non-minimum phase PVTOL aircraft based on nonlinear state feedback.InternationalJournalofControl, 2002, 75(6): 466-473
[6] Wang X H, Liu J K, Cai K Y. Tracking control for a velocity-sensorless VTOL aircraft with delayed outputs.Automatica, 2009, 45(12): 2876-2882
[7] Do K D, Jiang Z P, Pan J. On global tracking control of a VTOL aircraft without velocity measurements.IEEETransactionsonAutomaticControl, 2003, 48(12): 2212-2217
[8] Ailon A. A control for autonomous VTOL aircraft with restricted inputs. In: Proceedings of the 17th IEEE Mediterranean Conference on Control and Automation, Thessaloniki, Greece, 2009. 1569-1574
[9] 刘盛平,陆震,吴立成. 欠驱动VTOL空间飞行器系统的非线性跟踪控制.系统仿真学报,2006,18(2): 735-737
[10] 刘盛平,陆震,吴立成. 垂直起降飞机的全局轨迹跟踪控制.控制与决策,2007,22(8): 899-902
[11] 刘金琨,龚海生.有输入饱和的欠驱动VTOL飞行器滑模控制.电机与控制学报,2013,17(3): 92-97
[12] Astolfi A, Ortega R. Immersion and invariance: a new tool for stabilization and adaptive control of nonlinear systems.IEEETransactionsonAutomaticControl, 2003, 48(4): 590-606
[13] Astolfi A, Ortega R, Karagiannis D. Nonlinear and Adaptive Control with Applications. London:Springer-Verlag, 2008
[14] Karagiannis D, Astolfi A. Nonlinear adaptive control of systems in feedback form: an alternative to adaptive backstepping.Systems&ControlLetters, 2008, 57(9): 733-739
Tracking control for a VTOL aircraft based on adaptive immersion and invariance
Zou Liying*, Miao Fengjuan*, Tao Bairui**
(*College of Communications and Electronics, Qiqihar University, Qiqihar 161006) (**Modern Education and Technology Center, Qiqihar University, Qiqihar 161006)
To realize the tracking control of a vertical take-off and landing (VTOL) aircraft with uncertain input disturbances, a robust tracking control strategy based on adaptive immersion and invariance (I&I) was presented. The strategy uses an adaptive I&I method to achieve the real-time estimation and attenuation of uncertain input disturbances. For making the controller design easier, it transfers the output tracking problem of an original system into the stabilizing problem of two error subsystems by using the system decomposing technique to change the original system into a minimum phase error subsystem and a non-minimum phase subsystem. On the basis of the adaptive I&I estimator, two low-dimensional controllers of the two decomposed subsystems were designed, which makes the overall closed-loop system exponentially stable. The numerical simulation results and stability analysis demonstrate the effectiveness and robustness of the proposed control method.
vertical take-off and landing (VTOL) aircraft, output tracking, immerse and invariance (I&I), disturbance rejection
10.3772/j.issn.1002-0470.2016.02.009
①黑龙江省自然科学基金(F201438)和黑龙江省教育厅科学技术研究(12541899)资助项目。
2015-10-30)
②女,1980年生,博士生,讲师;研究方向:飞行器控制,非线性控制;联系人,E-mail: zouliying2007@126.com