Documentos de Académico
Documentos de Profesional
Documentos de Cultura
INGENIERIA DE CONTROL
Figura 1: Motor DC
( )
(1)
_____________________________________________________________________
MSC.ING. FREEDY SOTELO V.
PAG.1
INGENIERIA DE CONTROL
Step Response
0.1
0.09
0.08
0.07
Amplitude
0.06
0.05
0.04
0.03
0.02
0.01
0
0.5
1.5
2.5
3.5
4.5
Time (sec)
>> [A,B,C,D]=tf2ss(num,den)
A=
-12.0000 -20.0200
1.0000
0
B=
1
0
C=
0 2
D=
0
>> step(A,B,C,D)
_____________________________________________________________________
MSC.ING. FREEDY SOTELO V.
PAG.2
INGENIERIA DE CONTROL
Step Response
0.1
0.09
0.08
0.07
Amplitude
0.06
0.05
0.04
0.03
0.02
0.01
0
0.5
1.5
2.5
Time (sec)
0.12
Amplitude
0.1
0.08
0.06
0.04
0.02
0.5
1.5
2.5
3.5
4.5
Time (sec)
_____________________________________________________________________
MSC.ING. FREEDY SOTELO V.
PAG.3
INGENIERIA DE CONTROL
x
0
(2)
(3)
''
''
3. Espacio de Estado
x1 x2 '
'
(4)
'
x3 x4 x '
(5)
'
(6)
'
x1
y1 1 0 0 0 x 2
y 2 0 0 1 0 x3
x
4
(7)
(8)
_____________________________________________________________________
MSC.ING. FREEDY SOTELO V.
PAG.4
INGENIERIA DE CONTROL
4. Linealizacion
x '1 f1 / x1
'
x 2 f 2 / x1
' f / x
1
x 3 3
x ' 4 f / x
1
4
f1 / x 2
f1 / x3
f 2 / x 2
f 2 / x3
f 3 / x 2
f 3 / x3
f 4 / x 2
f 4 / x3
f1 / x 4
x1 f1 / u
f 2 / x 4
x 2 f 2 / u
u
x f / u
f 3 / x 4
3
3
5. Linealizando en MatLab
5.1. Programa
% Programa
: LinPenInv.m
% Descripcion :
clc
% Variables simbolicas
syms f1 f2 f3 f4 x1 x2 x3 x4 u m M l g
f1=x2
f2=((M+m)*g*sin(x1)-u*cos(x1)-m*l*x2^2*sin(x1)*cos(x1))/(M*l+m*l-m*l*(cos(x1))^2)
f3=x4
f4=(u+m*l*x2^2*sin(x1)-m*g*sin(x1)*cos(x1))/(M+m-m*(cos(x1))^2)
f=[f1;f2;f3;f4];
% Calculo de jacobianos en Punto de Operacion
v=[x1,x2,x3,x4]; w=[u];
x1=0;x2=0;x3=0;x4=0;u=0;
As=subs(jacobian(f,v))
Bs=subs(jacobian(f,w))
% Dando valores a parametros del sistema
m=0.1;M=2;l=0.5;g=9.81;
A=subs(jacobian(f,v))
B=subs(jacobian(f,w))
C=[1 0 0 0; 0 0 1 0]
D=[0]
step(A,B,C,D)
% Fin
5.2. Ejecutando Programa
f1 = x2
f2 = ((M+m)*g*sin(x1)-u*cos(x1)-m*l*x2^2*sin(x1)*cos(x1))/(M*l+m*l-m*l*cos(x1)^2)
f3 = x4
f4 = (u+m*l*x2^2*sin(x1)-m*g*sin(x1)*cos(x1))/(M+m-m*cos(x1)^2)
_____________________________________________________________________
MSC.ING. FREEDY SOTELO V.
PAG.5
INGENIERIA DE CONTROL
As =
0
(M+m)*g/M/l
0
-m*g/M
1
0
0
0
0
0
0
0
0
0
1
0
Bs =
0
-1/M/l
0
1/M
A=
0
20.601
0
-0.4905
1
0
0
0
0
0
0
0
0
0
1
0
B=
0
-1
0
0.5
C=
1
0
0
0
0
1
0
0
D=
Step Response
0
To: Out(1)
-0.1
-0.2
Amplitude
-0.3
-0.4
0.1
To: Out(2)
0.08
0.06
0.04
0.02
0
0.1
0.2
0.3
0.4
0.5
0.6
Time (sec)
= 20.601
= 0.05
=1
= 0.981
= 2.1
u(3)
(20.601*sin(u(2))-u(1)*cos(u(2))-0.05* sin(u(2))*cos(u(2))*(u(3))^2)/(1.05-0.05*(cos(u(2)))^2)
u(5)
(u(1)+0.05*sin(u(2))*(u(3))^2-0.981*sin(u(2))*cos(u(2)))/(2.1-0.1*(cos(u(2)))^2)
_____________________________________________________________________
MSC.ING. FREEDY SOTELO V.
PAG.6
INGENIERIA DE CONTROL
A=
0
20.601
0
-.4905
1
0
0
0
0
0
0
0
0
0
1
0
B=
0
-1
0
0.5
C=
1
0
0
0
0
1
0
0
D=
PENDULO INVERTIDO
MODELO NO LINEAL
Sistema:
f = [ u f1 f2 f3 f4 ] '
ynl: x1
x1nl: x1l
u
MATLAB
Function
Step
x'
Pendulo
ynl: x3
1/s
Integrator
Matriz C
ynl: x1, x3
yl: x1
Entrada:u
MODELO LINEALIZADO
yl: x3
x'
B
Matrix
Gain3
Sum
1/s
Integrator1
Matrix
Gain1
yl: x1, x3
Matrix
Gain2
INGENIERIA DE CONTROL
f(4);
(u+m*l*f(2)^2*sin(f(1))-m*g*sin(f(1))*cos(f(1)))/(M+m-m*(cos(f(1)))^2) ];
t=t+h;
tacu=[tacu t];
facu=[facu f];
end
%plot(tacu',yacu(1,:)','r'); grid on;
plot(tacu,facu(1,:),'r'); grid on;
axis([min(tacu) max(tacu) min(facu(1,:)) max(facu(1,:))]);
title('Sistema de Pendulo Invertido');
xlabel('tiempo[seg]'); ylabel('Posicion D[rad/seg]');
%-------------------------------------------------------------------------------------------------------
_____________________________________________________________________
MSC.ING. FREEDY SOTELO V.
PAG.8
INGENIERIA DE CONTROL
8
7
6
5
4
3
2
1
0
0.5
1.5
2
2.5
Tiempo[seg]
3.5
3.5
Figura 9: Grfica de .
Sistema de Pendulo Invertido
0
-2
Posicion D?[rad/seg]
-4
-6
-8
-10
-12
-14
-16
-18
0
0.5
1.5
2
2.5
tiempo[seg]
_____________________________________________________________________
MSC.ING. FREEDY SOTELO V.
PAG.9
INGENIERIA DE CONTROL
_____________________________________________________________________
MSC.ING. FREEDY SOTELO V.
PAG.10
INGENIERIA DE CONTROL
d2
m
r
i
m
F
i
i j
2
dt
i 1
j 1
N
(12)
Luego, sustituyendo
obtenemos:
(ecuacin (10)) y
(14)
_____________________________________________________________________
MSC.ING. FREEDY SOTELO V.
PAG.11
INGENIERIA DE CONTROL
)(
)(
(15)
dt
(16)
(17)
Y ordenando:
) (
) (
(18)
Donde:
(19)
_____________________________________________________________________
MSC.ING. FREEDY SOTELO V.
PAG.12
INGENIERIA DE CONTROL
(20)
(21)
(22)
Donde:
(23)
(24)
se obtiene:
(26)
(27)
_____________________________________________________________________
MSC.ING. FREEDY SOTELO V.
PAG.13
INGENIERIA DE CONTROL
(29)
Las ecuaciones (15), (18) y (29) representan el modelo matemtico del proceso
pndulo invertido controlado por la corriente de armadura. Tales ecuaciones
pueden ser escritas en forma compacta:
(
(
(30)
(31)
(32)
Donde:
(33)
(34)
(35)
(37)
(38)
(39)
_____________________________________________________________________
MSC.ING. FREEDY SOTELO V.
PAG.14
INGENIERIA DE CONTROL
[ ]
)(
(
(
(
(
)(
) (
) (
)
) )
) (
(40)
Y puesto que en nuestro sistema tenemos como salidas disponibles el
desplazamiento angular de la varilla y el desplazamiento del carro, la ecuacin
de salida toma la forma siguiente:
(41)
Donde:
(42)
(43)
( )
( )
[
)
( )
)
( )
( )
)(
)]+
)
( )
) ]
(44)
_____________________________________________________________________
MSC.ING. FREEDY SOTELO V.
PAG.15
INGENIERIA DE CONTROL
(45)
)
[
(46)
(47)
Donde:
(
[(
[(
(48)
(49)
_____________________________________________________________________
MSC.ING. FREEDY SOTELO V.
PAG.16
INGENIERIA DE CONTROL
( )
( )
( )
( )
(50)
( )
(51)
( )
Donde
) ( )
( )
(52)
es el tiempo inicial, y:
(53)
(
Donde
(54)
( )
[
se obtienen de:
(55)
(]) ()
(56)
(57)
En donde
y
son matrices constantes que no dependen del periodo de
muestreo ; por consiguiente, son las mismas que para el caso continuo.
_____________________________________________________________________
MSC.ING. FREEDY SOTELO V.
PAG.17
INGENIERIA DE CONTROL
SISTEMA DE SEGUIMIENTO
_____________________________________________________________________
MSC.ING. FREEDY SOTELO V.
PAG.18