文档下载 文档下载导航
设为首页 | 加入收藏
搜索 请输入内容:  
 导航当前位置: 文档下载 > 所有分类 > Design and implementation of an autonomous flight control law for a UAV
侵权投诉

Design and implementation of an autonomous flight control law for a UAV

无人直升机

2334K.Pengetal./Automatica45(2009)2333–2338

flightcontrollawcanbedesignedinadecentralizedfashion.Anewlydevelopednonlinearcontroltechnique,namely,thecompositenonlinearfeedback(CNF)controlmethod(Chen,Lee,Peng,&Venkataramanan,2003;He,Chen,&Wu,2005),whichhassuccessfullybeenappliedtosolvemanyreal-lifeproblems,isemployedtodesignthekernelcontrollawbasedontheidentifiedlinearmodeloftheUAVhelicopterusingin-flightdata.Dynamicinversion(Isidorietal.,2003),capableoffullydealingwithnonlinearitiesinaffinesystems,isadoptedtodesignthecommandgeneratorbasedonthekinematicalmodelsoftheUAV.Lastly,theflightschedulingisdescribedinadiscreteeventsystemthatcausesthehelicoptertoflyinsomepre-determinedflightconditions.2.DynamicandkinematicmodelsofUAVhelicopter

TheUAVsystemstudiedinthispaper,namedHeLion,isupgradedfromaradio-controlledbarehelicopter,Raptor90,byassemblinganeffectiveavionicsonboardsystemmountedunderthefuselageofthehelicopter(Caietal.,2005).Thehelicopteris1,410mminlength,190mminwidth,and476mminheight,anditsmaximaltakeoffweightis15kg.Itsweightincreasesfrom4.9kgto11kgafterintegratingallthenecessarycomponents.Itsmainrotorhasadiameterof1,605mmanditstailrotorhasadiameterof260mm.Thehelicopterisequippedwithanengine,whichproducesapowerof2.28kWatthespinningrateof15,000rpm,anditcanbeoperatedmanuallywitharemotecontrolunit.Therangeofitspracticalspinningrateisfrom2,000rpmto16,000rpm.Thegearratiooftheenginerotortothemainrotortothetailrotoris8.45:1:4.65.Thebarehelicopteriscapableofperformingvariousflighttasksincludinghoverandagileflight.Astheflightspeedofsmall-scalehelicoptersisrelativelylow,itseffectinaerodynamicscanbesafelyignoredanditisfeasiblepracticallytousealinearmodelinhoveringandnear-hoveringflightconditions.AlinearmodelofHeLionforsuchflightconditionshasbeenidentifiedinCai,Chen,Peng,Dong,andLee(2006)within-flightdataandisgivenas

˙x1

=A1

x1

˙x+B1

20

A2

x2

B2

u,(1)

where

thestatevariables

x1=Vx,Vy,φ,θ,ωx,ωy,a,b

,

x2=(V z,ψ,ωz,wf),

andwhereVx,Vy,Vz(inm/s)arethegroundvelocitiesmeasuredinthe(x,y,z)-directionsofthebodyframe,respectively.φ,θandψ(inrad)arerespectivelytheroll,pitchandyawangles,andωx,ωyandωz(inrad/s)arethecorrespondingroll,pitchandyawangularrates,aandb(inrad)arethefirstharmonicsoflongitudinalandlateralωflappinganglesofthemainbladetip-pathplane,andfinally,fisastatevariableofabuilt-infilterintheyawchannel.Thecontrolinputisgivenbyu=δ δ0,

(2)

whereδ0isthetrimvaluesofthecontrolinputcommand,δ= δr,δp,δc,δt

and

,withδr,δp,δcandδtbeingrespectivelytherollcyclic,pitchcyclic,collectiveandtailrotorcommands,whichallπ/haveanormalizedvaluein[ 1,1],with1beingequivalentto4rad.ForHeLion,themaximumvaluesthattheinputchannelscantakearerespectively0.35,0.35,0.12and0.4.ThemeasurementoutputoftheUAVsystemis

y= Vx,Vy,φ,θ,ωx,ωy,Vz,ψ,ωz

.

(3)

Inthehoveringcondition,δ0=(0.05,0.02, 0.22,0) whenthespinningrateofthemainbladesis1750rpm.Undersuchanoperatingcondition,thecorrespondingsystemdataare

A11A120A14

0

A0I1=

020A3100A

34 ,B1= 00 ,

00A43

A55A560

A44

B41

B520

AA2=

0660A75A76A

77 ,B2=

00BB

7273 ,0A86

A87

where

A 0.17780

11==

0 9.781

0.3104

,

A12

,

A0

9.781

14= 9.781

9.781

,A 0.3326 0.5353

31=,

0 0. 1903 0.2940A34=75.764343.8600 1 172.620 59.958,A43= 10,

A44= 8.12224.6535 0.0921 8,A55= 0.6821,

A56= 0 0.1070 .1222,A66= A76= 0 5.5561 ,A86= 01,02.7492 ,A75= 0.1446,A77= 36.674,A87= 11.1120,B41

=0.04962.6224 2.49280.1740

,B52=15.6491,

B72=1.6349,

B73= 58.4053.

Thekinematicalmodelisrelativelysimpleandisgivenby

p˙ p˙x

Vx

y=B

bV˙y,(4)

pzVz

wherepx,py,pzarerespectivelythedisplacements(inm)ofhelicopterinthe(x,y,z)-directionsofthenorth-east-down(NED)frame,andBbisthetransformationmatrixfromtheNEDframetothebodyframewith

ccB cθcψ

θs sb=

cψ

sφssψ+scφsθcψφcψ+sφssθ

,

(5)

φψ+φsθcψsθs ψφcψ+cφsθsψ

cφccθφθ

wheres =sin( )andc =cos( ).Lastly,theheightoftheaircraftisgivenbyh= pz.

3.Designofautonomousflightcontrollaw

TheschematicdiagramoftheautonomousflightcontrollawisshowninFig.1,inwhichtheoverallflightcontrolsystemishierarchicallydividedintothreelayers:(1)thekernelcontrollayer,whichistoguaranteetheasymptoticstabilityoftheaircraftmotionwithrespecttothesurroundingairandtotrackflightcommandsVxc,Vyc,Vzc,andψc;(2)thecommandgeneratorlayer,whichistogenerateflightcommandsbytrackingflightreferencespxr,pyrandpzrfromtheflightschedulinglayer;andlastly(3)theflightschedulinglayer,whichistogenerateflightreferencesbasedonpre-scheduleflighttasksorflightmissions.Asdemonstratedlaterinactualtestresults,suchacontrolschemehasproventobeveryeffectiveandyieldsanexcellentperformance.3.1.Kernelcontrollayer

ThestructureofthekernelcontrollawisdecentralizedinnatureandisshowninFig.2.Thekernelcontrollawisdecoupledintotwoparts,i.e.,therolling/pitchingcontrolandtheheaving/headingcontrol.Therolling/pitchingcontrolishierarchicallydividedintothevelocity,attitudeandswashplatecontrolcomponents.The

上一页第2页

你可能喜欢

热门文档

相关文档

站点地图 | 文档上传 | 侵权投诉 | 手机版
本站所有资源均来自互联网,本站只负责收集和整理,均不承担任何法律责任,如有侵权等其它行为请联系我们.
文档下载 Copyright 2013 doc.guandang.net All Rights Reserved.  -  email