Escolar Documentos
Profissional Documentos
Cultura Documentos
Segundo [1], tem-se abaixo as equaes que regem a dinmica do pndulo invertido.
( M + m) x + m l = u
( I + m l 2 ) + m l x = m g l
J = ( x Q x + u R u )dt
0
x2
(
M + m ) [ g sen( x1 ) + ( x 2 ) 2 sen( x1 ) cos( x1 ) (1 + l ) ] cos( x1 ) u m l sen( x1 ) cos( x1 ) ( x 2 ) 2
=
m l (cos( x1 )) 2 ( M + m) [(sen( x1 )) 2 l (cos( x1 )) 2 ]
x1 = x 2
x3 = x 4
xdot=[x(2);(2.1*(9.81*(sin(x(1)))+
((x(2))^2)*(sin(x(1)))*(cos(x(1)))*1.5)-(cos(x(1)))*u0.05*(sin(x(1)))*(cos(x(1)))*((x(2))^2))/(-0.05*((cos(x(1)))^2)-
x4 =
u + m l sen( x1 ) ( x2 )2
( M + m)
m l cos( x1 ) {
2.1*(((sin(x(1)))^2)-0.5*((cos(x(1)))^2)));
x(4);(((u+0.05*(sin(x(1)))*((x(2))^2))/(2.1))(0.05*(cos(x(1)))*((2.1*(9.81*(sin(x(1)))+
((x(2))^2)*(sin(x(1)))*(cos(x(1)))*1.5)-(cos(x(1)))*u0.05*(sin(x(1)))*(cos(x(1)))*((x(2))^2))/(-0.05*((cos(x(1)))^2)2.1*(((sin(x(1)))^2)-0.5*((cos(x(1)))^2))))/(2.1)))];
Subrotina Pendulo1.m
(Esta subrotina deve ser um arquivo .m localizada no mesmo caminho que o
programa principal: pendulo)
function [xdot] = pendulofunction(t,x)
global K
u=-K*[x(1); x(2);x(3); x(4)];
%observe que estamos calculando a soluo do sistema com realimentao
u=-Kx
xdot=[x(2);(2.1*(9.81*(sin(x(1)))+
((x(2))^2)*(sin(x(1)))*(cos(x(1)))*1.5)-(cos(x(1)))*u0.05*(sin(x(1)))*(cos(x(1)))*((x(2))^2))/(-0.05*((cos(x(1)))^2)2.1*(((sin(x(1)))^2)-0.5*((cos(x(1)))^2)));
x(4);(((u+0.05*(sin(x(1)))*((x(2))^2))/(2.1))(0.05*(cos(x(1)))*((2.1*(9.81*(sin(x(1)))+
((x(2))^2)*(sin(x(1)))*(cos(x(1)))*1.5)-(cos(x(1)))*u0.05*(sin(x(1)))*(cos(x(1)))*((x(2))^2))/(-0.05*((cos(x(1)))^2)2.1*(((sin(x(1)))^2)-0.5*((cos(x(1)))^2))))/(2.1)))];
0
1
0
0
K=
-54.0554 -11.8079 -1.0000 -2.7965
P=
326.7189
69.2133
11.8079
30.3158
69.2133
15.2894
2.7051
6.9631
11.8079 30.3158
2.7051 6.9631
2.7965 3.4102
3.4102 8.3331
0
0
1
0
0
0
, R = [1]
0
E=
-4.6944 + 0.9514i
-4.6944 - 0.9514i
-0.5104 + 0.4088i
-0.5104 - 0.4088i
0
1
0
0
0
0
1
0
0
0
, R = [ 0.01]
0
E=
-9.7166 + 3.4316i
-9.7166 - 3.4316i
-0.8330 + 0.4795i
-0.8330 - 0.4795i
Agora escolheram-se:
100
0
Q=
0
0 0 0
1 0 0
, R = [ 0.01]
0 100 0
0 0 1
K=
-289.6689 -61.9517 -100.0000 -74.7368
P=
89.7899 18.6900 61.9517 31.5867
18.6900 4.5391 14.7140 7.8392
61.9517 14.7140 74.7368 27.4279
31.5867 7.8392 27.4279 14.1836
E=
-9.7900 + 4.0657i
-9.7900 - 4.0657i
-2.5016 + 1.5721i
-2.5016 - 1.5721i
0 0 0
1 0 0
, R = [ 0.01]
0 800 0
0 0 1
Com estes valores obteve-se os seguintes resultados, que quando comparados com
os anteriores, se mostram melhores.
K=
-513.5160 -113.9266 -282.8427 -168.8891
P=
289.8697
64.3963
322.2330
118.5223
64.3963
14.9869
73.8872
27.6953
E=
-10.8272 + 6.9258i
-10.8272 - 6.9258i
-3.9138 + 1.2159i
-3.9138 - 1.215
322.2330 118.5223
73.8872 27.6953
477.6905 142.1176
142.1176 52.0129
BIBLIOGRAFIA
[1] OLIVEIRA, V. A.; Exerccio SEL 380 Controle Robusto Controle Pndulo
Invertido sobre um
Carrinho;