基于滑?？刂频乃男頍o人機自適應(yīng)跟蹤控制

劉凱悅, 冷建偉

(1.天津理工大學(xué) 自動化學(xué)院, 天津 300384;2.天津市復(fù)雜系統(tǒng)控制理論及應(yīng)用重點實驗室, 天津 300384)

基于滑?？刂频乃男頍o人機自適應(yīng)跟蹤控制

劉凱悅1, 冷建偉2

(1.天津理工大學(xué) 自動化學(xué)院, 天津 300384;2.天津市復(fù)雜系統(tǒng)控制理論及應(yīng)用重點實驗室, 天津 300384)

針對四旋翼無人機在系統(tǒng)內(nèi)部模型參數(shù)不確定性情況下的軌跡跟蹤問題,提出了一種基于滑模控制的四旋翼無人機自適應(yīng)跟蹤控制方法。首先,采用單位四元數(shù)來描述系統(tǒng)姿態(tài),將系統(tǒng)分解為位置子系統(tǒng)和姿態(tài)子系統(tǒng);考慮到位置子系統(tǒng)的欠驅(qū)動特性,引入了虛擬控制力,跟蹤位置信息并解算出實際升力和理想姿態(tài);其次,通過自適應(yīng)滑?？刂破餮a償了質(zhì)量和轉(zhuǎn)動慣量的不確定性,實現(xiàn)了軌跡的跟蹤;最后,利用Lyapunov理論證明了閉環(huán)系統(tǒng)的穩(wěn)定性。仿真結(jié)果表明了算法的有效性。

四旋翼無人機; 單位四元數(shù); 虛擬控制力; 自適應(yīng)滑?？刂?/p>

0 引言

與傳統(tǒng)的直升機相比,四旋翼無人機的工藝更簡單、安全性能更強、飛行效率也更高,因此在軍事和民用領(lǐng)域的應(yīng)用越來越廣泛,例如監(jiān)控、偵察、在惡劣環(huán)境下的探索和救援任務(wù)等[1]。然而其固有的非線性、欠驅(qū)動、強耦合性以及系統(tǒng)參數(shù)未知等特性,使得四旋翼無人機系統(tǒng)的控制器設(shè)計仍然是一項具有挑戰(zhàn)性的任務(wù)[2-3]。

目前,在系統(tǒng)模型參數(shù)存在不確定性的前提下,為了實現(xiàn)四旋翼無人機軌跡跟蹤的目標,已提出了多種控制器設(shè)計方案。文獻[4]設(shè)計了模糊自適應(yīng)控制器,有效地補償了系統(tǒng)未建模參數(shù)的攝動和外界干擾。王焱等[5]采用魯棒滑?？刂品椒?實現(xiàn)了對期望值的有效跟蹤。甄紅濤等[6]設(shè)計了一種魯棒自適應(yīng)反步控制器,抵消了不確定性對系統(tǒng)的影響,但采用歐拉角描述姿態(tài)會產(chǎn)生奇點,跟蹤效果不佳。文獻[7-9]在Lyapunov理論的基礎(chǔ)上,采用自適應(yīng)控制的方法,將位置子系統(tǒng)的跟蹤誤差收斂到0,保證了四旋翼無人機控制性能趨近于系統(tǒng)參數(shù)未改變時的控制性能。陳向堅等[10]提出了基于區(qū)間二型模糊神經(jīng)網(wǎng)絡(luò)的自適應(yīng)控制器,通過在線逼近系統(tǒng)不確定性,證明了系統(tǒng)的閉環(huán)穩(wěn)定性。

本文首先采用單位四元數(shù)法對姿態(tài)加以描述,同時考慮四旋翼無人機的欠驅(qū)動特性,將整個系統(tǒng)分解為位置和姿態(tài)兩個子系統(tǒng)[11]。通過位置子系統(tǒng)中虛擬控制力的設(shè)計,可以得到實際輸入升力和理想四元數(shù),實現(xiàn)了位置子系統(tǒng)的指令跟蹤。另外,針對四旋翼無人機的參數(shù)存在不確定性問題,采用自適應(yīng)控制方法設(shè)計自適應(yīng)律進行補償,保證四旋翼無人機的軌跡跟蹤。

1 系統(tǒng)數(shù)學(xué)模型

四旋翼無人機是由固定在一個十字框架結(jié)構(gòu)上的兩對互相旋轉(zhuǎn)的螺旋槳組成,這種結(jié)構(gòu)使得四旋翼無人機具有垂直起降、空中懸停和朝任意方向飛行等優(yōu)點[12]。定義Obxbybzb為四旋翼無人機的本體坐標系;選取北、東、下坐標系作為無人機的慣性坐標系,表示為Ogxgygzg。圖1為四旋翼無人機的模型結(jié)構(gòu)圖。

圖1 四旋翼無人機模型結(jié)構(gòu)圖Fig.1 Structure of quadrotor UAV model

本文采用單位四元數(shù)描述四旋翼無人機的姿態(tài)信息。單位四元數(shù)定義為Q=[q,η]T=[q1,q2,q3,η]T,可以表示無人機在三維坐標系下的任何旋轉(zhuǎn)。不同于描述姿態(tài)的其他方法,單位四元數(shù)法只需要在本體坐標系和慣性坐標系下進行四旋翼無人機的旋轉(zhuǎn)估計,而且還避免了“萬相鎖”現(xiàn)象的產(chǎn)生[13]。由單位四元數(shù)表示的從慣性坐標系到本體坐標系的旋轉(zhuǎn)矩陣為:

根據(jù)歐拉-拉格朗日進行建模,將四旋翼無人機的運動方程簡化為:

(1)

2 虛擬控制力設(shè)計

將式(1)四旋翼無人機位置子系統(tǒng)模型表達式展開,得到其動力學(xué)方程為:

(2)

由式(2)可知,位置子系統(tǒng)有x(t),y(t),z(t)三個狀態(tài),控制輸入為升力T,可判斷出位置子系統(tǒng)為欠驅(qū)動系統(tǒng)。由此本文引入了虛擬控制力F=[F1,F2,F3]Τ,使F1,F2,F3分別跟蹤x,y,z三個自由度的位置信息。

首先將位置子系統(tǒng)改寫為:

(3)

其中:

(4)

式(4)等價為如下方程組:

(5)

3 四旋翼無人機系統(tǒng)控制器設(shè)計

四旋翼無人機系統(tǒng)控制器結(jié)構(gòu)如圖2所示。首先引入并設(shè)計虛擬控制力,使位置子系統(tǒng)控制器跟蹤參考位置信息,同時解算出輸入升力T和目標姿態(tài)Qd。再通過設(shè)計控制力矩MΣ,實現(xiàn)對目標姿態(tài)Qd的跟蹤,從而實現(xiàn)對參考指令信號的跟蹤。

圖2 四旋翼無人機系統(tǒng)控制器結(jié)構(gòu)圖Fig.2 Structure of quadrotor UAV system controller

3.1 位置子系統(tǒng)控制器設(shè)計

假設(shè)質(zhì)量m未知,通過設(shè)計自適應(yīng)滑?？刂破鞯玫紽的控制律,解算出目標姿態(tài)Qd和輸入升力T,保證閉環(huán)系統(tǒng)的穩(wěn)定性。

令不確定參數(shù)f=m,則式(3)改寫為:

其中:

假設(shè)不確定參數(shù)f是有界的,且f∈R{f:0

(6)

設(shè)計虛擬輸入力的控制律為:

(7)

質(zhì)量m的自適應(yīng)律設(shè)計為:

(8)

3.2 姿態(tài)子系統(tǒng)控制器設(shè)計

由于m未知造成轉(zhuǎn)動慣量I不確定,因此在姿態(tài)子系統(tǒng)控制器設(shè)計中,也采用自適應(yīng)滑?？刂品椒?。姿態(tài)子系統(tǒng)模型描述為:

定義誤差向量為:

(9)

其中:

式中:Ωd為飛行器的目標角速度。

推導(dǎo)出角速度誤差模型為:

(10)

令不確定參數(shù)y=I=diag(y1,y2,y3),則式(10)改寫為:

(11)

假設(shè)不確定參數(shù)y是有界的,其范圍如下:

輸入力矩的控制律設(shè)計如下:

(12)

令A(yù)=[1,1,1]T,慣量矩陣I的自適應(yīng)律設(shè)計為:

(13)

其中:

4 系統(tǒng)穩(wěn)定性證明

定理:考慮基于歐拉-拉格朗日方法下的系統(tǒng)模型(1),在虛擬控制輸入F和控制輸入力矩MΣ作用下,整個四旋翼無人機系統(tǒng)穩(wěn)定。

證明:考慮如下Lyapunov函數(shù):

對其沿系統(tǒng)軌跡求導(dǎo)得:

(14)

5 仿真驗證

考慮式(1)給出的四旋翼無人機模型,取質(zhì)量m=3 kg,重力加速度為9.8 m/s2。其中,系統(tǒng)控制器所需的參數(shù)系數(shù)和控制增益分別為:c=0.2,γ=2,ks=10,α=4,kβ=10,kq=15,kΩ=15。

假設(shè)四旋翼無人機的初始狀態(tài)為:P(0)=[1,3,2]Τm,v(0)=[0,0,0]Τm/s,I(0)=diag(0.039,0.039,0.039) kg·m2,Q=[0,0,0,1]T,Ω(0)=[0,0,0]T。

目標軌跡為:

圖4 質(zhì)量跟蹤仿真結(jié)果Fig.4 Simulation results of mass tracking

圖5 轉(zhuǎn)動慣量估計值Fig.5 The estimate values of inertia moment

6 結(jié)束語

本文在系統(tǒng)參數(shù)質(zhì)量和轉(zhuǎn)動慣量未知的情況下,對四旋翼無人機的軌跡跟蹤問題進行了研究。采用單位四元數(shù)法對系統(tǒng)姿態(tài)進行描述,針對欠驅(qū)動特性以及參數(shù)的不確定性,采用自適應(yīng)滑模方法設(shè)計虛擬控制律;所提控制方案可以不依賴于模型的精確參數(shù),使四旋翼無人機能夠準確跟蹤目標。

[1] Islam S,Dias J,Seneviratne L D.Adaptive tracking control for quadrotor unmanned flying vehicle[C]//IEEE/asme International Conference on Advanced Intelligent Mechatronics.Besan?on:IEEE,2014:441-445.

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

[3] 王璐,李光春,王兆龍,等.欠驅(qū)動四旋翼無人飛行器的滑模控制[J].哈爾濱工程大學(xué)學(xué)報,2012,33(10):1248-1253.

[4] Pedro J O,Mathe C.Nonlinear direct adaptive control of quadrotor UAV using fuzzy logic technique[C]//Control Conference (ASCC),2015 10th Asian.Sabah,Malaysia:IEEE,2015.

[5] 王焱,宋召青,劉曉,等.一種自適應(yīng)滑?？刂扑惴ㄔ谒男頍o人飛行器中的應(yīng)用[J].海軍航空工程學(xué)院學(xué)報,2013,28(5):471-474.

[6] 甄紅濤,齊曉慧,夏明旗,等.四旋翼無人機魯棒自適應(yīng)姿態(tài)控制[J].控制工程,2013,20(5):915-919.

[7] Nicol C,Macnab C J B,Ramirez-Serrano A. Robust adaptive control of a quadrotor helicopter[J].Mechatronics,2011,21(6):927-938.

[8] 李瑞琪,王洪福,李瑞雪,等.基于模型參考自適應(yīng)的四旋翼飛行器控制[J].計算機測量與控制,2013,21(12):3260-3263.

[9] Alessandretti A,Aguiar A P,Jones C N.Trajectory-tracking and path-following controllers for constrained underactuated vehicles using model predictive control[C]//2013 European Control Conference (ECC).Linz,Austria:IEEE,2013:1371-1376.

[10] 陳向堅,李迪,續(xù)志軍,等.四旋翼微型飛行器的區(qū)間二型模糊神經(jīng)網(wǎng)絡(luò)自適應(yīng)控制[J].光學(xué)精密工程,2012,20(6):1334-1341.

[11] 楊慶華,宋召青,時磊.四旋翼飛行器建模、控制與仿真[J].海軍航空工程學(xué)院學(xué)報,2009,24(5):499-502.

[12] Schreier M.Modeling and adaptive control of a quadrotor[C]//IEEE International Conference on Mechatronics and Automation.Chengdu China:IEEE,2012:383-390.

[13] 丁少賓,肖長詩, 劉金根,等.X型四旋翼無人機建模及四元數(shù)控制[J].系統(tǒng)仿真學(xué)報,2015,27(12):3057-3062.

[14] 喬繼紅,戴亞平,劉金琨.基于非線性干擾觀測器的直升機滑模反演控制[J].北京理工大學(xué)學(xué)報,2009,29(3):224-228.

[15] Khalil H K.Nonlinear systems third edition[M].Upper Saddle River,NJ:Prentice-Hall,Inc.,2002.

(編輯：李怡)

Adaptive tracking control of quadrotor UAV based on sliding-mode control

LIU Kai-yue1, LENG Jian-wei2

(1.College of Automation, Tianjin University of Technology, Tianjin 300384, China;2.Key Laboratory of Complex Systems Control Theory and Application, Tianjin 300384, China)

An adaptive control method was proposed based on sliding mode control for the trajectory-tracking problem of quadrotor UAV in the presence of model parameter uncertainties. Firstly, the attitude was described using unit quaternion and the system was decomposed into position subsystem and attitude subsystem. Considering the under-actuated characteristics of position subsystem, the virtual control force was introduced to track the position information and calculate the actual thrust and the desired attitude. Secondly, an adaptive sliding-mode controller was designed to compensate the mass uncertainty and moment of inertia uncertainty to guarantee the tracking of trajectory. Finally, the stability of the closed-loop system was proved based on Lyapunov theory. Simulation results show the effectiveness of algorithm.

quadrotor UAV; unit quaternion; virtual control force; adaptive sliding-mode control

2016-05-11;

2016-09-06;

時間:2016-11-10 09:10

劉凱悅(1991-)，女，山東高唐人，碩士研究生，研究方向為控制科學(xué)與工程。

V249.1; V279

A

1002-0853(2017)01-0043-05