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

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

无人直升机

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

3.1.4.Heavemotioncontrol

ThispartistocontrolVztrackingtheflightcommandVzc.TocontroltheheavedirectionmotionoftheUAVhelicopter,weusethefollowingsubsystem

V

˙z=A55Vz+B52v55,(24)

wherethecontrolinputvariable

v=B 15552A56x66+u3,(25)andwherex66=(ψ,ωz) andu3isthethirdentryinthecontrol

inputvectorof(1).Averysimplestaticcontrollerisobtainedasfollows

v 1

55=F55Vz B52(A55+B52F55)Vzc.(26)

WeselectF55= 0.052265suchthatA55+B52F55<0.Itisclear

that

u=v1

355 B 52A56x66.

(27)

3.1.5.Headingmotioncontrol

Headingmotioncontrolistogenerateacontrollersuchthatthestatevariableψwillfollowtheflightcommandψc.Thesubsystemweuseforheadingmotioncontrolischaracterizedby

˙x

66=AΨx66+BΨv66,(28)

where x66=(ψ,ωz) ,AΨ

=A

66

A76

,

BΨ

=0B73

.

(29)

ThefollowingstatefeedbackCNFcontrollawyieldsaverygoodperformancefortheheadingmotion:

v66=FΨx66+GΨψc+ρΨB ΨPΨ(x66 HΨψc),

(30)where

FΨ=

0.01712

0.08486

(31)

ischosensuchthatAΨ+BΨFΨisasymptoticallystable,

GΨ=[ CΨ2(AΨ+BΨFΨ)

1

BΨ]

1

,

(32)HΨ= (AΨ+BΨFΨ) 1BΨGΨ,

(33)

Pψ>0isthesolutionoftheLyapunovequation,

(AΨ+BΨFΨ)

PΨ+PΨ(AΨ+BΨFΨ)= WΨ

(34)

withWΨ=diag{0.034243,1.7122×10 6},andfinally

e α4|ψ ψc| e 1ρ Ψ= β4 1 e 1

(35)

withβ4=1andα4=0.1.

Inordertotransformthecontrollawof(30)intotheactual

inputtothehelicopter,weneedtoestimatethestatevariableωfassociatedtothebuilt-infilterintheyawchannel,whichcanbedoneasfollows

˙x

f=(A87 LfA77)(xf+Lfωz)+A86x66 Lf(A75Vz+A76x66+B72u3+B73u4),

(36)whereLf= 0.1ischosensothatA87 LfA77<0,andω f=xf+Lfωz.

(37)

Finally,the4th entryofthecontrolinputu14=v66 B

vectorisgivenby

73A75Vz A77ω

f B72u3(38)

andtheactualcontrolsignalthatisinjectedintotheUAVisgivenby

δ=δ0+u.

(39)

ThiscompletesthedesignofthekernelcontrollawsfortheUAVhelicoptersystem.

3.2.Commandgenerator

Thecommandgeneratorfunctionistogeneratenecessaryflightcommandsassociatedwithrequiredflightmissions.ItcanbecarriedoutusingthedynamicinversiontechniquebasedonthedisplacementequationorthekinematicmodeloftheUAVsystemin(4).Morespecifically,wenotethat(4)canberewrittenas

p

˙

p˙xVxcosψscosθsy=B bVy=Vgsinψ˙scosθs,(40)

p

zVz sinθswhereVg,θsandψsarerespectivelythegroundspeed,flightpath

angleandflightazimuthangle.Thetaskofthecommandgeneratoristogenerateflightcommands,i.e.,Vxc,Vyc,Vzcandψc,bytrackingtheflightreferencesofthescheduledsteadyandmaneuveringflights.

Foraheadingdirectionreferencegivenintermsofψrorψ

˙r,ψc=ψrorψc=ψ

˙r t+ψ,(41)

where tisgenerallychosentobethesamplingperiodoftheover-allcontrolsystem,whichis20msforHeLion.Forflightreferences

givenintermsofpxr,pyrandpzrorh

˙r,

Vxc

kpx(px pxr

Vyc=Bb

p)kpy(y pyr)(42)

Vzc

kpz(pz pzr)

wherethelastentrykpz(pz pzr)canbereplacedby h

˙rifitisgiven,and

kpx= 0.3,

kpy= 0.3,

kpz= 0.5

(43)

arefeedbackgainschosenforourUAVhelicopter.Wenotethath= pz.ForflightreferencesgivenintermsofVgrandeitherone

ofhr,θsr,θ

˙srandψsrorψ˙sr,

Vxc

cosψsccosθ Vyc=BbVgr

ψθscsinVzc

sccossc

,

(44)

sinθsc

where

θ

(h hr)

sc=arcsin

khorθsc=θ

˙Vsr t+θs(45)

g

orθsc=θsr,and

ψsc=ψsrorψsc=ψ

˙sr t+ψs,(46)

andwherekh= 0.5isafeedbackgainchosenforourUAVand tischosentobethesamplingperiodoftheoverallcontrolsystem.Lastly,thedetaileddesignofflightschedulingistobegiveninthenextsectionforaflightenvelope,whichconsistsofflighttasksincludingautomatictakeoff,hovering,slithering,spiralingandautomaticlanding.

4.Simulationandactualflightexperiment

Weillustratethedesignofflightschedulingwithaflighten-velopeexperiment,whichconsistsoftasksincludingautomatictakeoff,hovering,slithering,turningback,headturning,pirouet-ting,verticalturning,spiralturning,andautomaticlanding.Table1givestheevent-drivenmodelsofsuchanexperiment.Thespecificflightreferencesofthescheduledsteadyandmaneuveringflightsaregivenasfollows:(1)Takeoff:h

˙r,pxr,pyrandψrareconstants.(2)Hovering:pxr,pyr,p(3)ψzrandψrareconstants.

Slithering:ψsr=sr0±π/4,andhr,Vgrandψrareconstants.

(4)

Headturning:hr,Vgr,ψsrandψ

˙rareconstants.

上一页第4页

你可能喜欢

热门文档

相关文档

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