Professional Documents
Culture Documents
CONTROL
Raúl Ramírez López
Proyecto:
“Levitador
magnético”
Integrantes de equipo
• Adrián González Rivera
• Olvera Enríquez Evelyn
• Pérez Mora Mariano
17/06/2009
Levitador Magnético Control
Ingeniería Mecatrónica
LEVITADOR MAGNÉTICO.
2
Levitador Magnético Control
Ingeniería Mecatrónica
Ahora analizando el electroimán, se
tiene únicamente un circuito RL en
serie, por lo que su ecuación es:
di (t )
v (t ) = Ri (t ) + L (7)
dt
Entonces ya se puede proceder a
escribir las ecuaciones que gobiernan el
sistema.
d2y K i 2 (t )
=g− (8)
dt 2 m y 2 (t )
di (t ) 1 R
= v (t ) − i (t ) (9)
dt L L
3
Levitador Magnético Control
Ingeniería Mecatrónica
∂f y0 (t ) = 0
&& (11)
K1 =
∂y y0 ,i0
El valor de i(t ) , se puede obtener
∂f
K2 = sustituyendo en la ecuación (11) en la
∂i y0 ,i0 ecuación (8).
Es importante recordar que este modelo
matemático será usado para el análisis y mgx102
el diseño, puede representar con i0 (t ) = x30 (t ) = (12)
K
precisión la dinámica de un sistema real
para ciertas condiciones de operación,
Al sustituir (12) en la ecuación (9)
pero puede no ser preciso para otras.
Después de aplicar el método de
linealización, podemos escribir las 0 1 0
ecuaciones en forma matricial.
Ahora ya se conocen las ecuaciones del
2g 0
sistema, definiendo las variables de A= −
2 gK (13)
estado. x10 x10 m
0 0 R
x1 = y (t ) −
L
x2 = y& (t )
x3 = i(t )
0
De acuerdo con lo anterior las B = 0 (14)
ecuaciones de estado quedan como: 1
L
x&1 = x2
k x&32 Con lo anterior, se puede escribir la
x&2 = g − matriz de transición de estados.
m x&12
x&3 = −
R 1
x3 + v x& = Ax + Bu(t )
L L
Y la salida corresponde a la posición de
Linealizando cada una de las la esfera.
ecuaciones, la matriz A es: y = x1
Por lo tanto, en forma matricial, la
0 1 0 salida del sistema viene dada por:
K x 2 0 K x30 y = [1 0 0 ] x + 0u(t ) (15)
A = 2 30 −2 (9)
m x10
3
m x10 2
0 Donde:
0 R
−
L C = [1 0 0] , D = 0. (16)
4
Levitador Magnético Control
Ingeniería Mecatrónica
puede proceder a realizar las pruebas de el par [ A , B ] es controlable, lo que
controlabilidad y observabilidad. implica que S es de rango n.
La comprobación de este teorema se
Controlabilidad puede encontrar en casi cualquier libro
de control, por lo tanto se procederá a
Un sistema es completamente realizar los cálculos correspondientes
controlable si cada variable de estado de para verificar la controlabilidad del
dicho sistema se puede controlar para levitador magnético.
llegar a un cierto objetivo en un tiempo
finito, a través de algún control no Para determinar si el sistema es
restringido. Más aún, si se considera un controlable solo se necesitan conocer
sistema lineal e invariante en el tiempo, las matrices A y B.
descrito con las ecuaciones dinámicas: Al sustituir las ecuaciones (13) y (14)
en (18), se obtiene:
x& (t ) = Ax(t ) + Bu(t ) (17)
y (t ) = Cx(t ) + Du(t ) (18) 2 gK
0 0 −
x10 L m
“Se dice que el estado x(t ) es
2 R Kg
controlable en t = t0 si existe una S = 0 −
2 gK
entrada continua por intervalos u(t ) que x10 L m x10 L2 m
moverá al estado a cualquier estado 1 R R2
−
final x (t f ) en un tiempo finito ( L L2 L3
(t f − t0 ) ≥ 0 . Si cada estado x(t0 ) del (20)
sistema es controlable en un intervalo
de tiempo finito, se dice que es un Para que el sistema sea controlable la
sistema de estado completamente matriz de controlabilidad, debe ser de
controlable o simplemente controlable.” rango n, es decir, para este caso debe
tener tres renglones linealmente
1 independientes. Para comprobar la
TEOREMA 1:
Para que el sistema descrito por la independencia lineal basta que:
ecuación de estado de la ecuación (17)
sea de estado completamente det(S) ≠ 0 (21)
controlable, es necesario y suficiente
que la siguiente matriz de Realizando el cálculo del determinante
controlabilidad n × nr tenga rango n : de la matriz de controlabilidad, se
obtiene:
S = [B AB A 2 B L A n−1B ] (19)
4 gK
det(S) = − (22)
Ya que las matrices A y B están L3 mx102
involucradas, algunas veces se dice que
De acuerdo con la ecuación (21) el
sistema es linealmente independiente es
decir no singular, y por lo tanto el
1
El teorema 1, corresponde al teorema 5-1 del sistema es completamente controlable.
libro “Sistemas de control automático” de
Benjamín C. Kuo. Observabilidad.
La demostración puede ser consultada en la
página 150 del libro “Control automático y
sistemas dinámicos” de R. Canales Ruiz.
5
Levitador Magnético Control
Ingeniería Mecatrónica
Esencialmente, un sistema es C
completamente observable si cada CA
variable de estado del sistema afecta V = CA 2 (23)
alguna de las salidas. Si cualquiera de
los estados no se puede observar a partir M
de las mediciones de las salidas, se dice CA n−1
que el estado es no observable, y el
sistema no es completamente Para el sistema del levitador magnético
observable, o simplemente no se cuenta con una sola salida, entonces
observable. C es una matriz renglón de 1 × n ; V es
una matriz cuadrada de n × n . Entonces
Dado un sistema lineal e invariante con el sistema es completamente observable
el tiempo que se describe mediante las si V, es no singular.
ecuaciones dinámicas de las ecuaciones
(17) y (18). Al igual que para la controlabilidad, la
demostración no se expone aquí, pero
“Se dice que el estado x(t0 ) es puede ser consultada en algún libro de
observable si dada cualquier entrada control.
u(t ) , existe un tiempo finito t f ≥ t0 tal
Al sustituir las ecuaciones (14) y (16)
que del conocimiento de u(t ) para en la ecuación (23). Se obtiene:
t0 ≤ t < t f , las matrices A, B, C y D; y
la salida y (t ) para t0 ≤ t < t f son
suficientes para determinar x(t0 ) . Si 1 0 0
cada estado del sistema es observable V= 0 1 0 (24)
para un tiempo t f finito, se dice que el 2g 2 gk
x 0 −
sistema es completamente observable, o
10 x10 m
simplemente observable.”
Ahora, de acuerdo con el teorema 2,
El siguiente teorema demuestra que la
para que el sistema sea completamente
condición de observabilidad depende de
observable, la matriz de observabilidad
las matrices del sistema A y C. El
debe ser de rango n, es decir, para este
teorema también proporciona un
caso debe tener tres renglones
método para probar la observabilidad.
linealmente independientes. Para
2 verificar la independencia lineal es
TEOREMA 2:
suficiente que:
Para que el sistema descrito por las
ecuaciones (17) y (18) sea
det(V) ≠ 0 (25)
completamente observable, es necesario
y suficiente que la siguiente matriz de
observabilidad de n × np tenga un rango Al realizar las operaciones
correspondientes para calcular el
n:
determinante de la matriz de
observabilidad se tiene:
2
El teorema 1, corresponde al teorema 5-4 del
libro “Sistemas de control automático” de 2 gK
Benjamín C. Kuo.
det(V ) = − (26)
x10 m
La demostración puede ser consultada en la
página 154 del libro “Control automático y
sistemas dinámicos” de R. Canales Ruiz.
6
Levitador Magnético Control
Ingeniería Mecatrónica
En consecuencia, los renglones de la
matriz son linealmente independientes,
{
L CetA Bu (t ) + Dδ (t )} = C ( sI − A ) B + D
−1
H ( s ) = C ( sI − A ) B + D
−1
Anteriormente se ha mencionado que el (31)
levitador magnético es un sistema lineal
e invariable en el tiempo, gracias a esto Al sustituir los valores de las matrices
se sabe que la relación, entrada-salida, A, B, C y D, en la ecuación (31), se
cuando el estado es cero es: tiene lo siguiente:
t
y (t ) = ∫ h(t − σ )u(σ )dσ (27) 2 R R
0 s + Ls s+
L c
De acuerdo con las propiedades de la − 2
convolución, la ecuación (27), queda: ∆ ∆ ∆
R R 0
sC1 + L C1 s + L s
2
sC2
Y( s ) = H ( s )U( s ) H(s) = [1 0 0] − 0
(28)
∆ ∆ ∆
1
s2 −C1
0 0 L
Como se conocen las matrices Y( s ) y ∆
U( s) , la matriz de transferencia es:
(32)
H( s) = Y( s)U−1 (s) (29)
Donde:
R 2 R
Donde la existencia de U−1 (s) está ∆ = s3 + s − c1s + c1
L L
garantizada por la independencia lineal 2g
de los vectores ui . C1 =
x10
2 gK
Si se considera ahora el sistema dado C2 =
por las ecuaciones (17) y (18). x10 m
{
La cual nos representa la función de
Pero: L e t A } = ( s I − A ) −1 transferencia del sistema.
7
Levitador Magnético Control
Ingeniería Mecatrónica
La función de transferencia de los La ecuación anterior, tiene una
sistemas lineales, invariables, y de representación de polos y ceros, como
razón n, es la razón de dos polinomios se muestra en la figura 3.
en s, con coeficientes constantes. ×
a( s) = am ( s − z1 )( s − z2 )( s − z3 )...( s − zm )
b( s) = ( s − p1 )( s − p2 )( s − p3 )...( s − pn )
Figura 3. Gráfica de polos y
Donde los números zi y pi , son ceros
números complejos. Como es sabido, si
los coeficientes de los polinomios son Obtención de la respuesta al impulso
reales, las raíces complejas deben a partir de polos y ceros.
aparecer en pares conjugados.
Dichos números complejos, junto con
am , caracterizan completamente la Una manera de encontrar la
transformada inversa de Laplace de una
función de transferencia del sistema. función racional era mediante la
expansión en fracciones parciales. En el
Los números pi , se denominan polos caso de polos simples y cuando m > n :
del sistema y los zi , ceros del sistema.
Ambos pueden representarse de forma
gráfica usando la siguiente convención: ( s − z1 )( s − z2 )( s − z3 )...( s − zm )
H( s) =
( s − p1 )( s − p2 )( s − p3 )...( s − pn )
× representa los polos, y Ο representa (36)
ceros.
Los parámetros A1 , A2 ,... An , se
Entonces, a excepción de la constante
determinan multiplicando H( s) por
am , un sistema puede ser representado
(s − pi ) y evaluando s, en el punto pi , o
en el plano complejo, por un conjunto
de polos y ceros. sea:
8
Levitador Magnético Control
Ingeniería Mecatrónica
1
A1 = (180° + 180°)
R R
− c1 + c1
L L
(38) 1
Las funciones exponenciales que A1 = 2
(39)
R
+ c1
aparecen en la expresión anterior están
determinadas por los polos del sistema. L
Más aún la respuesta al impulso de un
sistema con una función de
transferencia H( s) es una combinación Para A2 :
pi t
lineal de las funciones e , donde pi ,
es un polo de H( s) .
Para A3 :
Figura 4.
Figura 5.
9
Levitador Magnético Control
Ingeniería Mecatrónica
1
A3 = (0° + 0°) No obstante éste punto será tratado, de
R
+ c1 ( 2c1 ) una forma más detallada, considerando
L
la relación entrada-salida del sistema,
1
A3 = (41) basándose en el estudio que realizó
2R
c1 + 2c1 Nyquist, en el cual se considera que un
L sistema es estable cuando la salida no
crece indefinidamente debido a entradas
pequeñas.
De acuerdo con la ecuación (38), y
tomando en cuenta el valor de la Un sistema dinámico es estable en el
constante am , la respuesta impulsional sentido entrada-salida, si estando en
del sistema es: reposo:
R
− t
c e L
e − c1 t
e c1 t
i. Cualquier entrada acotada,
h(t ) = − 2 − + u(t )
L R produce una salida acotada.
2
2R 2R
+ c1 L c1 − 2c1 L c1 + 2c1
L
(42) u (t ) < M ∀t ⇒ y (t ) < N ∀t
Para M y N constantes.
∀ε , δ ∋ u ( t ) < ε ⇒ y (t ) < δ ∀t
10
Levitador Magnético Control
Ingeniería Mecatrónica
11
Levitador Magnético Control
Ingeniería Mecatrónica
Controlador
PI D
12
Levitador Magnético Control
Ingeniería Mecatrónica
13
Levitador Magnético Control
Ingeniería Mecatrónica
14
Levitador Magnético Control
Ingeniería Mecatrónica
Aplicando el Criterio de Routh:
Para poder estabilizar el sistema Cubriendo las constantes para que todos
realizara el método de Routh: los coeficientes de la primera columna
sean positivos los valores son:
Para poder estabilizar el sistema se
utiliza criterio de Routh. No obstante 0 $59.46
una sola constante no es suficiente para 0 $0.303
estabilizar el sistema.
(1) Controlador PI
$2477 $ 24775
34
150 $ 982 $ 147300 2477 $ 24775
!"#
1
!"# (3)
Con esta ecuación se procede a aplicar el
criterio de Routh, para determinar los
valores de K que hacen estable el
Sustituyendo (1) y (2) en (3) la nueva sistema.
función de transferencia viene dada por:
1 $982 $24776
150 $7147300 24778 9 0
$2477 $ 2477
1 24778
150 $ 982 $ 147300 $ 2477 $ 2477 $24776
150
15
Levitador Magnético Control
Ingeniería Mecatrónica
L = 0.04; K = 0.01; X10 = 0.02;
Al obtener los valores para las X3 = X10 * sqrt(m *g/K);
constantes se tiene:
Kp =-61;
Kd =0.5;
5 0 0 Ki =-1;
0 $59.46
%Para facilitar la captura y el
No obstante el sistema sigue siendo calculo%
a1 = 2*g / X10; a2 = -
inestable, por lo que se procede a (2/X10)*sqrt(g*K/m);
conectar ambos controladores en
cascada, y usando los mismos valores %Introduciendo Matrices del
encontrados para las K. Sistema%
A = [0 1 0; a1 0 a2; 0 0 -R/L];
B = [0; 0; 1/L];
Ref e u
(t) H( y
C = [1 0 0];
P P S) D = 0;
Plant=ss(A,B,C,D)
16
Levitador Magnético Control
Ingeniería Mecatrónica
Bibliografía:
17