Documentos de Académico
Documentos de Profesional
Documentos de Cultura
- MARCO TEÓRICO
En esta sección se desarrollará el modelamiento del sistema esfera bobina, así como la
Todos los sistemas que utilicen levitación magnética para sustentar elementos
ferromagnéticos deben contar, por lo menos, con dos elementos: un sistema eléctrico,
constituido por una fuente variable de voltaje y una bobina; un sistema electromecánico,
J1
1 R.
. V(t)
1
i(t)
J2 .L
.
Fm
Fg
Donde:
m es la masa de la esfera,
k es el coeficiente de fricción viscoso, Fb= fuerza de fricción magnética
g es la aceleración de la gravedad, Fg=mg
F(y,i) es la fuerza generada por el solenoide,Fm
i es la corriente eléctrica.
8
En la Figura 4-1 se presenta un esquema de la planta a controlar. A continuación se
planta:
La ecuación 4-1 expresa la suma de voltajes alrededor del lazo cerrado; la ecuación 4-2
4-3 se expresa la ecuación de equilibrio para las fuerzas presentes. La variable que
= v ec.4.5
= + = + ec.4.6
características del sistema a trabajar, esto es, masa de la esfera 66 gramos, y punto de
L 0 =0.155 H,
L 1 =0.258 H,
g=9.81 m/s 2 ,
R=12.79 Ω ,
a = 0.00825.
9
Donde L0, L1 y a son constantes positivas. En la ec.4.6 Puede verificarse fácilmente que
el modelo presentado considera que la inductancia es máxima (L0+L1) cuando la pelota
está más cerca del solenoide y decrece a L0 cuando no hay pelota (x= ).
De las ecuaciones 4.1 a 4.6 se obtiene el modelo en variable de estado que se presenta
a continuación:
̇ =
̇ =− ∗ ∗ +
= ( − ∗ +[ ∗ ∗ ∗ ] ec.4.7
Una vez que se linealiza el modelo alrededor del punto de equilibrio, (5 mm), y
= [ ] , = , ̅= . [ ], = . [ ]
̇ = . . ∗ +
− . − . .
=[ ]∗ ec.4.8
corriente, respectivamente.
Una de las primeras cosas que queremos hacer con las ecuaciones de estado es encontrar
los polos del sistema; estos son los valores de s donde det(sI - A) = 0, o los eigenvalores
de la matriz A:
S 1 = 0.0756,
S 2 = -18.6878 +74.2629i,
Para verificar qué sucede con este sistema inestable en condiciones iniciales no nulas,
4.3.1 Introducción
control ubicación de polos. Asumimos que las variables de estado son medidas y
controlable, y que los polos en lazo cerrado del sistema son reemplazados por polos
deseados del sistema de lazo cerrado con una apropiada matriz de realimentación de
estados. La presente técnica de diseño empieza con la ubicación de los polos en lazo
cuidado que el sistema deseado no presente una señal de control grande, porque puede
Por otro lado se debe escoger una matriz de ganancia de estados realimentada apropiada
Donde
- x(k) es el vector de estado (vector-n) en k- eximo instante de muestreo.
- u(k) es la señal de control (escalar) en k-eeximo instante de muestreo.
- G es la matriz de n × n.
- H es la matriz de n×1.
12
Asumimos la magnitud de la señal de control u(k) ilimitada. La señal de control es:
Se debe de observar que los valores propios de (G − HK) son los polos deseados µ1 , µ2 ...
En lazo cerrado
sistema de control en tiempo discreto es el mismo que en tiempo continuo. Estos método
y donde, αi i=1,2,...n son los coeficientes de la ecuación característica deseada del sistema
13
La matriz T es dada por.
T = MW (7)
matriz de transformación T es una matriz identidad. En este caso la matriz K se escribe como.
Donde T = I.
Dónde.
M = [H.GH. . . . .Gn-1
Además .
14
La matriz de estados realimentados K es determinado cuando el error es reducido a cero con
suficiente velocidad. Note que la matriz K no es única para el sistema dado, pero depende
de la ubicación de los polos deseados en lazo cerrado. La selección de los polos deseados o
de la velocidad del error entonces el efecto adverso del disturbio y medidas de ruidos estos se
incrementan.
determinante de (sI-(A-BK)).
Como las matrices A y B*K son ambas 3 por 3, el sistema tendrá 3 polos.
Usando realimentación completa de estado podemos ubicar los polos donde queramos.
Podríamos usar la función place para hallar la matriz de control, K, la cual nos dará los
polos deseados.
Antes de probar este método, tenemos que decidir dónde queremos que estén los polos
15
tiempo de establecimiento < 0.5 seg.
Entonces trataríamos de ubicar los dos polos dominantes en -10 +/- 10i (en zeta = 0.7 o
45 grados con sigma = 10 > 4.6*2).
El tercer polo lo ubicaríamos en -100 para empezar, y podemos cambiarlo luego
dependiendo en cómo es el comportamiento a lazo cerrado.
Borre el comando lsim de su archivo-m y todo lo demás después del mismo, entonces
agregue las líneas siguientes a su archivo-m,
A=[0 1 0;11.89 0 55.2; 0 -106.4 -37.3];
B=[0; 0; 2.9];
C=[1 0 0];
D=[0];
POLES=eig(A)
t = 0:0.001:1;
u = 4.54*t;
x0 = [5 0 0.355];
p1 = -10 + 10i;
p2 = -10 - 10i;
p3 = -100;
K = place(A,B,[p1 p2 p3])
lsim(A-B*K,B,C,0,u,t,x0);
Figura 4-4 Respuesta del sistema con control por ubicación de polos
16
4.4.2 Eliminación de sobre pico y simulación
estado). Trate de poner los polos más lejos a la izquierda para ver si mejora la respuesta
Figura 4-5 sistema mejorado con ubicación de polos más alejados del eje imaginario
entrada (elegimos un valor chico para el escalón, de modo que permanezcamos en la zona donde
lugar medimos todos los estados, multiplicamos por el vector ganancia K, y entonces
restamos el resultado de la referencia. No hay razón para esperar que K*x vaya a ser
igual a la salida deseada. Para eliminar este problema, podemos escalar la entrada de
referencia para hacerla igual a K*x_ss (ss: estado estacionario). Este factor de escala se
Podemos obtener Nbar de Matlab usando la función rscale (Copie la siguiente línea de
Nbar=rscale(A,B,C,0,K)
Note que esta función no es estándar en Maltaba necesitará copiarla a un archivo-m nuevo para
usarla. Ahora, si queremos hallar la respuesta del sistema bajo realimentación de estados con la
18
introducción de la referencia, simplemente notemos el hecho de que la entrada está multiplicada
lsim(A-B*K,B*Nbar,C,0,u,t)
Figura 4-6 Respuesta del sistema en lazo cerrado con entrada escalón unitario
19
4,5 Discretizacion del sistema levitador magnético
y el 'method'.
El tiempo de muestreo debería ser menor que 1/(30*BW) seg., donde BW es el ancho
Asumiendo que la frecuencia del ancho de banda a lazo cerrado anda en 1 rad/seg. tanto
Ya estamos listos para usar c2dm. Ingrese los siguientes comandos a un archivo-m.
G=
1.0006 0.0091 0.0023
0.1086 0.7524 0.4171
-0.0535 -0.8041 0.4700
H=
20
0.0000
0.0068
0.0219
C=
1 0 0
D= 0
( + ) . . . ( ) .
( + ) = . . . ( ) + . ( )
( + ) − . − . . ( ) .
( )
( )=[ ] ( )
( )
=[ ]
columnas).
de observabilidad
de ambas matrices debe ser 3. La función rank puede darle el rango de cada matriz. En
comandos.
Observability = 3
Consideremos un diseño de control digital para una planta de tipo 0. EL controlador digital
v(k)=v(k-1)+r(k)-y(k)
Entonces
Obtenemos:
22
También.
Para una entrada escalón, como k se aproxima al infinito, xk, uk, y vk aproxima un
v(∞)=v(∞)+r(∞)-y(∞)
o
y(∞)=r(∞)=r
No hay estado estacionario. Sustituimos k = ∞ en la ecuación anterior, con ello
obtenemos.
Definimos:
Entonces tenemos:
23
Definimos
Finalmente obtenemos
Dónde.
Usamos las líneas de código para encontrar las matrices de estado en lazo cerrado
G1= [G zeros(3,1)
-C*G 1 ]
H1=[ H
-C*H]
Obtenemos la ecuación de estado en lazo cerrado es:
w(k)
24
4.5.3.1 Matrĺz de Controlabilidad y Polos deseados discreto
% controlabilidad
rankM=rank(M)
Ts=0.01;
zeta=0.7;
wn=4.6/(Ts*zeta);
u1=exp((-zeta*wn+1j*wn*sqrt(1-zeta^2))*Ts);
u2=conj(u1);
u3=0.95;
u4=0 .05;
25
4.5.3.2 Diseño del Controlador discreto
J = [u1 0 0 0
0 u2 0 0
0 0 u3 0
0 0 0 u4];
La ecuación en lazo cerrado integra las ganancias de estado e integral halladas previamente.
. . . .
( + ) − . . . . ( )
= + rk)
( + ) − . − . − . . ( )
− . − . − . . .
( )
( )=[ ] ( )
Transfer function:
La respuesta del sistema en lazo cerrado debido a una entrada escalón unitario se
muestra en la Figura.
tk=0:Ts:8;
u=ones(size(tk));
yd=lsim(F,u,tk);
plot(tk,yd)
title('Respuesta del sistema ante una entrada escalon')
ylabel('desplazamiento en mm')
xlabel(' time en seg')
grid
27
Figura 4.9 respuesta del sistema ante escalón unitario
En esta sección se describen cada uno de los pasos necesarios para el desarrollo de un
detallan cada una de las partes y las dimensiones que componen el sistema de levitación
A continuación se describirá de forma detallada cada uno de los modelos que componen
los bloques
28
Figura 4.10 14. Diagrama de bloques del Levitador Magnético
para evitar el desvió de las líneas del campo magnético. Haciendo consideración de los
de ser un material plástico cumple con la rigidez necesaria para nuestra aplicación, es no
Largo 24
Ancho 16
espesor 1/4
La idea básica de la estructura del prototipo se muestra en la Figura 4.11. El soporte está
conformado de seis piezas: una base superior, la cual es utilizada como soporte del
actuador; dos paredes laterales donde son colocadas las dos partes que constituyen el
29
sensor de posición; una pared trasera que es utilizada para simular un cubo y además
ayudar a la base superior con el peso del actuador; una base inferior que da soporte al
conjunto de piezas antes mencionadas; y dos piezas pequeñas que son colocadas debajo
de la base inferior con el fin de elevar la plataforma unos centímetros extras. Las
dimensiones de cada una de las piezas que constituyen al soporte fueron elegidas
considerando el ´área suficientes para cada una de las partes que constituyen un
levitador magnético. En la Tabla 4.2 se muestran las dimensiones de cada una de las
piezas.
30
4.6.2. Actuador
1.54in de dinámetro, el cual está constituido por 600 vueltas de cable de cobre del No.
4.6.3. Sensor
La selección de los sensores viene a ser de suma importancia, ya que no es posible hacer
levitar una esfera de material ferromagnéticos sin un buen sensado de la posición en que
De entre varios sensores estudiados fueron elegidos el clásico Diodo Emisor de Luz
de luz infrarroja azul transparente de 5mm de diámetro, con longitud de onda de 440nm,
señalar que el filtro de luz con el que cuentan los opto transistores utilizados para el
dise˜no del sensor no elimina en su totalidad el error causado por los efectos de la luz
ambiente sobre ´el, debido a que el material utilizado para el soporte base es
transparente y la retención de luz es muy escasa. Para la eliminación del error por causa
de la luz ambiente, viene a ser necesario el diseñar de un circuito capaz de eliminar este
error.
sensado de la posición
posici´on del objeto a levitar. Como se puede apreciar, el circuito cuenta con un diodo
Inicialmente por razón de la distancia y la luz ambiente que es incidida, evita que la luz
emitida por el IRED sea recibida en un 100 % en los optotransistores, dando as´i una
Eliminación del error inicial. El error de valor inicial es el primer problema a resolver.
Por lo que, se ha hecho la suma del error en cada optotransistor, el cual da un valor
32
aproximado de 3.6v. Este error es eliminado implementando un circuito restador con
y la otra entrada es se˜nal de referencia constante de 3.6v, con esto el error es eliminado
y aproximado a cero.
posición en que se encuentra la esfera de hierro. Este circuito esta constituido por un
colocada la señal de error proveniente de los sensores, donde la diferencia entre ambas
que son causados por los efectos de la luz ambiente sin la presencia de la esfera de
= +
33
Donde Vs1 y Vs2 son los voltajes medidos en los optotransistor 1 y 2 respectivamente.
Vb = 2Vref1- Va
El voltaje de salida del circuito mostrado en la Figura 4.13 es considerado como el error
de posición e(t) el cual está dado por la diferencia de Xo y X(t), por lo que el error de
e(t) = X0 - X(t),
Sensor de velocidad
mS
El derivador aproximado fue construido con base en integradores, los cuales son menos
propensos a los ruidos que los primeros. El filtro de salida se construyó como la
configuración de un RC serie.
C. Sensor de corriente
Para su construcción se utilizó un sensor de efecto hall análogo lineal, el cual posee un
rango de funcionamiento de ± 900 Gauss, con una salida de 0 a 5 voltios y cero campo
en 2.5 voltios. La corriente que se desea medir pasa por una pequeña bobina de
medición, la cual se encuentra arrollada alrededor de un núcleo en forma de toroide;
esta corriente crea un campo que gira alrededor del núcleo, el cual posee una ranura en
la que se instala el sensor de efecto hall; de esta manera la lectura de corriente se
traduce a campo y este finalmente en voltaje. El número de vueltas de la bobina de
medición es tal que la corriente máxima de operación del sistema corresponda a la mitad
de la salida máxima del sensor, es decir 1.25 voltios. Un diagrama de este montaje
puede verse en la Figura 4.15.
35
Figura 4.15. Sensor de corriente
diagrama de Bode del sensor; en este caso se introdujo una señal de corriente senoidal
(electroimán).. Se ha cuidado aislar la etapa del circuito que maneja potencia de las
etapas de baja potencia para evitar ruidos inducidos, interferencias o posibles voltajes
Este módulo es de vital importancia para el manejo del electroimán ya que este se
aislamiento total del circuito de control para evitar problemas de ruido y transientes que
36
continuación se mostrara el diagrama circuital y una explicación detallada de cada una
Como se menciono antes este circuito cumple con dos funciones: aislamiento y
potencia. La primera está compuesta por el optoacoplador que tomará una señal de
entrada desde la terminal 1 para excitar el LED que esta en su interior y a su ves el
fototransistor, este por su lado cumple con la puesta a tierra de la resistencia R4,
llevando así la base del transistor Q1 a tierra y por tanto poniendo el transistor en corte.
Cuando el transistor interno del optoacoplador esta en corte entonces en la base del
resistencia R4 y R5, este voltaje es suficiente para excitar la compuerta del transistor Q1
y poner el mismo en saturación y permitir que por la bobina circule una gran corriente;
protección contra sobre voltajes para evitar que Q1 se dañe debido a que el voltaje
máximo que tolera es de 20 V. El diodo D1 es un diodo Schottky que está dispuesto allí
37
para evitar que las corrientes transitorias de la bobina dañen el transistor, se escogió un
diodo de este tipo debido a que se requiere que la velocidad de conmutación sea lo mas
rápida posible para evitar que pasen corrientes a través del mismo cuando el circuito
Aparte de esto se logra notar que está dispuesta una pequeña fuente de poder, la misma
será utilizada para alimentar un cooler que enfriara el disipador tanto del propio
Este es una de las partes más importantes de todo el sistema debido a que es quien
módulos. Este módulo aunque esta descrito como un solo bloque en si está compuesto
por dos circuitos aislados totalmente uno de otro, para efectos de este proyecto debido a
de soporte que servirá para la alimentación del resto del circuito, el por qué de esto se
que se van a manejar amperajes que están por encima de los 10 amperios y se manejaran
cargas inductivas, entonces se quiere evitar que los picos inducidos por la corriente
de control, así como en el peor de los casos pudiera dañarlo y estropear todo. A
38
Figura 4.17. Fuente de alimentación para el electroimán.
rectificador tolera una corriente máxima de 35 amperios y debe llevar consigo un buen
bastante, los condensadores son 8 de 15000uF por 50V que suman unos 120000uF más
entrada, el por que de esta capacitáncia tan alta se debe a la cantidad de corriente que
deberá pasar por la terminal Vo lo que sugiere un descarga muy violenta de los
capacitares cuando el la señal saliente del rectificador comienza a bajar desde su valor
pico hasta cero. Cabe destacar que en este circuito no se muestra ningún otro elemento
de regulación de voltaje, esto se debe a que para evitar la mayor cantidad de perdidas
(MOSFET para este caso), esta parte será descrita con más detalle en el módulo de
potencia.
39
Por otro lado en el diagrama siguiente figura 4.18 se explicara los elementos que
Como se logra apreciar esta es una fuente de poder dual, esto se debe a que en el
En este circuito de la figura 4.18 se puede apreciar tres etapas: rectificación, filtrado y
regulación. La primera consta del puente rectificador que obtiene el valor absoluto de la
rectificador le sigue dos condensadores de 100uF que harán que se obtenga una señal
completamente recta, esta a su ves será la entrada del circuito de regulación compuesto
popular con una entrada de hasta 37V y una salida regulada de 5 voltios, en la terminal
regulador (es requerido) y los diodos D1 y D2 son diodos de protección para conducir
las corrientes que circulen en sentido contrario a tierra mediante el diodo D1 y los
sobrevoltajes (voltajes por encima del voltaje que se encuentra en la terminal 1 del
40