(1.西北工業大學無人機特種技術重點實驗室,陜西西安 710072) 2.西北工業大學無人機研究所,陜西西安 710072
?
飛翼布局無人機二階滑模姿態跟蹤魯棒控制
譚健1,周洲1,祝小平2,許曉平1
(1.西北工業大學無人機特種技術重點實驗室,陜西西安710072) 2.西北工業大學無人機研究所,陜西西安710072
摘要:針對飛翼布局無人機受擾姿態控制問題,提出一種二階滑模姿態跟蹤魯棒控制方案?;跁r標分離特性,將飛翼布局無人機姿態控制系統分為內外回路進行設計。外回路采用自適應二階終端滑??刂破?,利用自適應算法調節切換增益抑制復合干擾對系統性能的影響,同時二階終端滑模將不連續的符號函數加在控制量的導數上,通過積分得到連續的滑??刂坡桑瑥亩行У叵顺R幓?刂破鞯亩墩瘛然芈凡捎没谧赃m應super twisting滑模觀測器的積分滑??刂破?,設計自適應super twisting滑模觀測器以實現對內回路復合干擾的估計和補償。最后通過控制分配環節將控制力矩分配到舵面上,仿真結果驗證了所提方案的有效性。
關鍵詞:飛翼布局無人機;二階滑模;自適應;終端滑模; super twisting;觀測器;控制分配
飛翼布局無人機出于氣動效率及隱身特性的考慮,取消了平尾和垂尾等部件,具有縱向穩定性弱、航向中性穩定、橫航向運動耦合強等一些問題,需要采用具有良好魯棒性的非線性控制器以克服復合干擾的影響?;W兘Y構控制具有設計簡單、魯棒性強以及在滑模運動階段對干擾具有不變性等優點,近年來在航空器的控制系統設計中有諸多應用[1-2]。與自適應控制技術相結合,確定變結構控制切換增益無須知道無人機復合干擾的上界,自適應滑模變結構的切換增益值采用自適應算法獲得。盡管采用自適應算法,切換增益值有所減小,然而,不連續符號函數依然會引起系統的抖振,抖振現象的存在限制了自適應滑模變結構控制的應用。采用準滑動模態的控制方法,將控制律不連續的符號函數替換為連續的飽和函數的方法可以有效抑制抖振,但是在抑制抖振的同時,會犧牲系統的魯棒性[3]。近年來高階滑模[4-5]得到了許多學者的重視,不連續符號函數施加在控制律的一階或高階導數上,在積分的作用下,得到連續的滑??刂坡桑行У叵魅趿丝刂破鞯亩墩?。
為保證飛行控制的性能,采用干擾觀測器估計與補償干擾,也是抑制復合干擾影響的良好方法。文獻[6]對super twisting算法進行了改進,提出了自適應super twisting二階滑??刂扑惴ǎ瑢τ谖粗薪绲倪B續干擾,可保證受擾系統的狀態有限時間內收斂到滑模流形s==0上,基于此二階滑模算法設計的自適應super twisting二階滑模干擾觀測器,將符號函數隱藏在積分項里,得到連續的干擾補償值,避免了抖振造成控制系統的不穩定。
基于以上分析,本文提出一種二階滑模姿態跟蹤魯棒控制方案,外回路采用自適應二階終端滑??刂破鳎米赃m應算法調節切換增益抑制復合干擾對系統性能的影響,通過二階終端滑模將符號函數隱藏在積分項中得到連續的控制輸入。內回路采用基于自適應super twisting二階滑模干擾觀測器的積分滑??刂破?,利用二階滑模觀測器得到連續的干擾補償值抑制內回路復合干擾的影響??紤]到飛翼布局無人機的多舵面布局和存在舵效非線性、舵面附加力的問題,采用非線性控制分配,按照阻力最小的優化目標將控制力矩分配到舵面上。最后,仿真結果驗證了所提出的方法具有良好的控制性能。
飛翼布局無人機的舵面配置如圖1所示,為4 組8個舵面。從內到外分別布置了升降舵舵1、升降副翼舵2和舵3以及開裂式方向舵舵4。

圖1 飛翼布局無人機舵面配置
考慮到未建模動態與外界擾動,無人機的姿態模型為包含不確定項的非線性方程組:

式中,Ω=[α β μ]T分別為無人機的迎角、側滑角和滾轉角,ω=[p q r]T分別為滾轉角速率、俯仰角速率和偏航角速率,fs,ff為姿態模型精確建模部分,gs為與狀態變量相關的矩陣,gf為與慣量矩相關的矩陣,具體表達式參見文獻[7]。Mc為舵面產生的滾轉、俯仰和偏航控制力矩,與舵面偏角的關系式為

式中,δ,δmin,δmax都為8×1維向量,δ為無人機8個舵面的舵面偏角,δmin,δmax分別為舵面偏角位置約束的最小和最大值,G(δ)是與舵面偏角δ有關的非線性函數。Δs,Δf是未建模動態與外界干擾等產生的姿態模型復合干擾,有如下表達式

式中,Δfs,Δff,Δgs,Δgf為系統的未建模動態,ds,df為外界干擾。基于時間尺度將無人機姿態控制系統分為外回路和內回路分別設計,其中外回路為姿態角回路(1),內回路為姿態角速率回路(2)。
飛翼布局無人機姿態模型的外回路為一階系統,由高階滑模的特性可知,對外回路采用二階滑??刂疲瑢⒎柡瘮惦[藏在積分項中得到連續的控制輸入,可以有效的抑制控制律的抖振。同時,為了提高外回路控制精度,設計了如下的積分滑模面:

式中,Ωc為姿態跟蹤目標指令,es=Ω-Ωc,cs= diag(cs,1,cs,2,cs,3)為積分參數且各分量大于零,ρ= [ρ1ρ2ρ3]T。
設計如下的非奇異終端滑模用以實現姿態控制系統外回路的二階滑??刂?

式中,參數η= diag(η1,η2,η3)且各分量大于零,=[]T,p,q為奇數,且滿足1<p/q<2,滑模面Ss=[Ss,1Ss,2Ss,3]T。
定理1對于無人機姿態控制系統外回路
如果復合干擾Δs=[Δs,1Δs,2Δs,3]T連續可微且一階導數有界,即||<θi(i = 1,2,3)。采用控制律(8)式與自適應律(9)式所示的自適應二階終端滑??刂破鲿r,外回路閉環是漸近穩定的。


式中,λ= diag(λ1,λ2,λ3),ξ= diag(ξ1,ξ2,ξ3)且各分量大于0,

證明:取Lyapunov函數為



當滑模面Ss≠0,由文獻[8]可知,若= 0,ρi≠0,則系統處于不穩定狀態。p,q為奇數且滿足1<p/q<2,當≠0時,則存在>0。外回路復合干擾連續可微且一階導數有界,即有||<θi(i = 1,2,3),由(11)式可得

設在tr時間內系統收斂到滑模面Ss= 0,由終端滑模的性質可知,ρi將在tr時間后的有限時間內收斂到零,當ρi= 0,由積分滑模的性質可知,外回路穩態誤差es=Ω-Ωc將漸近收斂到零,外回路閉環是漸近穩定的,定理1得證。
3. 1自適應super twisting二階滑模干擾觀測器
考慮到飛翼布局無人機的內回路存在復合干擾,設計如下的自適應super twisting二階滑模干擾觀測器對復合干擾進行估計與補償。
定理2對于無人機姿態控制系統內回路,若復合干擾Δf=[Δf,1,Δf,2,Δf,3]T連續且有界,設計如下自適應super twisting二階滑模干擾觀測器:


為證明定理2,首先給出引理:
引理1若干擾Δ連續可微且有界,對于受擾自適應super twisting二階滑??刂扑惴ǎ?]

若參數φ1,φ2采用如下自適應律,則系統狀態有限時間收斂到σ(t) =(t) = 0。

證明:式(1)減去式(13)得


可知,在有限時間內,內回路復合干擾Δf可由(14)式的估計,由(14)式可以看出,自適應super twisting二階滑模觀測器將不連續符號函數sign隱藏積分項里,抑制了常規滑模觀測器的抖振現象。
3. 2滑模干擾觀測器補償復合干擾
積分滑模面可有效提高控制器的精度與魯棒性,為內回路設計如下的積分滑模面:

式中,ef=ω-ωc,cf= diag(cf,1,cf,2,cf,3)為積分項參數且各分量大于0,S =[S1,S2,S3]T。
定理3對于無人機姿態控制系統內回路,若復合干擾Δf=[Δf,1,Δf,2,Δf,3]T連續且有界,采用如(23)式所示基于自適應super twisting二階滑模觀測器的積分滑??刂破鲿r,內回路閉環是漸近穩定的。

式中,sgn(S) =[sgn(S1)sgn(S2)sgn(S3)]T,滑模控制器參數k = diag(k1,k2,k3)且各分量大于0,diag(| S|a) =diag(| S1|a,| S2|a,| S3|a),指數a∈(0,1)。
證明:選取Lyapunov函數為

自適應super twisting二階滑模干擾觀測器可在有限時間內實現Δf-^Δf= 0?;?刂坡梢呀泴崿F了內回路各通道間的解耦,對于內回路單個通道有

在有限時間內系統軌跡會到達每一個通道的滑模面Si= 0(i = 1,2,3),即S = 0,此后開始進行滑模運動,積分滑模面可保證內回路穩態誤差漸近收斂到零,定理3得證。
內回路控制律設計得到的是三軸方向上的舵面控制力矩。為充分利用冗余舵面與解決非線性舵效、舵面附加阻力等問題,采用非線性控制分配求解舵面偏角,控制分配以姿態控制時舵面附加阻力最小為優化目標。

式中,J為優化目標,CDδ為控制分配舵面附加的阻力系數,非線性控制分配采用非線性規劃方法進行求解。
4. 1仿真參數設定
飛翼布局無人機的初始狀態為V = 0. 6Ma,α0= 1. 8°,β0= 0°,μ0= 0°,p0= q0= r0= 0 rad/s。
外回路和內回路復合干擾分別為

姿態跟蹤目標指令為
αc= 5°,βc= 4°,μc= 3°
控制器參數為
p = 7q = 5η= diag(1,1,1)γ= 0. 5
cs= diag(0. 01,0. 01,0. 01)
λ= diag(0. 5,0. 5,0. 5)
ξ= diag(2,2,2)
cf= diag(0. 01,0. 01,0. 01)
k = diag(2,2,2),a = 0. 5
自適應super twisting二階滑模觀測器參數
ζ1(0) = 0,珘ε= 1,κ= 1,ε= 0. 5,= 1
為了說明本文所提方法的有效性,現對以下2種控制方案進行比較。
控制方案1:外回路采用自適應二階終端滑模控制器,內回路采用基于super twisting二階滑模干擾觀測器的積分滑??刂破?。
控制方案2:去除控制方案1外回路的自適應律和內回路的自適應super twisting二階滑模干擾觀測器,其他與控制方案1相同。
4. 2仿真結果對比與分析
圖2~圖4為2種控制方案下飛翼布局無人機迎角、側滑角和速度滾轉角響應曲線,在系統具有復合干擾的情況下,控制方案1很好跟蹤了控制指令,控制無超調,收斂速度快,穩態精度高,有效抑制了復合干擾的影響,魯棒性好??刂品桨?沒有跟蹤上控制指令,迎角、側滑角和速度滾轉角都圍繞著控制指令振蕩,動態特性很差。

圖2 迎角響應曲線

圖3 側滑角響應曲線

圖4 速度滾轉角響應曲線
滑模干擾觀測器用來實現對復合干擾的估計與補償,控制方案1對內回路各通道復合干擾的估計如圖5所示,觀測器的干擾估計曲線與復合干擾曲線基本重合,很快實現了對復合干擾的估計,因此從姿態控制的魯棒性、跟蹤精確、收斂速度,控制方案1都具有較好的效果。
控制方案1的舵面偏角如圖6所示。由于本文控制方案1外回路采用自適應二階終端滑??刂破?,通過二階終端滑模將符號函數隱藏在積分項中得到連續的控制輸入。內回路采用自適應super twisting二階滑模干擾觀測器得到連續的干擾補償值,同時采用具有二階滑模特性的冪次趨近律,抑制了姿態控制系統的抖振,因此,舵面偏角曲線平滑無抖振。從圖7可以看出,右開裂式阻力方向舵δr4和左開裂式阻力方向舵δl4始終單側偏轉,與非線性控制分配的優化目標附加阻力最小一致。

圖5 內回路各通道干擾與干擾估計

圖6 控制方案1舵面偏角
針對飛翼布局無人機受擾姿態控制問題,提出了二階滑模姿態跟蹤魯棒控制方案,分別利用自適應控制與自適應super twisting二階滑模干擾觀測器抑制外回路、內回路復合干擾的影響,由于二階滑模的采用,有效的減小了常規滑模控制器的抖振現象,本文所提方法更適于工程實踐應用,仿真結果也驗證了其有效性。
參考文獻:
[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(2) : 658-684
[2]Khatri A K,Singh J,Sinha N K.Aircraft Maneuver Design Using Bifurcation Analysis and Sliding Mode Control Techniques [J].Journal of Guidance,Control,and Dynamics,2012,35(5) : 1435-1449
[3]曾憲法,王潔瑤,王小虎,等.基于SMDO的滑模控制器設計及其在導彈上的應[J].航空學報,2011,32(5) : 873-880 Zeng Xianfa,Wang Jieyao,Wang Xiaohu,et al.Design of Sliding Mode Controller Based on SMDO and Its Application to Missile Control[J].Acta Aeronautica et Astronautica Sinica,2011,32(5) : 873-880 (in Chinese)
[4]Levant A.Homogeneity Approach to High-Order Sliding Mode Design[J].Automatica,2005,41(5) : 823-830
[5]Shtessel Y B,Shkolnikov I A,Levant A.Smooth Second-Order Sliding Modes: Missile Guidance Application[J].Automatica,2007,43(8) : 1470-1476
[6]Yuri B S,Jaime A M,Franck Plestan,et al.Super-Twisting Adaptive Sliding Mode Control: a Lyapunov Design[C]∥49th IEEE Conference on Decision and Control,Atlanta,GA,USA,2010: 15-17
[7]張強,吳慶憲,姜長生,等.考慮執行器動態和輸入受限的近空間飛行器魯棒可重構跟蹤控制[J].控制理論與應用,2012,29(10) : 1263-1271 Zhang Qiang,Wu Qingxian,Jiang Changsheng,et al.Robust Reconfigurable Tracking Control of Near Space Vehicle with Actuator Dynamic and Input Constraints[J].Control Theory&Application,2012,29(10) : 1263-1271 (in Chinese)
[8]Feng Y,Yu X Y,Man Z H.Non-Singular Adaptive Termi-nal Sliding Mode Control of Rigid Manipulators.Automatica,2002,38(12) : 2159-2167
Second Order Sliding Mode Attitude Tracking and Robust Control of Flying-Wing UAV
Tan Jian1,Zhou Zhou1,Zhu Xiaoping2,Xu Xiaoping1
(1.State Key Laboratory of UAV Special Technology at Northwestern Polytechnical University,Xi'an 710072 China 2.Research institute of unmanned Aerial Vehicle,Northwestern polytechnical University,Xi'an 710072,China)
Abstract:We propose a second order sliding mode attitude tracking and robust control strategy for the flying-wing unmanned aerial vehicle(UAV) with unknown external interferences.We take into account its timescale separation property and design its attitude control system into outer loop and inner loop.The outer loop uses the adaptive second order sliding mode controller and the adaptive algorithm to adjust the switch gains and suppress the influence of compound interference on the performance of the flying-wing UAV.The second order sliding mode controller adds the discontinuous sign function to the derivative of the control volume and obtains through integration the continuous sliding mode law,thus effectively eliminating the chattering of the conventional sliding mode controller.The inner loop uses the integral sliding mode controller based on the adaptive super twisting sliding mode observer.The adaptive super twisting sliding mode observer is for estimating and compensating for the compound interference of the inner loop.Finally,we use control allocation to allocate control moment to the rudder surface of the control system.The simulation results show preliminarily that our strategy is effective.
Key words:adaptive algorithms,angle of attack,angular velocity,attitude control,computer software,computer simulation,control,controllers,convergence of numerical methods,design,drag coefficient,flight control systems,Lyapunov functions,matrix algebra,robust control,sliding mode control,unmanned aerial vehicles(UAV) ; flying-wing UAV,second order sliding mode,super twisting,observer,power approximation,control allocation
作者簡介:譚健(1989—),西北工業大學博士研究生,主要從事無人機飛行控制研究。
收稿日期:2014-09-28基金項目:國家自然科學基金(11302178)資助
文章編號:1000-2758(2015) 02-0185-06
文獻標志碼:A
中圖分類號:TP273