无人直升机
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.
A Survey of Autonomous... 5页 免费 helicopter ...The design of flight control laws for hovering ...D. Simulation and Implementation The overall flight...
H. Design and implementation of an autonomous flight control law for a UAV helicopter. Automatica, 2009, 45, 2333-2338. [6] Aleksandrov, D., Penkov,...
Design and implementatio... 35页 免费 Autonomous Vehicle Techn... 10页 免费 Advanced Flight Control ... 9页 5财富值 Navigation functionaliti... 127页 ...
Intelligent Flight Control of an Autonomous Quadrotor...the versatile capabilities of this special design....implementation of control laws, and comparison with...
“System Identification, Estimation and Control for Autonomous Flight of High ...Design and Implementation of a Kalman ?lter for a 6-inch ?xed-wing gun...
Design and implementat... 35页 免费 Modeling and Control S... 6页 1下载...and provides UAV pilot controlled flight and autonomous flight (autopilot mod...
and Control of a UAV Using Low-Cost Sensors_英语...and flight control loop for autonomous flight. With...UAV Autopilot Design f... 9页 1下载券 基于H...
Control Law Design of Reconnaissance and Attack ...flight route to keep good reconnaissance and ...J. Guo. Survey of Key Technologies of autonomous...
Design of flight control... 暂无评价 11页 免费...Design, implementation a... 暂无评价 14页 5财富...“leader” aircraft while the autonomous “follower...
热门文档