Beruflich Dokumente
Kultur Dokumente
CONTROLE AUTOMATICO
DE ATITUDE DE UM HELICOPTERO
COM DOIS
GRAUS DE LIBERDADE
Arau
jo Campelo Rodrigues, Eduardo Henrique dos Santos, Antonio
Carlos Ybere
Eduardo Carrilho da Cunha
Emails: ybere.campelo@gmail.com, eduardo.ime12@gmail.com, carrilho@ime.eb.br
Abstract The present article is related to attitude automatic control of a two degree of freedom helicopter.
The problems treated are (i) obtaining the model dinamics equations using Lagrangian Mechanics, and (ii)
specification and tests of controllers for pitch and yaw angles automatic control. Differences concerning the
coupling and decoupling of pitch and yaw commands are discussed.
Keywords
Introdu
c
ao
ISBN: 978-85-8001-069-5
Apresenta
c
ao do Equipamento
Modelagem
5246
Coordenadas Generalizdas
vetor posic
ao do centro de massa
r cm e o
plano horizontal (plano x-y);
o angulo de arfagem (t), formado pela
projecao de
r cm na horizontal e uma direcao
arbitrada.
Kyy
Kpy
Kyp
Beq,p
Figura 2: Diagrama de corpo livre do 2DOF
Helicopter.
Beq,y
3.2
Lagrangiano do Sistema
M
rcm
Jeq,y
Jeq,p
ISBN: 978-85-8001-069-5
(1)
Constante
de
forca na arfagem
pelo motor de
arfagem
Constante
de
forca na guinada
pelo motor de
guinada
Constante
de
forca na arfagem
pelo motor de
guinada
Constante
de
forca na guinada
pelo motor de
arfagem
Atrito viscoso
equivalente
no motor de
arfagem
Atrito viscoso
equivalente
no motor de
guinada
Massa
do
Helicoptero
Distancia
do
centro de massa
ao eixo fixo do
Helicoptero
Momento
de
Inercia
equivalente
sobre a guinada
Momento
de
Inercia
equivalente
sobre a arfagem
Aceleracao da
gravidade
0, 204
N.m/V
0, 072
N.m/V
0, 0068
N.m/V
0, 0219
N.m/V
0, 800
N/V
0, 318
N/V
1, 3872
kg
0, 186
0, 0384
kg.m2
0, 0432
kg.m2
9, 81
m/s2
Pelo
Teorema
dos
Eixos
Paralelos
(Alonso, 2005), e considerando que movimentos
infinitesimais podem ser decompostos em
movimentos puros de arfagem e guinada
sucessivos, tem-se:
Jp = Jp,cm + M r2 cm
(2)
5247
Jy = Jy,cm + M r2 cm cos2 ()
(3)
em que Jp e Jp,cm s
ao os momentos de inercia
total e em relac
ao ao centro de massa para o
movimento de guinada; Jy e Jy,cm os momentos
de inercia total e em relac
ao ao centro de massa
para arfagem, e M a massa do helic
optero.
Dessa forma, pode-se escrever a Energia
Cinetica na forma
1 2 1
Jp + Jy 2
(4)
2
2
A energia potencial do sistema e obtida de
maneira trivial, j
a que e puramente gravitacional,
a partir da Figura 3:
Ec =
Ep = M grcm sen()
(5)
em que g e a acelerac
ao da gravidade.
Portanto, pela definicao do Lagrangiano
(Greenwood, 1997):
1
L = Ec Ep =
Jp,cm + M r2 cm 2 +
2
1
2
+ Jy,cm + M r cm cos2 () 2 M grcm sen()
2
(6)
3.3
Forcas Generalizadas
(7)
(8)
(9)
= Qk
(10)
dt qk
qk
ISBN: 978-85-8001-069-5
1
(kyp Vm,p + kyy Vm,y
Jy
M r2 cm sen(2) Beq,y )
(12)
Controle
Modelo Linearizado
(13)
(14)
(15)
xop = [0, 0, 0, 0]
(16)
5248
y = Cx + Du
4.3
em que
0
0
A=
0
0
0
1
0
0
0
1
0 9, 260
0
0
0
3, 487
0
0
0
0
B=
2, 361 0, 079
0, 240 0, 790
1 0 0 0
C=
0 1 0 0
0 0
D=
0 0
(17)
(18)
(19)
(20)
2, 361
s2 + 9, 26s
G(s) = 0, 2402
s2 + 3, 487s
0, 07871
s2 + 9, 26s
0, 7895
2
s + 3, 487s
(21)
(22)
ISBN: 978-85-8001-069-5
d2 s
,
+ 2d s + d2
(24)
4.2
s2
d2 s
d2 s
=s
2
s2 + 2d s + d
d2
(25)
(26)
(23)
5249
0.1
0
ngulo, rad
0.1
0.2
0.3
0.4
0.5
0.6
0.7
0.8
10
20
30
40
50
Tempo, s
Guinada
0.8
Referncia
Medido
Calculado
0.7
0.6
ngulo, rad
0.5
0.4
0.3
0.2
0.1
0
0.1
10
20
30
40
50
Tempo, s
D2 =
G12
= 0, 0334.
G11
(28)
G21
= 0, 3042.
G22
(29)
Analogamente,
4.4
(27)
ISBN: 978-85-8001-069-5
D1 =
2, 288s + 7, 556
+ 12, 75s + 32, 29)
(30)
s(s2
0, 7869s + 7, 302
s(s2 + 12, 75s + 32, 29)
(31)
Ajustando-se os ganhos da mesma maneira
que no controlador anterior, percebe-se pela
Figura 8 uma melhora significativa quanto ao
acompanhamento do sistema `a entrada degrau
tanto para a arfagem quanto para a guinada.
Nota-se que o sistema segue a entrada, mas ainda
existe um erro estacionario de aproximadamente
5250
ngulo, rad
0.1
0.2
0.3
0.4
0.5
0.6
Referncia
Medido
Calculado
0.7
0.8
10
20
30
40
50
Tempo, s
Guinada
0.45
0.4
0.35
ngulo, rad
0.3
0.25
0.2
0.15
0.1
0.05
J=
0.05
r0 x)T Q(r0 x + uT Ru dt (32)
ISBN: 978-85-8001-069-5
30
40
50
(33)
As matrizes originais A, B e C serao
modificadas para inclus
ao do novo termo integral,
ja a matriz D permanecer
a nula. Sendo a matriz
1 0 0 0
Aux =
(34)
0 1 0 0
20
T
()d,
10
Tempo, s
x0 (t) =
Referncia
Medido
Calculado
(38)
e
R = diag(1, 1)
(39)
5251
10, 7621
K=
0, 6146
7, 0652
0, 2886
T
0, 8459
21, 2276
0, 6664
12, 1004
0.2886
7, 0652
0.1
0
0.1
(40)
angulo, rad
Arfagem
0.2
0.2
0.3
0.4
0.5
A implementac
ao do controlador e feita como
segue na Figura 9. Note que o derivador na
implementac
ao foi tambem substituido pelo filtro
discutido na Subsec
ao 4.3.
0.6
Referncia
Medido
Calculado
0.7
0.8
10
20
30
40
50
tempo, s
Guinada
0.18
Referncia
Medido
Calculado
0.16
0.14
angulo, rad
0.12
0.1
0.08
0.06
0.04
0.02
0
0.02
10
20
30
40
50
tempo, s
Conclus
ao
Os
controladores
projetados
atenderam
parcialmente `as espectativas.
Notou-se uma
ISBN: 978-85-8001-069-5
Agradecimentos
5252
Edgard Bl
ucher.
Baumaister, J. e Leit
ao, A. (2008). Introduc
ao `
a
Teoria de Controle e Programaca
o Din
amica,
primeira edic
ao edn, IMPA.
Bruno, N. (2010). Notas de Aulas Em Controle,
IME.
Belanger, P. (2005). Control Engineering: A
Modern Approach, 1st edition edn, Oxford
University Press.
Dorf, R. C. (1989). Modern Control Systems, 8nd
edition edn, Wesley Longman.
e B. Zupancic, G. K. (2006). Modelling and
identification of a laboratory helicopter,
Proc. 5th Mathmod conferency .
Francois Leonard, A. M. e. G. A. (2012). Robust
nonlinear controls of model-scale helicopters
under lateral and vertical wind gusts, IEEE
Transactions on Control Systems Technology
.
Greenwood, D. (1997). Classical Dynamics, Dover
Publications Inc.
Gualin Wang, Jihong Zhu, C. Y. e. H. X.
(2011). System identifcation for helicopter
yaw dynamic modelling, Computer Research
and Development (ICCRD) .
Ogata, K. (2003).
Engenharia de Controle
Moderno, 4a edic
ao edn, Prentice Hall.
Pereira, R. L. e Kienitz, K. H. (2011).
Implementac
ao de controladores robustos
a partir da tecnica de tfl/ltr aplicado a
um helic
optero de tres graus de liberdade,
DINCON 2011, 10a Conferencia Brasileira
de Din
amica, Controle e Aplicac
oes .
Quanser (2007).
Manual.
ISBN: 978-85-8001-069-5
5253