Beruflich Dokumente
Kultur Dokumente
TEORA DE CONTROL IV
Ax + Bu
(1.1)
donde el punto denota derivada con respecto al tiempo, ofrece una gran simplicidad,
lo que ha permitido el diseo de sistemas de control com mltiples entradas y mltiples
salidas (MIMO) de manera directa.
La funcin x(t) es el estado del sistema. El estado describe donde se almacena la
energa en un sistema. Por ejemplo, en un diagrama a bloques los estado son las salidas de
los integradores. En un circuito los estados son los voltajes en los capacitores y las
corrientes en los inductores. La seal u(t) es la entrada de control.
El modelo de estado viene dado por ecuaciones diferenciales de primer orden. La
diferencia con la teora de control clsico estriba en x(t) y u(t) son vectores, no escalares.
Denotamos el nmero de componentes de x como n y el de u como r; lo que implica que A
es una matriz cuadrada de orden n y B es una matriz de n por r. Se acostumbra llamar a A la
Grupo 9A1M
A pgina 1 de 26
ESIME ZACATENCO
TEORA DE CONTROL IV
(1.2)
describe como la salida medida y(t) se obtiene del estado x(t) y de las entradas u(t).
Las salidas pueden ser elegidas en cierto grado por el diseador del sistema, dependiendo
de los sensores que tenga disponibles. El numero de componentes del vector de salida es m.
La matriz C, de orden m por n, es llamada matriz de salida o de medicin, y la matriz D, de
m filas por r columnas, se llama matriz de transmisin directa.
Por lo tanto el modelo de estado espacio viene dado por las matrices A, B, C y D lo
que produce una representacin muy conveniente para un sistema con r entradas y m
salidas. La siguiente figura muestra un diagrama a bloques del modelo de estado espacio
dado por (1.1) y (1.2). Notar que hay n integradores, puesto que tenemos un diagrama a
bloques de vectores. Cada salida de un integrador es un componente del estado.
(1.3)
Grupo 9A1M
A pgina 2 de 26
ESIME ZACATENCO
Y1 ( s )
Y ( s )
2
.
.
Y m ( s )
U (s )
G 11 ( s ) G 12 ( s) L G1r ( s ) 1
U 2 ( s)
G 21 ( s) G 22 ( s ) L G 2 r ( s) .
M
M
M
.
G m1 ( s ) G m2 (s ) L G mr ( s ) U r ( s )
TEORA DE CONTROL IV
(1.4)
(1.5)
(1.6)
(1.7)
(1.8)
Para pasar del modelo de estado espacio a la funcin de transferencia se puede usar
el comando ss2tf de MATLAB o con ALIN, empleando el comando inicia seguido de F9.
Discretizacin de un sistema continuo
Como se mencion al principio la gran ventaja de la teora de control moderno es
poder aplicar la computadora digital al control de los sistemas, por lo que es esencial poder
expresar el modelo matemtico de manera discreta en el tiempo por lo que se crea un ndice
entero k, tal que el tiempo se exprese mediante: t = kT, donde T es el periodo de muestreo y
k es k-simo periodo de muestreo del proceso por parte del algoritmo de control digital.
El procedimiento usual es retener la entrada de control u(t) entre periodos de
muestreo, lo que quiere decir que se le mantiene constante. Ello se logra empleando
retenedores de orden cero (ROC) en la salida de la computadora, o sea a la entrada del
proceso, segn muestra la figura siguiente. Entonces la seal de control u(t) est dado en
trmino del control en tiempo discreto:
u(t) = u(k) ; kT # t < (k+1)T
Grupo 9A1M
A pgina 3 de 26
ESIME ZACATENCO
TEORA DE CONTROL IV
(1.9)
(1.10)
= e AT
= I + AT +
1 2 2 1 3 3
1 j j
A T + A T + .. +
A T L
2!
3!
j!
(1.11)
BT +
1
1
1
AB T 2 + A 2 BT 3 + L + A j 1BT j + L
2!
3!
j!
(1.12)
Basados en las dos ecuaciones anteriores es fcil escribir un programa que discretice
el modelo continuo, en efecto usaremos el comando c2d de MATLAB (ALIN tambin
brinda dicha capacidad) para discretizar los modelos que se estudiarn aqu. Las matrices C
y D no cambian al discretizar el modelo.
Los polos del sistema continuo son los valores principales de A. Los polos del
sistema discretizado son los valores principales de la matriz F. Si los valores principales de
A se denotan por i, entonces los valores principales de F, vienen dados por:
zi = exp(iT)
(1.13)
Sin embargo
Profr. Salvador Saucedo
Grupo 9A1M
A pgina 4 de 26
ESIME ZACATENCO
zi
= e Re(i )T e Im( i )T
TEORA DE CONTROL IV
(1.14)
Figura 1.3 Sistema con dos entradas y dos salidas, de tres variables de estado
Se consideran amplificadores operacionales ideales, esto es, con impedancia de
entrada infinita, ancho de banda infinito y ganancia muy alta.
Las matrices de estado y de control son:
Grupo 9A1M
A pgina 5 de 26
ESIME ZACATENCO
1
R1 C3
1
R1 C 2
1
R 2 C1
2 R1C1
R 3C 3
0
1
=
R1C1
0
TEORA DE CONTROL IV
0
2
R1C 3
0
1 0 0
0 1 0
0 0
0 0
0
50
100
0
66 . 66 50
0
50
= 100
0
0
100
-100.0000
-66.6667
0
0
-50.0000
-50.0000
B
0
-100
0
C = [1
0
0
-100
0
0 ;0
0];
Grupo 9A1M
A pgina 6 de 26
ESIME ZACATENCO
TEORA DE CONTROL IV
D = zeros(2);
t = 0:0.001:0.65; %Para definir la variable tiempo
[Y1,X1] = step(A,B,C,D,1,t); %Respuesta al escaln unitario en u1:
plot(t,X1(:,1)) %Para ver grfica de primera variable de estado
plot(t,X1(:,2))
1.0e+002 *
-0.0468 + 0.4804i
-0.0468 - 0.4804i
-1.0731
Grupo 9A1M
A pgina 7 de 26
ESIME ZACATENCO
TEORA DE CONTROL IV
1.0e+005 *
0
0
0.0000
-0.0010
den1 =
0.1000
-0.0500
5.0000
0.0000
1.0e+005 *
0.0000
0.0012
G11 ( s ) =
0.0333
10 , 000 s
+ 116 .6 s
2.5000
+ 500 ,000
3,333 .3 s
=
250 , 000
Y1(s) /U1(s)
1.0e+005 *
0
0
den2 =
-0.0000
-0.0000
0.0000
0.0500
-5.0000
-0.0000
%Para Y1(s)
%Para Y2(s)
1.0e+005 *
0.0000
0.0012
0.0333
2.5000
-0.3509
0.7637
0.0343
0.0733
-0.3509
-0.0048
-0.0048
0.0343
-0.3623
0.0343
-0.1583
0.8165
G =
Grupo 9A1M
A pgina 8 de 26
ESIME ZACATENCO
TEORA DE CONTROL IV
=
=
=
0.981511.01
0.9815-11.01
0.65100
( R1 + R 2 )C1
R1
L ( R1 + R2 )
0
0
1
L
11 ( R1 + R2 ) C1
11C 2
R1 R2
1
+ R3
L 11 ( R1 + R2 )
R1
( R + R )C
2
1
1
0
R2
L ( R1 + R2 )
D = 0
Grupo 9A1M
A pgina 9 de 26
ESIME ZACATENCO
0
333 .3
0
0
3. 333 10
30 ,303
45 , 455
10 , 606
C = [ 0 0 1000]
TEORA DE CONTROL IV
333 . 3
0
6 .666
D = 0
%Con MATLAB:
R1 = 1000;
R2 = 2000;
R3 = 1000;
C1 = 1E-6;
C2 = 2*1E-6;
L = 0.1;
format long
A = [-1/((R1+R2)*C1) 0 -R1/(11*((R1+R2)*C1));0 0 1/(11*C2);
R1/(L*(R1+R2)) -1/L -(R1*R2/(11*(R1+R2)) +R3)/L]
1.0e+004 *
-0.0333333333
0
0.0003333333
0
0
-0.0010000000
-3.0303030303
4.5454545455
-1.0606060606
B = [1/(C1*(R1+R2));0;R2/(L*(R1+R2))]
1.0e+002 *
3.3333333333
0
0.0666666667
C = [0
R3]
0
1000
D = 0;
x0 = [5 0 0.005]'; %Condiciones iniciales
t = 0:0.001:0.015;
y = initial(A,B,C,D,x0,t) %Respuesta a las condiciones iniciales
5.00000000000000
1.08394357485109
0.71087342493114
0.44894878397576
0.26561129517121
0.13786042107093
0.04940438357282
-0.01129570503725
-0.05241153466482
-0.07972933145942
-0.09734539425799
-0.10815886504720
-0.11422084334659
-0.11698172287903
Grupo 9A1M
A pgina 10 de 26
ESIME ZACATENCO
TEORA DE CONTROL IV
-0.11746642064118
-0.11639851914340
eig(A)
1.0e+004 *
-0.03446288565293
-1.05531046112403
-0.00416604716243
El sistema slo tiene races reales negativas, por lo que su respuesta es estable y sobre
amortiguada.
Funcin de Transferencia
[num,den] = ss2tf(A,B,C,D)
num =
1.0e+006 *
0
den =
0.006666666667
3.333333333334
0.00000000000033
1.0e+008 *
0.000000010
0.000109393939
0.0409090909
1.51515151515
Obviamente, los polos de la funcin de transferencia son los valores
principales de la matriz A:
Format short
roots(den) = 1.0e+004 *
-1.0553
-0.0345
-0.0042
0.0218555516
0.9619224141
-0.0009043533
-2.0119461658
4.1106968295
-0.0045253632
G =
0.2678367340
0.0271498100
0.0006830392
H = C;
eig(F)
0.708483
Profr. Salvador Saucedo
Grupo 9A1M
A pgina 11 de 26
ESIME ZACATENCO
TEORA DE CONTROL IV
0.959195
0.000026
Respuesta a las condiciones iniciales en el caso discreto:
[Yd,Xd] = dinitial(F,G,H,D,x0,26);
[y Yd(1:16)]
5.0000
1.0839
0.7109
0.4489
0.2656
0.1379
0.0494
-0.0113
-0.0524
-0.0797
-0.0973
-0.1082
-0.1142
-0.1170
-0.1175
-0.1164
Caso 3: Sistema pasivo de cuarto orden con dos entradas y dos salidas
Se acostumbra representar el voltaje de cada capacitor y la corriente en cada
inductor mediante sendas variables de estado, por lo que en este caso hay tres variables de
estado para la cada de voltaje en los tres capacitores y una variable de estado ms para la
corriente en el inductor.
Figura 1.8 Sistema de cuarto orden, con dos entradas y dos salidas
Las matrices de estado y de entrada vienen dadas por:
Grupo 9A1M
A pgina 12 de 26
ESIME ZACATENCO
1
R1 C1
1
L
0
0
1
C1
R2
L
1
C2
1
C3
0
1
L
0
0
R3 C 3
TEORA DE CONTROL IV
1
R C
1 1
= 0
0
0
0
1
R3 C3
0
1 0 1 1
1
0 0 0
0 0
0 0
Usando MATLAB:
R1 = 10000;
R2 = 5000;
R3 = 20000;
C1 = 10E-6;
C2 = 2E-6;
C3 = 10E-6;
L = 0.2;
A = [-1/(R1*C1) -1/C1 0 0; 1/L -R2/L -1/L
0 1/C3 0 -1/(R3*C3)] = 1.0e+005 *
-0.0001
0.0001
0
0
eig(A) =
-1.0000
-0.2500
5.0000
1.0000
0
-0.0001
0
0
-1/L;0 1/C2 0 0;
0
-0.0001
0
-0.0001
1.0e+004 *
-2.4859
-0.0143
-0.0009
-0.0004
format long
eig(A)
1.0e+004 *
-2.48591948847648
-0.01430461214020
-0.00087345420702
-0.00040244517630
B = [1/(R1*C1) 0;0 0;0 0;0 1/(R3*C3)]
10
0
0
0
0
0
0
5
Grupo 9A1M
A pgina 13 de 26
ESIME ZACATENCO
TEORA DE CONTROL IV
C = [1 0 -1 1;0 0 0 1];
D = zeros(2);
t = 0:0.001:1.2;
Se define una matriz para aplicar la excitacin en ambas entradas (u 1 = sen(4t) y u 2 = 2*cos(4t) ):
U = [sin(4*pi*t) ; 2*cos(4*pi*t)]';
[Y,X] = lsim(A,B,C,D,U,t); %Se consideran CI nulas
plot(t,Y(:,1))
%Para grfica de y1(t)
-2.9863897726
-0.0042804018
15.2729540344
3.0203154515
0.0341005171
-0.0001527295
0.8277431724
-0.0342753554
0.0339256788
-0.0001510158
-0.1713767770
0.9559499011
G =
0.0194528161
0.0000034100
0.0017542420
0.0003496766
0.0001748382
-0.0000017138
-0.0008800506
0.0097747435
Grupo 9A1M
A pgina 14 de 26
ESIME ZACATENCO
TEORA DE CONTROL IV
H = C;
k = 0:600; %Para tener 600 periodos de muestreo
Ud = [sin(4*pi*k*T); 2*cos(4*pi*k*T)]'; %Se discretiza la misma
excitacin usada en el caso continuo
[Yd,Xd] = dlsim(F,G,H,D,Ud); %Se resuelve modelo discreto
[Y(1:2:23,:) Yd(1:12,:)] %Para contrastar soluciones continua y discreta
se despliegan los primeros doce valores:
0
-0.0172
-0.0296
-0.0384
-0.0444
-0.0484
-0.0508
-0.0521
-0.0525
-0.0522
-0.0515
-0.0503
0
0.0196
0.0383
0.0564
0.0740
0.0912
0.1081
0.1246
0.1408
0.1567
0.1725
0.1879
0
-0.0174
-0.0300
-0.0389
-0.0450
-0.0491
-0.0516
-0.0529
-0.0534
-0.0531
-0.0524
-0.0513
0
0.0195
0.0383
0.0564
0.0740
0.0912
0.1081
0.1246
0.1408
0.1568
0.1725
0.1880
M 1z 1 + k1z1 + k 2( z1 z 2 ) + b1 z1 + b2 ( z1 z 2 ) =
..
M 2 z 2 + k3 z 2 + k 2( z 2 z1 ) + b3 z 2 + b2 ( z 2 z1 )
f1
=
Grupo 9A1M
f2
A pgina 15 de 26
ESIME ZACATENCO
TEORA DE CONTROL IV
( k1 + k 2 ) / M 1
k2 / M2
( b1 + b 2 ) / M 1
k2 / M1
b2 / M 2
(k 3 + k 2 ) / M 2
x1
b2 / M 1
x2 +
x3
1
(b 3 + b2 ) / M 2 x 4
0
0 0
1 / M 1 0 f1
0 0 f 2
0 1 / M 2
Si suponemos que tenemos sensores de posicin (en mm) y de velocidad (en mm/s)
slo para la segunda masa, tendremos la ecuacin de salida
y1
y
2
x1
0 0 1000 0 x 2
x
0 0 0 1000 3
x4
; N = newton = 1kg-m/s
con MATLAB:
k1
k2
k3
M1
M2
b1
b2
b3
=
=
=
=
=
=
=
=
1000
2000
500
10
5
40
50
20
1
-9
0
10
0
200
0
-500
0
5
1
-14
-9.5000 +24.6931i
-2.0000 + 9.7980i
-9.5000 -24.6931i
-2.0000 - 9.7980i
Grupo 9A1M
A pgina 16 de 26
ESIME ZACATENCO
TEORA DE CONTROL IV
+
+
-
9.80e+000i
9.80e+000i
2.47e+001i
2.47e+001i
2.00e-001
2.00e-001
3.59e-001
3.59e-001
1.00e+001
1.00e+001
2.65e+001
2.65e+001
Grupo 9A1M
A pgina 17 de 26
ESIME ZACATENCO
TEORA DE CONTROL IV
Grupo 9A1M
A pgina 18 de 26
ESIME ZACATENCO
TEORA DE CONTROL IV
ylabel('Grados')
xlabel('Frecuencia en rad/seg.')
grid on
Grupo 9A1M
A pgina 19 de 26
ESIME ZACATENCO
TEORA DE CONTROL IV
24.6931
-9.5000
0
0
0
0
-2.0000
-9.7980
0
0
9.7980
-2.0000
B =
0.0569
0.0561
-0.0169
0.0952
-0.1139
-0.1122
-0.0169
0.0952
C =
-23.7099
24.0638
-368.9676 -814.0772
D =
0
0
0
0
69.2783
-258.9633
12.2890
654.2075
EL GIRSCOPO VERTICAL
Una de las aplicaciones ms interesantes de las ecuaciones de movimiento de Euler
es el estudio del girscopo, que ha maravillado a matemticos y fsicos por ms de un siglo.
Este dispositivo es un sensor muy til en aeronaves y satlites espaciales. Su diseo y
control constituyen un problema tecnolgico importante desde hace mas de 50 aos.
En un girscopo ideal el rotor o rueda es mantenido girando a una velocidad
angular constante mediante el uso de un motor que compensa los pares debidos a la
friccin. Suponer que el eje de giro de la rueda es el eje Z. Si asumimos que TzB es tal que
zB = 0 , esto es
Hz = Jzz = constante
Donde Jz es el momento polar de inercia. Si adems suponemos que el rotor del
girscopo es realmente simtrico respecto del eje de giro Z, y puesto que
Jx = Jy = Jd (momento diametral de inercia)
Las primeras dos ecuaciones del girscopo vienen dadas por
xB
H
yB
Jd
Tx
Jd
Grupo 9A1M
A pgina 20 de 26
ESIME ZACATENCO
yB
H
xB
Jd
TEORA DE CONTROL IV
Ty
Jd
Figura 1.17 Diagrama a bloques de un girscopo de dos ejes con sistema de captura
El rango de movimiento de una rueda alrededor de sus ejes X y Y relativo a su
cubierta es muy pequeo ( menos de dos grados). Por ello el girscopo debe ser mantenido
Profr. Salvador Saucedo
Grupo 9A1M
A pgina 21 de 26
ESIME ZACATENCO
TEORA DE CONTROL IV
normal a su eje de giro mediante pares (torques) de tal modo que la magnitud de dichos
pares sea proporcional a las velocidades angulares de la cubierta.
Las otras dos ecuaciones para definir la dinmica del girscopo son
dx
dy
= xB xE
= yB yE
donde xE y yE son las velocidades angulares externas que se desean medir con el
girscopo. Las cuatro ecuaciones constituyen las ecuaciones bsicas de un girscopo ideal.
La figura anterior representa el diagrama a cuadros de las cuatro ecuaciones adems de
agregar la realimentacin necesaria para controlar el girscopo. El diagrama exhibe los
pares Tx y Ty generados como funciones de los desplazamientos angulares dx y dy , para
mantener a los mismos dentro del rango previsto. Dichos desplazamientos pueden ser
medidos usando pequeos sensores magnticos instalados en la cubierta, capaces de
detectar pequeas inclinaciones de la misma. El sistema de control que realiza la captura
de la rueda es una parte muy importante de un girscopo con valor comercial.
Las cuatro ecuaciones vistas estn en cierto modo idealizadas por lo que un
girscopo ms prctico presenta otros pares debido a pequeos resortes aadidos a los
soportes de la cubierta, adems de ofrecer resistencia a los cambios de velocidad pues
existen una friccin viscosa, de magnitud pequea pero no del todo insignificante que
genera pares proporcionales a las velocidades angulares.
xB
yB
KQ
H
D
K
T
yB d (xB xE ) D d x
dy + x
Jd
Jd
Jd
Jd
Jd
KQ
Ty
H
D
K
xB d (yB yE ) D d y +
dx +
Jd
Jd
Jd
Jd
Jd
El modelo de estado espacio viene dado por dx/dt = Ao x + Bo u + Ev, donde v es una
variable externa.
Si definimos al vector de estado como
dx
dy
=
xB
yB
x1
x
2
x3
x4
El vector de control u viene dado por [Tx Ty ]t , mientras que el vector externo v,
viene dado por [xE yE]t . Las matrices Bo y E vienen dadas por
Grupo 9A1M
A pgina 22 de 26
ESIME ZACATENCO
Bo
0
0
0
0
1 / J d 0
0 1 / J d
TEORA DE CONTROL IV
0
1
0
1
Dd / J d 0
0 Dd / J d
Ao
0
0
K D
Jd
K
Q
J d
0
KQ
0
Dd
Jd
K
D
Jd
Jd
H
Jd
0
1
H
Jd
D
d
J d
KQ/Jd = 40 seg-2
KD/Jd = 20 seg-2
1580
=
40
40
202
1580
2000
2000
J d
202
0
1600
48
1600
1
0
48
Con races complejas repetidas en 24 32j, esto es, polos con frecuencia natural de
40 rad/seg y 0.6 de coeficiente de amortiguamiento. La matriz de entrada B es igual a la
matriz E.
Cul ser la respuesta a un escaln unitario en xE?
Veamos cmo obtener dicha respuesta con MATLAB
t = 0:0.001:0.5;
B
-1
0
0
-1
Grupo 9A1M
A pgina 23 de 26
ESIME ZACATENCO
TEORA DE CONTROL IV
250
0
0 250
C = [1 0 0 0; 0 1 0 0];
[Y1,X1] = step(A,B,C,D,1,t);
%Respuesta e escaln unitario para wxE
[Y2,X2] = step(A,B,C,D,2,t);
%Respuesta e escaln unitario para wyE
plot(t,Y1)
grid on
xlabel('tiempo')
title('Respuesta a escaln unitario en WxE')
ylabel('y1 y2')
PROBLEMAS
1.
Considerar el sistema del pndulo invertido que se monta en un carro que rueda sin
friccin, movido por un motor controlado que produce una fuerza u. Si se consideran slo
pequeos ngulos de giro respecto de la posicin vertical de tal modo de obtener un
modelo lineal, y asumiendo que la masa m del pndulo se concentra en la parte superior
de la varilla, ver pginas 803-805 de [1].
a) Demostrar que las ecuaciones exactas del movimiento son
( M + m) x + md cos md sen
= u
= 0
Grupo 9A1M
A pgina 24 de 26
ESIME ZACATENCO
TEORA DE CONTROL IV
b) Determinar el modelo de estado espacio (de cuarto orden), asumiendo que hay
un sensor para el desplazamiento x, y otro para el ngulo .
2. La figura siguiente es la analoga elctrica aproximada de un sistema trmico,
donde C1 y C2 son capacidades trmicas de dos masas, R3 es la resistencia al paso de calor
entre ambas masas, mientras que R1 y R2 son resistencias al flujo de calor entre las masas y
la fuente de calor.
Determinar a) Modelo de estado-espacio, tomando al voltaje en los capacitores
como las variables de estado y que existe un sensor de temperatura en la masa 1; y b)
Respuesta al escaln unitario, si R1 = R2 = 20, R3 = 50, C1 = 10 y C2 = 5. Las R tienen
unidades fsicas de grado-s/calora, y las C, de calora/grado.
KQ/Jd = 30 seg-2
KD/Jd = 20 seg-2
Grupo 9A1M
A pgina 25 de 26
ESIME ZACATENCO
Ao
TEORA DE CONTROL IV
0
1
0
0
0
0
0
1
=
20 30
8
1500
30 20 1500 8
Las races de Ao se obtienen con el comando eig(Ao):
-8.0251 1500.016i
0.020 0.01342i
Respuesta del girscopo sin captura
Obtener con MATLAB la respuesta a un escaln unitario en xE para corroborar la
inutilidad de un girscopo sin sistema de captura pues presenta dos dificultades serias: la
primera es que una excitacin en uno de los ejes afecta a ambas salidas; la otra es que el
girscopo responde como si fuera un integrador, de manera muy lenta.
Segn indican las races de lazo abierto el girscopo sin captura es inestable. Para
remediar tal situacin se puede agregar amortiguamiento viscoso pero para lograr la
estabilidad se pagara un precio muy alto pues el sistema se hara de respuesta demasiado
lenta.
Respuesta del girscopo con captura
Si el vector de control se genera mediante: Kx, y si hacemos que K presente
ciertas simetras para desacoplar los movimientos de rotacin en ambos ejes, modificamos
mediante ensayos el valor tentativo de K:
K
22
1500
605 30
30 605 1500 22 J d
Grupo 9A1M
A pgina 26 de 26