Escolar Documentos
Profissional Documentos
Cultura Documentos
Amita Muralikrishna ST6 PDF
Amita Muralikrishna ST6 PDF
0
m p l b cos
A= det det
0 0 0 1
0
(m p l 2 + I ) m p l sen
0
b (m p l + I )
2
det det
(1)
0
m p l cos F ( mc + m p ) m p g l sen
det
+
det
vet =
0
(m p l + I ) ( mp l ) g sen cos
2 2
F
Figura l: Sistema do Pndulo Invertido em uma base mvel det det
(2)
Smbolo Descrio Valor
Metade do comprimento da
l haste do pndulo e centro 0,3m
de massa d
= A + vet
mp Massa da haste 0,5kg
dt x x
v v
mc Massa do carrinho 0,5kg
b Coeficiente de fora viscosa 0,1 Ns/m (3)
g Acelerao da gravidade 9,8 m/s2
ngulo do pndulo radianos
Velocidade angular do
rad/s
Controlador PID
pndulo
Momento de inrcia do O controlador PID bastante difundido na
I 0,06kg/m2
pndulo indstria de modo geral. O seu nome uma
x Posio do carrinho metros abreviatura referente as primeiras letras das
v Velocidade do carrinho m/s
palavras proporcional, integral e diferencial,
kp Ganho Potencial N/rd
respectivamente. O significado destas palavras est
ki Ganho integral 1/s assim relacionado: proporcional a um erro,
kd Ganho derivativo s proporcional integral no tempo deste erro e
Tabela 1: Descrio de variveis e constantes proporcional derivada no tempo deste erro.
u (t ) = k p e (t ) + k p ki e (t ) dt +k p kd
A modelagem dinmica do sistema foi obtida dt
0
com o uso da Mecnica Lagrangeana [1]. Aqui
(4)
apresentado apenas o resultado final da modelagem.
onde:
A forma final do modelo do pndulo invertido
u (t ) : o sinal de controle,
apresentada abaixo. Estas equaes foram
programadas no MATLAB. e (t ) : o erro que vem do sistema,
k p : o ganho proporcional;
kd : o ganho derivativo e
ki : o ganho integral.
Pela simples inspeo da equao acima,
0
percebe-se que a primeira parcela do lado direito da
m p l cos F ( c + m p ) m p g l sen
m
mesma est relacionada com o controle det
+
det
proporcional, a segunda com o integral e a terceira vetc = 0
(m p l + I )
com o diferencial. 2
( mp l ) g sen cos
2
F
No caso do pndulo invertido suponha-se que det det
D
seja realizada uma medida do ngulo que o
pndulo faz com a vertical. E que o erro seja (10)
produzido com relao a um valor de demanda D,
fixo pelo usurio. Este erro dado por:
e (t ) = ( (t ) D ). (5)
d
x = Ac x + vetc
Considerando que para a integral, tem-se: dt
t v v
i (t ) = e (t )dt , (6) i
i
0
(11)
= ( (t ) D ) (7)
0
= e (t ) , ou
Ac = 0
det det
dt dt 0 0 1 0
0
(m p l 2 + I ) m p l sen
0
b (mp l 2 + I )
0
det det
Para a parte derivativa tem-se: 1 0 0 0 0
(12)
de (t ) d ( (t ) D ) &
= = = . (8)
dt dt
As equaes acima so as respectivas: matriz
do sistema, o vetor de entradas externas e a equao
Assim, a equao fundamental pode ser escrita
da dinmica do pndulo invertido com controle
da forma:
PID.
u (t ) = k p e (t ) + k p k i i ( t ) + k p k d ( t ) Resultados
Foi utilizada para a realizao dos testes para o
(9)
problema do pndulo invertido, a verso 6.1 do
Matlab.
No caso particular do pndulo a ser equilibrado Os ganhos definem a ao do controle e devem
D = 0rd , a fora restauradora a fora de ser ajustados de modo que o ngulo do pndulo
controle do sistema. Desta forma tem-se: estabilize em = 0 rd.
F (t ) = u (t ) .
Os testes realizados neste trabalho consistiram
A incluso da equao de controle na na formao de diversas combinaes de valores
formulao do pndulo implica em integrar a dos ganhos do modelo. Alm destes, outros testes
equao (7). Isto pode ser conseguindo foram realizados variando-se o ngulo inicial .
modificando as equaes (1) (2) e (3).
A Tabela 2 mostra os melhores conjuntos de
valores de ganhos obtidos nos testes para 100, 500 e
1000 segundos, respectivamente. Os grficos das
Figuras 2, 3 e 4 mostram a convergncia do
sistema, com a devida configurao de parmetros,
com os comportamentos da posio do carrinho, da
velocidade do carrinho, do ngulo do pndulo e da
velocidade angular do pndulo.
tempo(s) kp kd ki
Figura 4: Convergncia do sistema utilizando o terceiro
Conjunto 1 500 100 5 500 conjunto de ganhos.
Referncias
Figura 2: Convergncia do sistema utilizando o primeiro
conjunto de ganhos. [1] Morais M. H. E., Muralikrishna A., Bravo R.,
Ferrari A. S., Braz I., Pndulo Invertido, CAP 328 -
Projeto Final, INPE, 2004.