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

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

无人直升机

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

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

2335

Fig.1.Structureoftheoverallautonomousflight

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

control.

Fig.2.Structureofthekernelcontrolsystem.

heaving/headingcontrolisrespectivelydecoupledintotheheavingandheadingcomponents.Thevelocity,swashplateandheavingcontrolcomponentsaredesignedwiththepoleassignmentmethod,whereastheattitudeandheadingcontrollawsaredesignedusingtheCNFcontroltechnique.TheCNFcontrollerconsistsofalinearfeedbackcontrollawandanonlinearfeedbackcontrollaw.Thelinearfeedbacklawisdesignedtoyieldaclosed-loopsystemwithasmalldampingratioforaquickresponse,whilethenonlinearfeedbacklawisusedtoincreasethedampingratiooftheclosed-loopsystem,whenthesystemoutputapproachesthetargetreference,toreducetheovershoot.WereferinterestedreaderstoChenetal.(2003)andHeetal.(2005)formoredetailedinformationontheCNFcontroltechnique.InformationonhardwarecomponentsusedinactualflightimplementationcanbefoundinCaietal.(2005).

3.1.1.Velocitycontrol

TheroleofthevelocitycontrolistodesignacontrollawsuchthatthestatevariablesofVxandVyarecapableoftrackingtheflightcommandsVxcandVycasquicklyaspossible.Thevelocitycontrollawiscarriedoutbasedonthefollowingsubsystem

˙x

11=A

¯11x11+A12v11,(6)

wherex11=(Vx,Vy) ,A¯ A111=A1114A 34A31and

v111=x31+A 1

12A14x44+A34

A31x11,(7)wherex31=(φ,θ) andx44=(a,b)

.Wenotethatthetermassociatedwithx11isintroducedinv11todealwiththeinteraction

betweenthevelocityandattitudecontrol.Anappropriatecontrollawisthenobtained

andisgivenby

vV11=F11x11+G11

xc

Vyc

,

(8)

where

F.1182111

=

0.00579

0

0.11702

0.00116

(9)

ischosen¯ A 1suchthatA

11+A12F11isasymptoticallystable,andG11=12(A¯11+A12F11).

3.1.2.Attitudecontrol

Theattitudecontrollerisdesignedbasedonthefollowingsubsystem

˙x

33=AΦx33+BΦv33,z33=CΦ2x33+DΦ2v33,

(10)

wherex33=(φ,θ,ω

x,ωy),

AΦ

=

I2

,BΦ

=0A34

,

(11)

thecontrolinput

v 1

33=x44+A34A31x11,

(12)andthecontrolled

outputz33ischaracterizedbyCΦ2=

I2

0,

DΦ2=A 1

12A14.

(13)

Attitudecontrolistomakez33trackthesignalv11of(8).Following

thedesignprocedureof(Chenetal.,2003;Heetal.,2005),astatefeedbackCNFcontrollawisobtainedandisgivenby

v33=FΦx33+GΦv11+ρΦB ΦPΦ[x33 HΦv11],

(14)

where

F 0.04802

0.17774 0.02595 0.09596

Φ=

0.10928

0.01683 0.06395

0.01119

isselectedsuchthatAΦ+BΦFΦisasymptoticallystable,GΦ=[DΦ2 (CΦ2+DΦ2FΦ)(AΦ+BΦFΦ) 1BΦ] 1,

HΦ= (AΦ+BΦFΦ) 1BΦGΦ,

(15)andPΦ>0isthesolutionoftheLyapunovequation,

(AΦ+BΦFΦ) PΦ+PΦ(AΦ+BΦFΦ)= WΦ(16)

withWφ= diag{0 .01,0,01,0.001,0ρ=diag β e α1|φ | e 1 .001 },

| 1 1 e 1 α , β2

e

2|θ e 1 Φ 1 e 1

withβ1=1,α1=0.1andβ2=0.6,α2=0.1,and

φ

θ

=x I1

312 A 12A14(FΦHΦ+GΦ)v11.(17)

3.1.3.Swashplatecontrol

Todesignaswashplatecontroller,weconsiderthefollowingsubsystemcharacterizedby

˙x

44=A44x44+B41v44,(18)

wherex44=(a,b) ,andthecontrolinput

v 1 u1

44=B41A43x32+

u2

,

(19)

andwherex32=(ωx,ωy) ,andu1andu2arerespectivelythefirst

andsecondentriesoftheUAVmodelin(1).Itistodesignacontrollawthatsuchthatx44tracks

r 1

44=v33 A34A31x11.

(20)

Forthissubsystem,thestatevariablescannotbemeasured.Wewouldthushavetodesignadynamicoutputfeedbackcontrollawinstead.Thefollowingisanappropriatecontrollerforcontrollingtheswashplateofthehelicopter,

˙x

c44=(A44 L44A34)xc44 L44A31x11+B41v44+(A44 L44A34)L44x32

(21)and

v44=F44(xc44+L44x32)+G44r44,

(22)

where

L=

0.0100.025

=

0.2605 3.4751

44

0.025

0.010

,F44

1.2188 0.4924

arechosensuchthatA44 L44A34andA44+B41F44arestable,and

G= B 1

4441(A44+B41F44).Finally,

u1

=v1

u2

44 B 41A43x32.

(23)

上一页第3页

你可能喜欢

热门文档

相关文档

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