飛艇森林巡防軌跡跟蹤的滑模控制

宋文龍，張金陽，賈鶴鳴

(東北林業(yè)大學機電工程學院，哈爾濱150040)

飛艇森林巡防軌跡跟蹤的滑?？刂?/p>

宋文龍，張金陽，賈鶴鳴

(東北林業(yè)大學機電工程學院，哈爾濱150040)

為實現(xiàn)無人飛艇在森林巡防時的軌跡跟蹤控制，針對飛艇飛行運動的非線性、耦合等特點，提出一種滑模控制方法?；谂ｎD第二定律等定理推導飛艇巡防飛行的精確數(shù)學模型，并通過選取狀態(tài)向量和控制向量，將其數(shù)學模型描述為非線性控制系統(tǒng)。通過泰勒級數(shù)展開將非線性系統(tǒng)簡化為線性系統(tǒng)，并設計滑?？刂坡?，同時采用飽和函數(shù)的方法抑制了滑?？刂浦械亩墩駟栴}。基于Lyapunov穩(wěn)定性理論證明了所設計控制系統(tǒng)的穩(wěn)定性。仿真結果表明，該方法的軌跡跟蹤效果較為理想，可實現(xiàn)無人飛艇對期望軌跡的精確跟蹤。

森林巡防;無人飛艇;軌跡跟蹤;滑?？刂?/p>

0 引言

在資源日益緊張的現(xiàn)代社會，資源越來越得到人們的重視，而森林資源更是首當其沖。同時對森林資源的保護工作也變得日益重要和嚴峻［1-3］。全國第7次森林資源審計結果顯示，我國森林總面積達到19 545.22萬公頃。我國森林面積巨大，對森林資源的巡防工作變成一項巨大挑戰(zhàn)，單純地僅僅依靠人力很難進行有效的巡防工作。通過人力進行巡防還容易受地形、氣候等客觀因素影響，給森林巡防工作帶來很大困難。針對上述問題，筆者提出采用飛艇代替人力進行森林的巡防工作，并提出采用滑?？刂品椒刂骑w艇進行森林巡防軌跡跟蹤。

飛艇是一種外形類似于雪茄或橢圓形的飛行器。艇囊中充滿輕于空氣的浮升氣體，主要成分是氦氣，為其提供浮升力［4，5］。飛機、直升機主要依靠動力裝置的能量在飛行器上發(fā)生空氣動力飛行，而飛艇主要是依靠空氣的浮力。正是因為這一特點，使飛艇能長時間在空中懸停，而只需要消耗非常少的燃料即低能耗，適合長時間的定點工作。與傳統(tǒng)飛行器如飛機相比，飛艇重量輕，經(jīng)濟性能好，穩(wěn)定性較高;與衛(wèi)星相比，飛艇的機動性能高，對部分區(qū)域的監(jiān)察效果更佳，受天氣影響小。同時，飛艇還具有低噪聲等特點。基于以上優(yōu)點，在軍用和民用方面，飛艇都具有非常高的研究價值。

對于飛艇的軌跡跟蹤控制有很多種方法，主要以傳統(tǒng)的PID(Proportional Integral and Differential)控制為主。Paiva等［6］采用傳統(tǒng)控制方法設計過飛艇的姿態(tài)控制器，基本達到了控制要求。但這種方法在模型參數(shù)發(fā)生改變，出現(xiàn)干擾時，控制效果難以保證，有待改進，而且對于軌跡跟蹤控制并沒有研究。歐陽晉等［7］也設計過飛艇的控制系統(tǒng)，通過采用線性矩陣不等式等方法，提高系統(tǒng)的魯棒性，但還是依賴于系統(tǒng)的精確數(shù)學模型。針對以上問題，筆者提出滑模控制方法解決飛艇軌跡跟蹤的控制問題。通過切換超平面的設計使系統(tǒng)沿著切換超平面滑動，最后到達原點，系統(tǒng)特性僅與所設計的切換超平面有關，所以具有很好的魯棒性。

1 飛艇運動數(shù)學模型

1.1 坐標系及運動參數(shù)定義

一般采用體坐標系和地面坐標系(也叫慣性坐標系)描述飛艇的運動情況。1)飛艇在空間的位置通常需要由地面坐標系進行描述。一般地選取飛艇的起飛點作為地面坐標系的原點Oε。OεXε軸通常和飛艇的飛行航向相一致。OεYε軸在地平面內(nèi)垂直于OεXε軸;OεZε軸與地平面相垂直，方向指向地心。2)艇體坐標系主要描述飛艇的運動速度。把飛艇的體積中心Cv選為艇體坐標系的原點，軸XB指向飛艇前端，在飛艇艇體的對稱平面上;法向軸ZB垂直于縱軸XB和橫向軸YB組成的平面，并指向下方;橫向軸垂直于縱軸XB和法向軸ZB組成的平面。整個飛艇整體上可以近似看作對稱的，飛艇的重心在飛艇的體積中心Cv的下方。其示意圖如圖1所示。

圖1 地面坐標系和艇體坐標系示意圖Fig.1 Schematic diagram of ground coordinate system and hull coordinate system

從地面坐標系到體坐標系的轉換矩陣是在歐拉角旋轉順序基礎上建立的，矩陣元素

其中c和s分別表示余弦和正弦;φ，θ和ψ分別表示飛艇的滾轉、俯仰、偏航角。

一般位置向量η1和姿態(tài)向量η2均在飛艇的慣性坐標系中加以定義，其分別為η1=(x y z)T，η2=(φ θ ψ)T。其中x、y、z表示飛艇在空間中的位置。

一般線速度向量V和角速率向量Ω均在飛艇的體坐標系中加以定義，其分別為:V=(u v w)T，Ω =(p q r)T。其中 u、v、w 分別表示飛艇在 OBXB、OBYB、OBZB方向的線速度;p、q、r分別表示飛艇沿3個坐標軸的滾轉角速率、俯仰角速率和偏航角速率。重心在艇身坐標系中的位置為Cg=(xGyGzG)。

定義 Ix、Iy、Iz分別是繞 OBXB、OBYB、OBZB軸的轉動慣量，Ixy、Iyz、Ixz分別為繞 XBOBYB、YBOBZB、XBOBZB平面的轉動慣量。

1.2 飛艇軌跡跟蹤運動數(shù)學模型

飛艇在運動的過程中會受到外力的作用，一般可將力分為三大類:空氣靜力(包含重力和浮力)、空氣動力(包含氣動壓力和流體慣性力)和控制動力［7-11］。

分別將這些力以及由他們所產(chǎn)生的力矩分別帶入牛頓第二定律和動量矩定理，并沿3個坐標軸方向分解，可以得到飛艇的動力學模型如下(飛艇在巡防軌跡跟蹤運動中不考慮橫滾運動，即p=0，φ=0)

其中 m 為飛艇的質量，mij(i=1，2，…，6;j=1，2，…，6)為飛艇所受流體慣性力中的附加質量，τs，τr分別為飛艇的俯仰、偏航力矩。

出于控制需要以及全面描述飛艇運動的需要，還需建立飛艇的運動方程

1.3 線性化數(shù)學模型

為了簡化方便，這里假設飛艇巡航軌跡跟蹤運動［12-16］是一種基準運動，即無傾斜、無側滑且迎角為零的等速直線運動，則飛艇的運動狀態(tài)可以簡化成以下形式

由此可知，在基準運動即等速直線運動中，除了U0外，其他值都為零。再將飛艇所受的各種力和力矩的運動參數(shù)按照小擾動定理進行簡化，就可以得到簡化后的線性運動方程。這里以X軸上的力為例進一步說明

其中α，β為迎角和側滑角。

由于基準運動是等速直線平飛，則力和力矩分量有如下關系

同時，因為α、β較小，可作如下近似:α=arctg(w/u)≈w/u，β=arctg(v/u)≈v/u，θ≈0。另外由于xG=0、yG=0，為簡化方程，增量均省略了記號Δ。

同理，其他軸向上的力也可以進行簡化，最后經(jīng)過簡化就可得出飛艇巡航飛行運動線性化后的運動方程，將方程用類似于狀態(tài)方程的形式表示

定義狀態(tài)量 x=［u，v，w，q，r，θ，ψ］T，輸入量 u=［F，δr，δs］T，M 為質量慣性矩陣，A、B 為常系數(shù)矩陣

其中Q=0.5ρV2稱為動壓，ρ為飛艇所處位置空氣密度，V為飛行速度，▽為飛艇容積，L為飛艇長度，Ci0(i=x，y，z，l，m，n)為飛艇的氣動系數(shù)，為氣動導數(shù)，F(xiàn)為推力，δs，δr為俯仰、偏航舵角。

可見，該線性系統(tǒng)是輸入輸出解耦的，如果給定原系統(tǒng)的期望輸出軌跡，則可對系統(tǒng)進行輸出跟蹤控制律設計。

2 滑模控制器設計

2.1 滑?？刂圃?/h3>

滑?？刂朴址Q為滑模變結構控制［17-19］?；？刂圃硎鞘紫榷x一個切換超平面，然后使系統(tǒng)軌線向切換超平面靠近，當?shù)竭_超平面附近時，控制作用使其在超平面附近滑動并最終到達超平面，之后控制作用將保證其軌線穩(wěn)定在切換超平面，并沿著超平面運動直到系統(tǒng)原點即期望狀態(tài)，控制結束。

2.2 滑?？刂破髟O計步驟

設計滑?？刂破饕话阒饕譃閮蓚€步驟。

步驟1 設計切換函數(shù)，即切換面s(x)的確定。切換面的確定非常重要，確定切換面是滑?？刂谱饔么嬖诘谋匾獥l件。切換函數(shù)即滑模面的設計有許多方法，如極點配置法，Lyapunov方程法等，經(jīng)過理論研究的發(fā)展，現(xiàn)今已經(jīng)比較成熟。

步驟2 設計控制律?？刂坡傻脑O計是設計滑?？刂破鞅夭豢缮俚牟襟E，控制律的選擇是否合適，直接關系到滑?？刂频目刂菩Ч涂刂破焚|。通過所設計的控制律保證從任何點出發(fā)的系統(tǒng)狀態(tài)軌線均可達到切換面。

2.3 飛艇滑?？刂破髟O計

通過上面的分析，以飛艇在水平面的軌跡跟蹤運動為研究對象，設計滑?？刂破?。線性化的飛艇水平運動線性模型為

選取切換函數(shù)s=Cx，C為正常數(shù)，則

采用指數(shù)趨近律

最后，得到最終控制量為

2.4 穩(wěn)定性分析

選取Lyapunov函數(shù)

對式(9)微分，可得

雖然滑?？刂瓶梢院芎玫貪M足控制要求，但在實際應用中，滑?？刂七€存在抖振問題，使執(zhí)行機構會出現(xiàn)高頻振蕩，極大地損害了執(zhí)行機構。故在本文中選擇設計飽和函數(shù)代替式(11)中的符號函數(shù)sgn()，以抑制控制器的抖振問題，選擇的飽和函數(shù)

其中σ表示邊界層寬度。通過如上設計后給定任意的初始值設計的滑模面函數(shù)都可到達并保持在邊界層內(nèi)。

3 仿真結果及分析

在仿真階段，分別采用傳統(tǒng)的PID控制和滑模變結構控制進行了仿真對比研究。飛艇的狀態(tài)為在高空做水平運動，PID參數(shù)采用Z-N整定法，所選擇的控制增益分別為kp=20，ki=2，kd=5。指數(shù)趨近律中的滑?？刂破鲄?shù)為k=28，邊界層厚度σ=0.5，軌跡跟蹤曲線及其他狀態(tài)變化曲線如圖2～圖8所示。

圖2 飛艇軌跡跟蹤仿真圖Fig.2 Airship tracking simulation diagram

圖3 速度變化曲線Fig.3 Speed changes curve

圖4 角速率變化曲線Fig.4 Angular rate change curve

圖6 誤差跟蹤軌跡曲線Fig.6 Error tracking trajectory curve

圖7 跟蹤軌跡平面俯視圖Fig.7 Tracking trajectory plane top view

圖8 控制量變化曲線Fig.8 Control amount change curve

由仿真曲線可以看出，這兩種方法基本都可以實現(xiàn)飛艇軌跡跟蹤控制。但與傳統(tǒng)PID控制方法相比，滑?？刂颇芨玫匾种聘蓴_，控制更為平滑，超調量較小，具有更好的控制性能。

4 結 語

筆者對飛艇進行受力分析，并通過牛頓定律和相關物理定理建立了飛艇飛行的數(shù)學模型，應用滑模理論確定切換函數(shù)和設計滑模控制律，進而對飛艇森林巡防飛行時軌跡跟蹤控制問題進行研究。通過仿真實驗驗證，該控制器能較好地驅動飛艇精確跟蹤期望軌跡。

［1］孫鵬.一種輪履復合式森林巡防機器人平臺的研究［D］.哈爾濱:東北林業(yè)大學機電工程學院，2010.SUN Peng.Research on a Wheel-Tracked Robot Platform for Forestry Patrol［D］.Harbin:College of Mechanical and Electrical Engineering，Northeast Forestry University，2010.

［2］霍庚，杜軍波，丁宏升，等.光線SINS/GPS組合導航系統(tǒng)分析［J］.吉林大學學報:信息科學版，2012，30(2):144-150.HUO Geng，DU Junbo，DING Hongsheng，et al.Analysis and Study of Optical SINS/GPS Integrated Navigation System［J］.Journal of Jilin University:Information Science Edition，2012，30(2):144-150.

［3］賈鶴鳴，宋文龍，牟宏偉，等.ISR-CDKF在SINS大方位失準角初始對準中的應用［J］.吉林大學學報:信息科學版，2013，31(2):196-202.JIA Heming，SONG Wenlong，MOU Hongwei，et al.Application of ISR-CDKF in Initial Alignment of Large Azimuth Misalignment in the SINS［J］.Journal of Jilin University:Information Science Edition，2013，31(2):196-202.

［4］基里林.現(xiàn)代飛艇設計導論［M］.吳飛，王培美，譯.北京:國防工業(yè)出版社，2009:2-30.KIRILIN.Introduction to Modern Airship Design［M］.Beijing:National Defense Industry Press，2009:2-30.

［5］甘曉華，郭穎.飛艇技術概論［M］.北京:國防工業(yè)出版社，2005:76-84.GAN Xiaohua，GUO Ying.Airship Technology Introduction［M］.Beijing:National Defense Industry Press，2005:76-84.

［6］PAIVA E C，BUENO S S.Sliding Mode Control Approaches for an Autonomous Unmanned Airship［C］//The 18th AIAA Lighter-Than-Air Systems Technology Conference.Washington，USA:AIAA Press，2009:327-335.

［7］歐陽晉，屈衛(wèi)東，席裕庚.平流層驗證飛艇的建模與分析［J］.上海交通大學學報，2003，37(6):956-960.OUYANG Jin，QU Weidong，XI Yugeng.The Stratosphere Airship Modeling and Analysis［J］.Journal of Shanghai Jiaotong University，2003，37(6):956-960.

［8］王彥廣，李健全，李勇，等.近空間飛行器的特點及其應用前景［J］.航天器工程，2007，16(1):50-57.WANG Yanguang，LI Jianquan，LI Yong，et al.The Characteristics and Prospects of Near Space Vehicle ［J］.Spacecraft Engineering，2007，16(1):50-57.

［9］譚惠豐，王超，王長國.實現(xiàn)結構輕量化的新型平流層飛艇研究進展［J］.航空學報，2010(2):258-264.TAN Huifeng，WANG Chao，WANG Changguo.Implementation Structure of the New Lightweight Stratospheric Airship Research［J］.Journal of Aviation，2010(2):258-264.

［10］趙攀峰，李大鵬，譚百賀，等.平流層飛艇熱力學建模與仿真研究［J］.合肥工業(yè)大學學報:自然科學版，2013(4):502-505.ZHAO Panfeng，LI Dapeng，TAN Baihe，et al.Stratospheric Airship Modeling and Simulation of Thermodynamics ［J］.Journal of Hefei Technology University:National Science Edition，2013(4):502-505.

［11］任一鵬，田中偉，吳子牛.飛艇空氣動力學及其相關問題［J］.航空學報，2010(3):431-443.REN Yipeng，TIAN Zhongwei，WU Ziniu.Airship Aerodynamics and Related Issues［J］.Journal of Aviation，2010(3):431-443.

［12］楊躍能，鄭偉，吳杰.臨近空間對地觀測平臺的矢量化建模及穩(wěn)定性分析［J］.國防科技大學學報，2011，33(3):28-32.YANG Yueneng，ZHENG Wei，WU Jie.Vector Modeling and Stability Analysis of Earth Observation Platform near Space［J］.Journal of the National University of Defense Technology，2011，33(3):28-32.

［13］凡永華，岳小飛，于云峰.高空飛艇飛行控制系統(tǒng)的線性模型跟隨設計［J］.計算機仿真，2012，29(1):49-52.FAN Yonghua，YUE Xiaofei，YU Yunfeng.High-Altitude Airship Flight Control System Design Linear Model to Follow［J］.Computer Simulation，2012，29(1):49-52.

［14］彭志.基于趨近律方法的平流層飛艇姿態(tài)控制研究［D］.湘潭:湖南科技大學信息與電氣工程學院，2012.PENG Zhi.Study on Stratospheric Airship Attitude Control Based on Reaching Law Approach［D］.Xiangtan:College of Information and Electrical Engineering，Hunan University of Science and Technology，2012.

［15］柯藝杰，周江華，崔燕香.平流層飛艇俯仰附加轉動慣量的估算與辨識［J］.飛行力學，2013，31(2):176-179.KE Yijie，ZHOU Jianghua，CUI Yanxiang.Stratospheric Airship Additional Pitching Moment of Inertia Estimation and Identification［J］.Flight Mechanics，2013，31(2):176-179.

［16］LIONEL L，BRUNO J.Robust Nonlinear Path-Following Control of an AUV ［J］.IEEE Journal of Oceanic Engineering，2008，33(2):89-102.

［17］MOHAMED E F，EI-METWALLY K，HANAFY A R.An Improved Tangent Bug Method Integrated with Artificial Potential Field for Multi-Robot Path Planning［C］//Innovations in Intelligent Systems and Applications(INISTA)，2011 International Symposium on.Istanbul:IEEE，2011:555-559.

［18］蔡國梁，周維懷，鄭松，等.不確定離散系統(tǒng)全程滑模變結構控制［J］.江蘇大學學報:自然科學版，2010，31(3):364-368.CAI Guoliang，ZHOU Weihuai，ZHENG Song，et al.Uncertain Discrete Systems Global Sliding Mode Variable Structure Control［J］.Journal of Jiangsu University:National Science Edition，2010，31(3):364-368.

［19］胡田文，吳慶憲，姜長生，等.指數(shù)趨近律單向輔助面滑?？刂疲跩］.電光與控制，2013(7):37-41.HU Tianwen， WU Qingxian，JIANG Changsheng， et al. Exponential Approach Law for Sliding Mode Control with Unidirectional Auxiliary Surfaces［J］.Optics and Control，2013(7):37-41.

(責任編輯:劉東亮)

Sliding Mode Control of Airship Trajectory Tracking on Forest Patrol

SONG Wenlong，ZHANG Jinyang，JIA Heming
(College of Mechanical and Electrical Engineering，Northeast Forestry University，Harbin 150040，China)

To achieve unmanned airship trajectory tracking control when patrol in the forest and the airship flight movement is nonlinear，coupling，etc.，a sliding mode control method is proposed.First，the accurate mathematical model of airship is deduced based on Newton's second law and other theorem，and by selecting the state vector and control vector，its mathematical model can be described as the nonlinear control systems.Nolinear system is simplified to linear system by Taylor series expansion，and the sliding mode control law is designed，while using saturation function suppressed chattering problem of sliding mode control.Finally，the designed control system stability is proved by Lyapunov stability theory.As can be seen from the simulation curves，the effect of trajectory tracking is more ideal，it can achieve the unmanned airship desired trajectory for accurate tracking.

forest patrol;unmanned airship;trajectory tracking;sliding mode control

TP273

A

1671-5896(2014)02-0158-08

2013-09-03

中央高?；究蒲袠I(yè)務費專項基金資助項目(DL13BB14);國家自然科學基金資助項目(31270757);新世紀優(yōu)秀人才支持計劃基金資助項目(NCET-09-0279);高等學校博士學科點基金資助項目(20110062110002)

宋文龍(1973— )，男，吉林四平人，東北林業(yè)大學教授，博士生導師，主要從事林業(yè)智能檢測與控制研究，(Tel)86-13206666921(E-mail)wlsong139@126.com;通訊作者:賈鶴鳴(1983— )，男，哈爾濱人，東北林業(yè)大學副教授，博士，主要從事非線性系統(tǒng)控制理論與應用、智能控制與濾波技術研究，(Tel)86-13206666920(E-mail)jiaheminglucky99@126.com。