侯順祥，凌 睿

(1.南昌工學(xué)院 電氣與信息工程學(xué)院， 南昌 330000； 2.重慶大學(xué) 自動(dòng)化學(xué)院， 重慶 400030)

基于擾動(dòng)觀測(cè)器的四旋翼飛行器跟蹤控制

侯順祥1，凌 睿2

(1.南昌工學(xué)院 電氣與信息工程學(xué)院， 南昌 330000； 2.重慶大學(xué) 自動(dòng)化學(xué)院， 重慶 400030)

針對(duì)存在不確定干擾的四旋翼飛行器軌跡跟蹤控制問(wèn)題，提出了非線性干擾觀測(cè)器和擴(kuò)張狀態(tài)觀測(cè)器對(duì)系統(tǒng)中的擾動(dòng)進(jìn)行估計(jì)，并將估計(jì)值與最優(yōu)控制器、滑?？刂破鞯脑O(shè)計(jì)相結(jié)合，克服了模型不確定及外部不確定干擾問(wèn)題，并實(shí)現(xiàn)了飛行器系統(tǒng)跟蹤誤差的一致有界。通過(guò)李雅普諾夫穩(wěn)定性理論驗(yàn)證了用上述方法設(shè)計(jì)的控制器系統(tǒng)的穩(wěn)定性。通過(guò)仿真驗(yàn)證了該控制器能夠?qū)崿F(xiàn)對(duì)飛行器的軌跡跟蹤控制。

四旋翼飛行器； 擾動(dòng)觀測(cè)器； 滑?？刂疲?最優(yōu)控制； 軌跡跟蹤

四旋翼飛行器具有結(jié)構(gòu)簡(jiǎn)單、價(jià)格低廉、機(jī)動(dòng)靈活等特點(diǎn)，被廣泛應(yīng)用于目標(biāo)監(jiān)視、追蹤、偵察等各個(gè)領(lǐng)域。本文針對(duì)存在不確定擾動(dòng)作用下四旋翼飛行器的控制器設(shè)計(jì)進(jìn)行了研究。

目前，國(guó)內(nèi)外學(xué)者們已在四旋翼飛行器控制研究上取得了諸多成果，但由于其欠驅(qū)動(dòng)、非線性、強(qiáng)耦合等特點(diǎn)[1]，建立的動(dòng)力學(xué)模型非常復(fù)雜，其控制器的設(shè)計(jì)極具挑戰(zhàn)性。文獻(xiàn)[2-4]采用PID控制器實(shí)現(xiàn)了對(duì)飛行器的控制，但其不能適應(yīng)復(fù)雜多變的環(huán)境。Xu G.H.等設(shè)計(jì)了一種基于神經(jīng)網(wǎng)絡(luò)的PID控制算法[5]，利用神經(jīng)網(wǎng)絡(luò)的自適應(yīng)和自學(xué)習(xí)能力對(duì)比例、積分和微分系數(shù)進(jìn)行調(diào)節(jié)，飛行器能快速響應(yīng)且誤差較小。文獻(xiàn)[6-7]采用反饋線性化的控制方法，雖然具有比較好的控制效果，但其對(duì)模型精度要求較高。文獻(xiàn)[8-10]采用滑模變結(jié)構(gòu)控制算法，解決了飛行器模型的非線性及耦合控制問(wèn)題。文獻(xiàn)[11-13]采用基于反步的控制算法，實(shí)現(xiàn)了飛行器的跟蹤控制問(wèn)題，但是抗擾動(dòng)性能不足，限制了其在飛行器控制中的應(yīng)用。

本文針對(duì)飛行器軌跡跟蹤問(wèn)題，將四旋翼飛行器系統(tǒng)分解成2個(gè)子系統(tǒng)，針對(duì)全驅(qū)動(dòng)子系統(tǒng)設(shè)計(jì)了非線性干擾觀測(cè)器與最優(yōu)控制器，由于欠驅(qū)動(dòng)子系統(tǒng)中存在復(fù)合擾動(dòng)，設(shè)計(jì)了基于切換函數(shù)的擴(kuò)張狀態(tài)觀測(cè)器對(duì)其進(jìn)行估計(jì)，采用李雅普諾夫穩(wěn)定性理論證明了所提控制器的穩(wěn)定性。仿真結(jié)果表明：本文提出的控制律在存在擾動(dòng)的情況下，能夠保證系統(tǒng)是指數(shù)收斂的，使輸出快速跟蹤位置指令。

1 系統(tǒng)建模和問(wèn)題描述

四旋翼飛行器結(jié)構(gòu)如圖1所示，飛行器通過(guò)橫滾、俯仰和偏航運(yùn)動(dòng)改變姿態(tài)從而調(diào)節(jié)其位置。其橫滾運(yùn)動(dòng)通過(guò)2號(hào)槳和4號(hào)槳的差速調(diào)節(jié)產(chǎn)生，其俯仰運(yùn)動(dòng)通過(guò)1號(hào)槳和3號(hào)槳的差速調(diào)節(jié)產(chǎn)生，通過(guò)提高(降低)1、3號(hào)槳的轉(zhuǎn)速同時(shí)降低(提高)2、4號(hào)槳的轉(zhuǎn)速產(chǎn)生偏航運(yùn)動(dòng)。θ、γ、φ分別表示飛行器姿態(tài)角，系統(tǒng)的動(dòng)力學(xué)模型可表示為

(1)

其中：Jx、Jy、Jz分別為機(jī)體關(guān)于x、y、z軸的轉(zhuǎn)動(dòng)慣量，m為飛行器質(zhì)量，l為螺旋槳中心至飛行器機(jī)體中心點(diǎn)的距離，U1、U2、U3、U4為系統(tǒng)控制輸入量，其由4個(gè)螺旋槳的角速度決定，其函數(shù)關(guān)系為

(2)

其中：b為升力系數(shù)，d為反扭矩系數(shù)。

圖1 四旋翼飛行器結(jié)構(gòu)示意圖

四旋翼飛行器滾轉(zhuǎn)與俯仰姿態(tài)受到飛行器水平位置誤差約束。其模型存在2個(gè)非完整約束，故將系統(tǒng)模型分解為全驅(qū)動(dòng)子系統(tǒng)和欠驅(qū)動(dòng)子系統(tǒng)，分別采用最優(yōu)控制和滑模變結(jié)構(gòu)方法對(duì)其進(jìn)行控制律設(shè)計(jì)。

2 控制系統(tǒng)設(shè)計(jì)

四旋翼飛行器軌跡跟蹤問(wèn)題需要實(shí)現(xiàn)在系統(tǒng)存在外界擾動(dòng)和內(nèi)部不確定的情況下，飛行器的實(shí)際位置x、y、z能夠達(dá)到期望位置xd、yd、zd。偏航角φ快速達(dá)到期望值φd有助于系統(tǒng)的解耦。其中，全驅(qū)動(dòng)通道包括高度和偏航角2個(gè)通道，在考慮系統(tǒng)模型不確定和外界擾動(dòng)的情況下，全驅(qū)動(dòng)子系統(tǒng)Σ1模型為

(3)

其中：d1為全驅(qū)動(dòng)子系統(tǒng)中的擾動(dòng)，狀態(tài)變量與系數(shù)矩陣含義可表示為

(4)

欠驅(qū)動(dòng)通道包括x-γ及y-θ兩個(gè)通道，在考慮存在外界擾動(dòng)的情況下，其動(dòng)力學(xué)方程為

(5)

(6)

其中d2、d3、d4、d5分別為系統(tǒng)中的擾動(dòng)。

2.1 全驅(qū)通道控制器設(shè)計(jì)

2.1.1 非線性干擾觀測(cè)器的設(shè)計(jì)

飛行器系統(tǒng)存在不確定擾動(dòng)，為抑制外界干擾對(duì)整個(gè)系統(tǒng)性能的影響，提高控制器精度，通過(guò)引入干擾觀測(cè)器在線估計(jì)外界干擾。

非線性干擾觀測(cè)器設(shè)計(jì)如下：

(7)

(8)

由式(8)可知：選擇適當(dāng)?shù)腖1(e1,e2)>0，可使觀測(cè)誤差按指數(shù)收斂。

所以，選擇L1(e1,e2)=k1，設(shè)計(jì)p1(e1,e2)=k1e2。

2.1.2 基于非線性干擾觀測(cè)器的控制器設(shè)計(jì)

為實(shí)現(xiàn)對(duì)給定軌跡的跟蹤，基于干擾觀測(cè)器，針對(duì)全驅(qū)子系統(tǒng)設(shè)計(jì)了線性二次調(diào)節(jié)(LQR)最優(yōu)控制器。

全驅(qū)動(dòng)通道是二階子系統(tǒng)，Σ1子系統(tǒng)跟蹤誤差e1和跟蹤誤差導(dǎo)數(shù)e2為

(9)

變量e1和e2的一階導(dǎo)數(shù)與擾動(dòng)d1之間的關(guān)系滿足

(10)

令

(11)

則式(10)變?yōu)?/p>

(12)

對(duì)誤差子系統(tǒng)Σ1，選擇最優(yōu)控制器

(13)

將控制律(式(13))代入式(11)中，得到閉環(huán)系統(tǒng)

(14)

(15)

通過(guò)設(shè)計(jì)全驅(qū)通道控制器u，實(shí)現(xiàn)對(duì)指令z1d的跟蹤。

2.2 欠驅(qū)動(dòng)通道控制器設(shè)計(jì)

對(duì)于欠驅(qū)動(dòng)通道控制律的設(shè)計(jì)，本文首先根據(jù)四旋翼飛行器控制目標(biāo)選取合適的誤差變量進(jìn)行切換函數(shù)設(shè)計(jì)； 然后根據(jù)切換函數(shù)對(duì)擴(kuò)張狀態(tài)觀測(cè)器進(jìn)行設(shè)計(jì)，對(duì)重構(gòu)后系統(tǒng)中的擾動(dòng)進(jìn)行估計(jì)； 最后設(shè)計(jì)基于擴(kuò)張狀態(tài)觀測(cè)器的滑?？刂坡?。下面首先設(shè)計(jì)x-γ通道的控制律。

2.2.1 切換函數(shù)設(shè)計(jì)

(16)

(17)

對(duì)于x-γ通道欠驅(qū)動(dòng)子系統(tǒng)，通過(guò)設(shè)計(jì)左右通道及滾轉(zhuǎn)角的控制輸入量U3，實(shí)現(xiàn)飛行器實(shí)際位置x能夠達(dá)到期望位置xd，同時(shí)保持滾轉(zhuǎn)角γ的鎮(zhèn)定。

切換函數(shù)s1相關(guān)的變量e1、e2、e3和e4分別為

誤差變量e1、e2、e3、e4的一階導(dǎo)數(shù)與擾動(dòng)d2，d5間的關(guān)系為

由e1、e2、e3、e4設(shè)計(jì)x-γ通道子系統(tǒng)的切換函數(shù)為

s1=c1e1+c2e2+c3e3+e4

(20)

式中c1、c2和c3為切換函數(shù)的參數(shù)。切換函數(shù)參數(shù)c1、c2和c3的選取需使得狀態(tài)轉(zhuǎn)移矩陣為Hurwitz矩陣，這樣當(dāng)切換函數(shù)s1趨近于0后，系統(tǒng)跟蹤誤差能夠收斂于0。

y-θ通道子系統(tǒng)的切換函數(shù)設(shè)計(jì)與此相同。

2.2.2 擴(kuò)張狀態(tài)觀測(cè)器設(shè)計(jì)

對(duì)于飛行器系統(tǒng)中存在的未建模動(dòng)態(tài)和外界擾動(dòng)，采用擴(kuò)張狀態(tài)觀測(cè)器對(duì)此復(fù)合擾動(dòng)進(jìn)行估計(jì)。采用基于系統(tǒng)模型的傳統(tǒng)ESO設(shè)計(jì)方法對(duì)系統(tǒng)中的非匹配擾動(dòng)d2、d3進(jìn)行估計(jì)，采用基于切換函數(shù)的ESO設(shè)計(jì)方法對(duì)匹配不確定性d4、d5進(jìn)行估計(jì)。

對(duì)于x-γ通道中的非匹配不確定性d2，設(shè)計(jì)基于系統(tǒng)模型的擴(kuò)張狀態(tài)觀測(cè)器為

(21)

y-θ通道中的非匹配不確定性d3的設(shè)計(jì)與上述方法相同。

(22)

對(duì)于x-γ通道，在經(jīng)切換函數(shù)s1重構(gòu)后的系統(tǒng)中既包含擾動(dòng)d5，也包含由對(duì)d2的估計(jì)引起的其他擾動(dòng)，將其作為總擾動(dòng)d5s。設(shè)計(jì)基于切換函數(shù)s1的擴(kuò)張狀態(tài)觀測(cè)器為

2.2.3 控制器設(shè)計(jì)

由切換函數(shù)導(dǎo)數(shù)得到

(24)

(25)

(26)

U3=ueq+usw

(27)

故得到x-γ通道的控制律U3為

(28)

(29)

將控制式(25)～ (27)代入式(24)，得

(30)

(31)

(32)

(33)

式中 -λmin(Q)為正定陣Q的最小特征值。

3 系統(tǒng)仿真

在Matlab/Simulink環(huán)境下對(duì)本文設(shè)計(jì)控制律進(jìn)行了仿真實(shí)驗(yàn)。系統(tǒng)模型相關(guān)參數(shù)如表1所示，假設(shè)期望軌跡為

d2=0.2sin(0.1πt)

d3=0.2cos(0.1πt)

d4=0.3sin(0.1πt)+0.1

d5=0.3cos(0.1πt)

表1 飛行器模型參數(shù)

選擇控制器的相關(guān)參數(shù)如下：

l1=2.341，l2=3.583，k1=55，k2=27，Q=diag(90,90)，R=45，c1=64，c2=48，c3=12，c4=27，c5=27，c6=9，p1=16，p2=14，λ1=6，λ2=5。

選擇擴(kuò)張狀態(tài)觀測(cè)器的參數(shù)為

h1=6，h2=12，h3=7，h4=5，h5=9，h6=7，h7=12，h8=8，h9=6，h10=10。

圖2所示為飛行器輸出軌跡跟蹤曲線，仿真結(jié)果表明：四旋翼能夠快速跟蹤指定的軌跡運(yùn)動(dòng)。

圖2 飛行器輸出軌跡跟蹤曲線

圖3所示為在本文提出的控制律下飛行器系統(tǒng)的軌跡跟蹤誤差曲線，在仿真中對(duì)飛行器初始狀態(tài)作了設(shè)定，飛行器在剛開(kāi)始啟動(dòng)時(shí)，能夠在2～3 s內(nèi)追蹤到指令位置且位置誤差不超過(guò)4 cm。運(yùn)動(dòng)過(guò)程中系統(tǒng)的中間狀態(tài)變量θ、γ、φ的曲線如圖4所示。在運(yùn)行過(guò)程中，飛行器的姿態(tài)歐拉角在本文所提方法的作用下能夠在1.8 s內(nèi)到達(dá)0.2°的穩(wěn)定誤差帶,最終保持鎮(zhèn)定。

圖5所示為四旋翼的控制器輸出曲線圖，為模擬系統(tǒng)的模型不確定性，將飛行器質(zhì)量m在10 s時(shí)從2.8 kg變?yōu)?.4 kg，采用觀測(cè)器對(duì)系統(tǒng)擾動(dòng)進(jìn)行了估計(jì)，對(duì)控制器的輸出進(jìn)行了補(bǔ)償，無(wú)連續(xù)跳變現(xiàn)象出現(xiàn)。

圖3 飛行器跟蹤誤差曲線

圖5 控制器輸出曲線

4 結(jié)束語(yǔ)

本文研究了存在不確定干擾的四旋翼飛行器的軌跡跟蹤問(wèn)題，將系統(tǒng)分解為全驅(qū)動(dòng)部分和欠驅(qū)動(dòng)部分。針對(duì)系統(tǒng)的不確定干擾，分別提出了非線性干擾觀測(cè)器與擴(kuò)張狀態(tài)觀測(cè)器對(duì)擾動(dòng)進(jìn)行估計(jì)，并在控制器中進(jìn)行補(bǔ)償，提高了控制器的抗干擾能力。仿真結(jié)果表明：本文所提控制律具有較好的跟蹤效果。由于設(shè)計(jì)的干擾觀測(cè)器能夠?qū)ο到y(tǒng)擾動(dòng)進(jìn)行有效估計(jì)，因而提高了控制精度。

[1] BESNARD L,SHTESSEL Y B,LANDRUM B.Quadrotor vehicle control via sliding mode controller driven by sliding mode disturbance observer[J].Journal of the Franklin Institute,2012,349:658-684.

[2] SALIH A L,MOGHAVVEMI,et al.Flight PID Controller Design for a UAV Quadrotor[J].Scientific Research & Essays,2010,5(23):3660-3667.

[3] KADA B,GHAZZAWI Y.Robust PID controller design for an UAV flight control system[C]//Lecture Notes in Engineering and Computer Science.USA:[s.l.],2011.

[4] MILHIM A,ZHANG Y M.Gain scheduling based PID controller for fault tolerant control of a quad-rotor UAV[C]//American Institute of Aeronautics and Astronautics Infotech@Aerospace 2010.Atlanta,GA:AIAA,2010:1-13.

[5] MADANI T,BENALLEGUE A.Backstepping control for a quadrotor helicopter[C]//Proceedings of the 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.Beijing,China:IEEE,2006:3255-3260.

[6] MOKHEARI A，BENALLEGUE A,DAACHI B.Robust feedback linea-rization andGH∞controller for a quadrotor unmanned aerial vehicle[C]//Proceedings of the 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.Edmonton,Canada:[s.n.],2005:1198-1203.

[7] FREDDI A,LANZON A,LONGHI S.A feedback linearization approach to fault tolerance in quadrotor vehicles[J].World Congress,2011,18(1):5413-5418.

[8] SUMANTRIB,UCHIYAMA N,SANO S,et al.Robust tracking control of a quad-rotor helicopter utilizing sliding mode control with a nonlinear sliding surface[J].Journal of System Design and Dynamics,2013,7(2):226-241.

[9] ZHANG R,WANG X,CAI K Y.Quadrotor aircraft control without velocity measurements[C] //Proceedings of the 48th IEEE.[S.l.]:[s.n.],2009:5213-5218.

[10] 吳琛,蘇劍波.四旋翼飛行器的軌跡跟蹤抗干擾控制[J].控制理論與應(yīng)用,2016,33(11):1422-1430.

[11] BOUABDALLAH S,SIEGWART R.Backstepping and sliding mode echniques applied to an indoor micro quadrotor[C]//Proceedings of IEEE International Conference on Robotics and Automation.Barcelona,Spain：[s.n.],2005:2247-2252.

[12] BOUADI H,BOUCHOUCHA M,TADJINE M.Sliding mode control based on backsteping approach for an UAV typequadrotor[J].International Journal of Applied Ma-them-Atics and Computer Sciences,2008,4(1):12.

[13] 牛洪芳,吳懷宇,陳洋.基于反步法的四旋翼飛行器滑動(dòng)模態(tài)控制[J].高技術(shù)通訊,2015,25(12):1083-1091.

TrackingControlforQuadrotorAircraftBasedonaDisturbanceObserver

HOU Shunxiang1, LING Rui2

(1.College of Electrical and information Engineering, Nanchang Institute of Science and Technology, Nanchang 330000, China; 2.School of Automation, Chongqing University, Chongqing 400030, China)

In order to solve the problem of trajectory tracking control of quadrotor aircraft with uncertain disturbances, a tracking strategy using a nonlinear disturbance observer and an extended state observer to estimate the disturbance in the system was proposed. The strategy is designed by the optimal controller and sliding mode controller, considering the estimation, to overcome the uncertainty of the model and the disturbance of external uncertainties，and the tracking error of the system are ultimately bounded under the control law. The stability of the controller system designed by the above method is verified by Lyapunov stability theory. Simulation results show that the controller can realize trajectory tracking control of aircraft.

quadrotor aircraft; disturbance observer; sliding mode control; optimal control; trajectory tracking

2017-05-23

江西省教育廳科學(xué)技術(shù)研究項(xiàng)目(GJJ161221)

侯順祥(1985—)，男，河南?？h人，碩士，講師，主要從事電機(jī)控制、四旋翼控制方面的研究，E-mail:308078808@qq.com； 凌睿(1979—)，男，重慶人，博士，副教授，主要從事智能控制、非線性控制方面的研究。

侯順祥，凌睿.基于擾動(dòng)觀測(cè)器的四旋翼飛行器跟蹤控制[J].重慶理工大學(xué)學(xué)報(bào)(自然科學(xué))，2017(12):173-180.

formatHOU Shunxiang, LING Rui.Tracking Control for Quadrotor Aircraft Based on a Disturbance Observer[J].Journal of Chongqing University of Technology(Natural Science)，2017(12):173-180.

10.3969/j.issn.1674-8425(z).2017.12.030

TP273

A

1674-8425(2017)12-0173-08

(責(zé)任編輯陳 艷)