小型四旋翼飛行器的滑模控制

王辰璐，陳增強，孫明瑋

?

小型四旋翼飛行器的滑?？刂?/p>

王辰璐1, 2，陳增強1, 2，孫明瑋1, 2

(1. 南開大學計算機與控制工程學院，天津，300350；2. 天津市智能機器人技術重點實驗室，天津，300350)

針對1種六自由度四旋翼模型，設計滑?？刂破鱽硖岣呖刂葡到y(tǒng)的魯棒性。首先將四旋翼模型劃分為全驅(qū)動和欠驅(qū)動2部分，全驅(qū)動子系統(tǒng)由高度和偏航角2個獨立回路組成，而欠驅(qū)動子系統(tǒng)則包含4個被控量和2個控制量。然后針對全驅(qū)動系統(tǒng)的2個回路設計了基于反步法(Backstepping)的滑?？刂?，并進一步推導出有限時間終端滑?？刂破?。將欠驅(qū)動子系統(tǒng)寫成一種級聯(lián)標準型，并給出一種欠驅(qū)動級聯(lián)形式的滑?？刂破鳌２捎肔yapunov穩(wěn)定性理論證明所設計的滑?？刂葡到y(tǒng)的穩(wěn)定性。研究結(jié)果表明：所提出的四旋翼控制器是有效的，它不僅具有良好的魯棒性和快速跟蹤動態(tài)性能，而且能夠有效地抑制抖振現(xiàn)象。

四旋翼飛行器；欠驅(qū)動系統(tǒng)；滑?？刂疲唤K端滑?？刂?；反步法

四旋翼飛行器具有機動性強、控制靈活的特點，可以實現(xiàn)垂直起降、定點懸停等飛行姿態(tài)，因而被廣泛應用于勘測、航拍、監(jiān)控、偵查等活動中，近年來已經(jīng)成為軍事、民用領域的研究熱點。六自由度的小型四旋翼飛行器模型具有典型的非線性、強耦合性和欠驅(qū)動特性，又極易受到模型本身不確定性和外界空氣動力的干擾，因而在控制上存在一定難度[1]。四旋翼飛行器常見的控制方法有Backstepping反步法[2]、自適應控制[3]、滑?？刂芠4]等，近幾年，一些新穎的控制方法如自抗擾控制[5]、模糊控制[6]、魯棒預測控制[7]等也成功應用到四旋翼的控制中。其中滑模控制因其具有魯棒性強的特點，成為四旋翼控制的研究熱點之一。DIKMEN等[8]設計了應用于姿態(tài)控制的滑?？刂破鳎籜U等[9]所設計的滑?？刂破魍瑫r完成了姿態(tài)控制和位置控制；LEE等[10]提出了一種自適應控制與滑模控制相結(jié)合的控制方法，通過自適應修正不確定性的估計值，減小了滑?？刂破鞯脑鲆?，使滑模控制更適用于電量有限的微小型四旋翼；王俊生[11]將滑?？刂茖嶋H應用于基于OS4四旋翼平臺的飛行實驗中，并取得了較好的控制效果。在此，本文作者采用滑模控制與Backstepping相結(jié)合的方法，得到的控制器結(jié)構(gòu)簡單，魯棒性強，對于具有強擾動和不確定性的四旋翼飛行系統(tǒng)具有很好的控制效果。在滑?？刂频幕A上，還將設計有限時間終端滑?？刂破?，并對兩者的控制效果進行比較。

1 四旋翼飛行器非線性模型

四旋翼的原始動力學模型非常復雜[12]，在合理忽略摩擦阻力和陀螺效應的情況下，得到四旋翼飛行器的簡化模型[9]：

其中：(，，)表示飛行器的位置；，和為飛行器的姿態(tài)參數(shù)，分別為滾轉(zhuǎn)角、俯仰角和偏航角；K為阻力系數(shù)；I為每個軸的轉(zhuǎn)動慣量；U為4個控制量；為飛行器的質(zhì)量；為重力加速度；為飛行器的半徑長。

四旋翼飛行器系統(tǒng)有6個自由度(，，，，，)和4個控制量(1，2，3，4)，獨立控制變量的個數(shù)小于自由度的個數(shù)，因此，四旋翼飛行器是一個典型的欠驅(qū)動系統(tǒng)。

2 控制器的設計

2.1 分析處理飛行器模型

在設計控制器前，先對四旋翼飛行器的模型進行分析和處理。將模型(1)劃分為2部分：子系統(tǒng)(2)有2個控制量(1，4)和2個被控量(，)，因此，是全驅(qū)動系統(tǒng)；子系統(tǒng)(3)有2個控制量(2，3)和4個被控量(，，，)，因此，是欠驅(qū)動系統(tǒng)。

(3)

2.2 全驅(qū)動子系統(tǒng)的滑?？刂破髟O計

全驅(qū)動子系統(tǒng)由高度和偏航角2個獨立通道組成，因此可以分別設計控制器。以高度通道為例，設計基于Backstepping的滑?？刂破?。

Backstepping的核心思想是設計1個虛擬控制量，以此為中間量，利用Lyapunov穩(wěn)定理論反推真正的控制量。對于二階系統(tǒng)，用Backstepping法設計滑?？刂破鞣譃?步。

第1步，定義誤差變量：

則

(5)

假設虛擬控制量為

其中：1為正常數(shù)。

(8)

多余項12使得系統(tǒng)無法滿足Lyapunov穩(wěn)定定理，故在第2步設計中，需要在真正的控制量1中加入1項，以消除12。

第2步，選擇滑動平面：

(11)

定義整個控制系統(tǒng)的Lyapunov函數(shù):

(13)

采用指數(shù)型滑模趨近律[13]：

故式(11)和(14)聯(lián)立可以求得

為了消除第1步中引入的12項，在中加入1項，得

(16)

驗證Lyapunov穩(wěn)定性:

故系統(tǒng)滿足Lyapunov穩(wěn)定性定理，控制器設計完成。同理可以得到偏航角通道的控制器：

(18)

2.3 全驅(qū)動子系統(tǒng)的終端滑?？刂破髟O計

2.2節(jié)所設計的滑?？刂破鞑捎镁€性滑模面，系統(tǒng)為指數(shù)型收斂，在時間趨于無窮的情況下無限趨近于滑模面。終端滑模控制是一種有限時間控制，即系統(tǒng)能在有限的時間內(nèi)收斂到滑模面，具有更好的收斂性能和魯棒性[11]。

首先引入有限時間Lyapunov穩(wěn)定判據(jù)[14]。

1)為正定函數(shù)；

2) 存在正實數(shù)＞0和∈(0，1)，以及1個包含原點的開鄰域，使得下列條件成立：

則系統(tǒng)為有限時間穩(wěn)定的。

可以利用有限時間Lyapunov穩(wěn)定判據(jù)，在滑?？刂破鞯幕A上，設計四旋翼全驅(qū)動子系統(tǒng)的終端滑?？刂破?。

仍然以高度控制為例，選擇非線性滑模面[14]：

其中：為正常數(shù)；和為正奇數(shù)，且2＞＞。

(20)

根據(jù)滑?？刂圃淼?/p>

其中：，和均為正實數(shù)。

根據(jù)有限時間系統(tǒng)的Lyapunov穩(wěn)定判據(jù)，系統(tǒng)有限時間穩(wěn)定。

2.4 欠驅(qū)動子系統(tǒng)的滑?？刂破髟O計

欠驅(qū)動系統(tǒng)形式多種多樣，控制器的設計方法也不盡相同。首先給出欠驅(qū)動模型的一類標準形式，即欠驅(qū)動級聯(lián)系統(tǒng)[15]：

其中：1和2為擾動項；為控制量；1是關于1，2，3的函數(shù)，且滿足，可逆且有界。

將式(3)所示的四旋翼飛行器欠驅(qū)動子系統(tǒng)改寫欠驅(qū)動級聯(lián)形式：

，

在考慮不確定性和外加干擾的情況下，用1和2表示模型本身不確定性和外部擾動的總和，1和2為有界擾動，且滿足。此時控制律為等效控制和切換控制之和，，利用Lyapunov穩(wěn)定性理論求得切換控制。

令

(27)

將式(26)代入式(27)得

根據(jù)Lyapunov穩(wěn)定定理，系統(tǒng)穩(wěn)定。

(29)

其中：

2.5 抖振的抑制

滑模控制是一種需要頻繁切換控制狀態(tài)的控制方法，系統(tǒng)在到達滑模面后，將沿滑模面運動，但由于切換函數(shù)在實際控制中的滯后性，系統(tǒng)會在滑模面附近很小的范圍內(nèi)做高頻振蕩即抖振[13]。抖振現(xiàn)象會給控制系統(tǒng)帶來不穩(wěn)定，破壞系統(tǒng)性能，在理論上無法完全消除，但可以采取一定的措施來抑制。

本文采用一種高增益連續(xù)函數(shù)()替代上述控制器中的符號函數(shù)sgn()，可以在一定程度上抑制抖振：

其中：為很小的正常數(shù)。

3 仿真研究

本文通過Matlab仿真來驗證所設計控制器的實效性。

四旋翼飛行器的參數(shù)設置為：1=2=3=0.010，4=5=6=0.012，1=2=1.25，3=2.5，=2 kg，=0.2 m，=9.8 m/s2。

首先對全驅(qū)動子系統(tǒng)進行普通滑模控制和終端滑?？刂频膶Ρ确抡嫜芯?。經(jīng)過調(diào)試，普通滑?？刂破鲄?shù)選擇為：1=1，1=0.5，1=2，4=1.5，4=0.7，4=2，終端滑?？刂破鲄?shù)選擇為：1=7，1=3，1=5，1=0.5，4=7，4=3，4=5，4=0.4，=1。

采用普通滑?？刂破骱徒K端滑?？刂破鲿r，飛行器高度和偏航角的變化曲線見圖1。由圖1可知：對于四旋翼飛行器的控制問題，普通滑?？刂破骺梢栽谳^短的時間內(nèi)使飛行器穩(wěn)定到期望位置和姿態(tài)，且無超調(diào)，可以滿足控制要求；終端滑?？刂圃诳刂破髟O計和參數(shù)調(diào)試上更復雜，但收斂速度更快，比普通滑?？刂破鞯目刂菩Ч?。

然后對飛行器系統(tǒng)進行飛行仿真。全驅(qū)動子系統(tǒng)采用普通滑?？刂?，欠驅(qū)動子系統(tǒng)采用級聯(lián)形式的滑?？刂?。經(jīng)過多次調(diào)試，確定控制器的參數(shù)如下：1=0.5，1=0.5，1=5，4=1，4=2，4=5，1=40，2=60，3=25，=10。

要求飛行器從坐標(1，1，2)處運動到(3，3，5)處，偏航角到達給定值d=45°，并保持俯仰角和滾轉(zhuǎn)角平穩(wěn)收斂到0°，即飛行姿態(tài)平穩(wěn)。

仿真結(jié)果如圖2和圖3所示。由圖2和圖3可知飛行器的位置和姿態(tài)角均在9 s內(nèi)收斂到給定值。

由于第2.4節(jié)設計欠驅(qū)動系統(tǒng)控制器時取近似≈d，下面分析該近似值選取的合理性。分析圖3中偏航角的變化曲線可知：偏航角通道的響應速度很快，在2 s左右達到40°，即給定值的89%，又由于偏航角在控制器求解中以正余弦三角函數(shù)的形式出現(xiàn)，僅作為系數(shù)存在，故該近似值的選取對控制器的影響很小，對控制效果的影響也可以忽略不計。

分析位置和姿態(tài)的仿真曲線可知：飛行器在較短的時間內(nèi)到達期望位置并懸停在該位置，俯仰角和滾轉(zhuǎn)角變化在很小的范圍內(nèi)，說明飛行器飛行姿態(tài)平穩(wěn)，故該滑?？刂破鲗λ男盹w行器的控制是有效的。

(a) 高度的變化曲線；(b) 偏航角的變化曲線

(a) x的變化曲線；(b) y的變化曲線；(c) z的變化曲線

(a) 俯仰角的變化曲線；(b) 滾轉(zhuǎn)角的變化曲線；(c) 偏航角的變化曲線

4 結(jié)論

1) 針對六自由度四旋翼飛行器這一典型的欠驅(qū)動非線性系統(tǒng)，設計滑?？刂破鳌Ｊ紫葘⑺男砟Ｐ头殖扇?qū)動和欠驅(qū)動系統(tǒng)2部分，然后這對這2部分分別設計滑?？刂破?。對全驅(qū)動部分設計基于Backstepping的滑?？刂坪陀邢迺r間終端滑模控制2種控制器，對欠驅(qū)動部分設計了級聯(lián)形式的滑模控制。利用Lyapunov穩(wěn)定理論證明了控制系統(tǒng)的穩(wěn)定性。最后通過數(shù)值仿真對所設計的整體控制方案進行驗證，證明該控制方案達到了滿意的動態(tài)控制性能，并能有效地抑制抖振的發(fā)生。

2) 對全驅(qū)動部分的普通滑?？刂破骱徒K端滑?？刂破鞯倪M行了仿真比較，終端滑?？刂破鞑粌H收斂速度快，而且控制效果更好。

[1] YU Yali, SUN Feng, WANG Yuanxi. Controller design of quadrotor aerial robot[J]. Physics Procedia, 2012, 33: 1254?1260.

[2] ASHFAQ A M, WANG Daobo. Modeling and backstepping-based nonlinear control strategy for a 6 DOF quadrotor helicopter[J]. Chinese Journal of Aeronautics, 2008, 21(3): 261?268.

[3] NICOL C, MACNAB C J B, RAMIREZ-SERRANO A. Robust adaptive control of a quadrotor helicopter[J]. Mechatronics, 2011, 21(6): 927?938.

[4] 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, Spain: IEEE, 2005: 2247?2252.

[5] XIA Guoyan, LIU Zhenghua. Quadrotor unmanned helicopter attitude control based on improved ADRC[C]//Proceedings of the 2014 IEEE Chinese Guidance, Navigation and Control Conference. Yantai, China: IEEE, 2014: 916?921.

[6] 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.

[7] ZEGHLACHE S, SAIGAA D, KARA K. Backstepping sliding mode controller improved with fuzzy logic: application to the quadrotor helicopter[J]. Archives of Control Sciences, 2012, 22(3): 315?342.

[8] DIKMEN I C, ARISOY A, TEMELTAS H. Attitude control of a quadrotor[C]//Proceedings of the 4th International Conference on Recent Advances in Space Technologies. Istanbul, Turkey: IEEE, 2009: 722?727.

[9] XU Rong, OZGUNER U. Sliding mode control of a quadrotor helicopter[C]//Proceedings of the 45th IEEE Conference on Decision and Control. San Diego, California, USA: IEEE, 2006: 4957?4962.

[10] LEE D, KIM H J, SASTRY S. Feedback linearization vs. adaptive sliding mode control for a quadrotor helicopter[J]. International Journal of Control, Automation and Systems, 2009, 7(3): 419?428.

[11] 王俊生. 四旋翼碟形飛行器控制系統(tǒng)設計及控制方法研究[D]. 長沙: 國防科學技術大學機電工程與自動化學院, 2007: 18?35. WANG Junsheng. Design of control system and research on control method for the quad-rotor[D]. Changsha: National University of Defense Technology. College of Mechatronic Engineering and Automation, 2007: 18?35.

[12] BOUABDALLAH S. Design and control of quadrotors with application to autonomous flying[D]. Lausanne, Switzerland: Ecole Polytechnique Federale in Lausanne, 2007: 15?25.

[13] 劉金琨. 滑模變結(jié)構(gòu)控制Matlab仿真[M]. 北京: 清華大學出版社, 2005: 35?36. LIU Jinkun. Slide mode varying structure control Matlab simulation[M]. Beijing: Tsinghua University Press, 2015: 35?36.

[14] 丁世宏, 李世華. 有限時間控制問題綜述[J]. 控制與決策, 2011, 26(2): 161?169. DING Shihong, LI Shihua. A survey for finite-time control problems[J]. Control and Decision, 2011, 26(2): 161?169.

[15] 丁鳳. 幾類欠驅(qū)動機器人系統(tǒng)的滑?？刂婆c應用[D]. 武漢: 華中科技大學自動化學院, 2013: 17?21. DING Feng. Sliding Mode control and application for underactuated robot systems[D]. Wuhan: Huazhong University of Science and Technology. College of Automation, 2013: 17?21.

(編輯 楊幼平)

Sliding mode control of a quadrotor helicopter

WANG Chenlu1, 2, CHEN Zengqiang1, 2, SUN Mingwei1, 2

(1. College of Computer and Control Engineering, Nankai University, Tianjin 300350, China;2. Tianjin Key Laboratory of Intelligent Robotics, Tianjin 300350, China)

A sliding mode control scheme was proposed for a 6 degree of free quadrotor model to improve the robustness of the quadrotor control system. Firstly, the quadrotor model was divided into two parts which included a fully-actuated subsystem and an under-actuated subsystem. The fully-actuated subsystem was composed of two independent loops with altitude and yaw angle, while the under-actuated subsystem had four state variables and two control variables. Secondly, a backstepping based on sliding mode controller and furthermore a finite time terminal sliding mode controller were proposed to the fully-actuated subsystem, and then a cascade sliding mode controller was designed to control the under-actuated subsystem which was transformed into a cascade standard form. Thirdly, the stability of the designed control system was proved by using Lyapunov stability theorem. The results show that the proposed quadrotor control scheme is effective, it not only has good robustness and fast tracking dynamic performance, but also has the ability to restrain buffeting.

quadrotor; under-actuated system; sliding mode control; terminal sliding mode control; back stepping

TP272

A

1672?7207(2017)04?1006?06

10.11817/j.issn.1672?7207.2017.04.021

2016?04?06；

2016?06?18

國家自然科學基金資助項目(61573199，61573197)；天津市自然科學基金資助項目(14JCYBJC18700)(Projects (61573199, 61573197) supported by the National Natural Science Foundation of China; Project (14JCYBJC18700) supported by the Natural Science Foundation of Tianjin City)

陳增強，博士，教授，博士生導師，從事復雜系統(tǒng)建?？刂婆c仿真、飛行器制導優(yōu)化與控制研究；E-mail：chenzq@nankai.edu.cn