Documentos de Académico
Documentos de Profesional
Documentos de Cultura
Director
LUIS ANGEL SILVA
Ing. Electrnico
DEDICATORIA
CONTENIDO
Pg.
INTRODUCCIN
13
14
14
1.2. JUSTIFICACIN
14
1.3. OBJETIVOS
14
14
14
2. MARCO TEORICO
15
15
16
16
16
16
16
17
18
19
19
19
23
25
25
25
28
28
29
30
32
36
38
42
43
47
50
4. CONCLUSIONES Y RECOMENDACIONES
52
BIBLIOGRAFIA
53
LISTA DE TABLAS
Pg.
Tabla 1. Seleccin de Componentes
Tabla 2. Regla de sintonizacin de Ziegler-Nichols basada en la ganancia
crtica
y periodo crtico
(segundo mtodo)
Tabla 3. Formula Sintonizacin bajo Control P (rpido)
Tabla 4. Formula Sintonizacin bajo Control P (normal)
Tabla 5. Formula Sintonizacin bajo Control P (lento)
Tabla 6. Formula Sintonizacin bajo Control PI o PID (rpido)
Tabla 7. Formula Sintonizacin bajo Control PI o PID (normal)
Tabla 8. Formula Sintonizacin bajo Control PI o PID (lento)
25
43
54
54
54
55
55
55
LISTA DE FIGURAS
Pg.
Figura 1. Sistema Ball and Beam
Figura 2. Entrenador CE106
Figura 3. Entrenador RT 121
Figura 4. Entrenador SRV02
Figura 5. Trazado del Sistema
Figura 6. Circuito equivalente de un servomotor controlado por armadura
Figura 7. Diagrama del servomotor cc controlado por armadura
Figura 8. Soporte de Servomotor
Figura 9. Base del Sistema
Figura 10. Vistas de la Estructura
Figura 11. Sistema Ball and Beam Construido
Figura 12. Tarjeta TAD
Figura 13. Esquema Tarjeta Electrnica
Figura 14. Tarjeta Electrnica
Figura 15. Mensaje 1 HMI
Figura 16. Interfaz de Usuario
Figura 17. Seal de Setpoint
Figura 18. Mensaje 2 - HMI
Figura 19. Sensor GP2D120
Figura 20. Voltaje Sensores vs. Posicin
Figura 21. Curvas Sensores Curvas Ecuaciones
Figura 22. Ruido Seal Entrada
Figura 23. Error de Posicin debido al ruido
Figura 24. Seales para identificar el sistema
Figura 25. Resultado del Modelo Estimado
Figura 26. Respuesta al escaln, sistema en lazo abierto
Figura 27. Diagrama de bloques del sistema.
Figura 28. LGR, planta Ec. (15), controlador P,
Figura 29. Respuesta escaln unitario, planta Ec. (15), controlador P,
Figura 30. LGR, planta Ec. (15), controlador P,
Figura 31. Respuesta escaln unitario, controlador P,
Figura 32. Control PID de una planta
Figura 33. LGR, planta Ec. (15), controlador Ec. (19)
Figura 34. Respuesta escaln unitario, controlador PID;
,
,
Figura 35. Respuesta escaln unitario, planta Ec. (15), controlador Ec.
(20)
13
17
18
18
21
24
24
26
26
27
27
28
29
29
30
31
31
32
33
33
34
35
35
36
37
38
38
39
40
40
41
43
44
45
46
47
48
49
50
51
51
LISTA DE ANEXOS
Pg.
Anexo 1. Formulas Sintonizacin
54
GLOSARIO
TTULO:
AUTOR(ES):
FACULTAD:
DIRECTOR:
RESUMEN
En este proyecto se presenta la construccin de un sistema Ball and Beam,
para validar estrategias bsicas de control tipo P, PI y/o PID, adems de una
interfaz de usuario desarrollada en Labview donde el usuario puede
interactuar con el sistema y realizar la autosintonizacin del controlador.
Se muestra el modelado matemtico de un sistema Ball and Beam
convencional, la construccin de un prototipo, el desarrollo de la interfaz de
usuario, el acondicionamiento de las seales de entrada, el diseo del
controlador y la validacin del mismo.
PALABRAS CLAVES:
Ball and Beam, Control PID, Labview, Servomotor,
Sensor Infrarrojo, TAD.
TITLE:
AUTHOR(S):
FACULTY:
ADVISER:
This project presents the construction of a Ball and Beam system, to validate
basic control strategies such P, PI and/or PID, also a user interface
developed in Labview where the user can interact with the system and
perform the autotune the controller.
Shows the mathematical model of a Ball and Beam conventional, the
construction of a prototype, the development of user interface, the
conditioning of the input signals, the controller design and validation.
KEY WORDS:
Ball and Beam, Control PID, Labview, Servomotor,
Infrared Sensor, TAD.
INTRODUCCIN
13
1.3. OBJETIVOS
1.3.1.
Objetivo General
1.3.2.
Objetivos Especficos
Disear y construir un sistema Ball and Beam.
Desarrollar una HMI en Labview para manipular el sistema.
Disear una estrategia de control para el sistema.
14
2. MARCO TEORICO
Antes de anotar cualquier especificacin conviene empezar definiendo el
propio sistema Ball & Beam. ste simplemente consiste en el movimiento de
una bola por el interior de una viga en forma de carril sujeta al eje de un
motor elctrico que le permite girar alrededor de su eje (Figura 1). El objetivo
que se pretende es controlar la posicin de la bola cambiando el ngulo de
inclinacin de la viga. Esta tarea es supervisada por un controlador que,
basado en medidas, genera una seal elctrica que controla el motor a
travs de su voltaje (seal de control o actuacin). Las medidas usadas
como referencia para llevar a cabo tal accin de control (variables
controladas) son el ngulo de la viga, dado por un encoder incremental, y la
posicin de la bola, obtenida mediante un sensor situado generalmente en
uno de los extremos de la barra.
La estabilizacin de la bola en el punto referenciado, normalmente el centro,
es difcil de conseguir debido a que sta se mueve sobre la barra con una
aceleracin que es proporcional a la inclinacin de la viga. Adems, se tiene
el inconveniente de que el sistema es inestable a lazo abierto, pues la
posicin de la bola se incrementa sin lmites a partir de un determinado
ngulo. Por tanto, se debe usar un control realimentado para mantener la
bola en la posicin deseada. Una ventaja del uso de este control en lazo
cerrado es que la respuesta del sistema se vuelve relativamente insensible a
las perturbaciones externas y a las variaciones internas en los parmetros
del sistema.
15
Una barra, con dos cables en paralelo sobre los cuales rueda la
pelota.
Un servomotor, que controla el ngulo de la barra.
Un sensor del ngulo de inclinacin.
Un sensor de posicin de la pelota en la barra.
16
Fuente: www.tecquipment.com/Datasheets/CE106_0808.pdf
17
Fuente: www.gunt.de/download/intro_automation_spanish.pdf
Fuente: www.quanser.com/english/.../SRV02_BallBeam_PIS_031108.pdf
18
diferencia entre las energas cintica y potencial, siendo por tanto un escalar.
As, mientras que con el procedimiento de Newton se coloca el nfasis sobre
el agente exterior que acta sobre el cuerpo (la fuerza), con el de Lagrange
se manejan magnitudes asociadas al cuerpo (energas cintica y potencial).
Este hecho es especialmente importante por diversos motivos. En primer
lugar, hace que la lagrangiana de un sistema sea invariante ante los cambios
de coordenadas. Esto permite pasar del espacio ordinario (en el que las
ecuaciones de movimiento pueden ser muy complicadas) a un espacio de
configuraciones elegido de tal forma que de una simplificacin mxima. En
segundo lugar, no es necesario establecer de forma explcita las fuerzas que
actan sobre el cuerpo, cosa que a veces ni siquiera es posible.
Entonces el modelo del sistema Ball and Beam, se consigue al aplicar la
ecuacin de Lagrange. Debido a que el actuador del sistema es un
servomotor, no existe elasticidad, y por lo tanto no existe energa potencial
en el sistema. Siendo as, el Lagrangiano est compuesto por energa
cintica y se expresa como:
(2)
Donde m es la masa de la esfera, v es la velocidad translacional de la esfera,
es la velocidad angular de la esfera, es el ngulo de la barra con
respecto al eje del motor,
es el momento de inercia de la barra, e
es el
momento de inercia de la esfera. Como los sensores del sistema miden la
posicin translacional de la esfera x y la posicin angular , es necesario
representar el modelo del sistema en trminos de estas dos variables, por lo
tanto ahora se encuentran las relaciones entre r, y x . De eso se puede
observar que la distancia recorrida se encuentra expresada por;
(3)
Donde es el ngulo rotacional de la esfera con respecto al eje del motor y r
es el radio efectivo de la esfera.
20
(4)
(5)
) )
21
(6)
(7)
( )
(8)
22
(12)
( )
Cabe hacer notar que entre ms aproximado sea el modelo con respecto al
sistema real, es necesario aadir ms parmetros fsicos que representan
caractersticas del sistema, cuyas variables, traducidas como parmetros de
las ecuaciones diferenciales del modelo del sistema aumentan la complejidad
del mismo, lo cual la mayora de las veces resulta inapropiado.
3.1.2.
Donde
es el par constante, y
representa el par de
23
Fuente: Autores
Fuente: Autores
Por tanto,
es
, donde la constante de
.
24
Referencia
Descripcin
HS-322HD
Servo analgico
estndar.
Sensores
GP2D120
Sensor medidor de
distancia por infrarrojo.
Fuente
NES-15-12
Fuente conmutada de
15W a 12V.
Micro
PIC18F2550 Microcontrolador de
Microchip.
Reguladores LM78xx
Reguladores de Voltaje.
Amplificador LM324
Amplificador
Operacional.
Criterio de
Seleccin
Velocidad, Torque.
Precisin, distancia,
salida.
Tamao, potencia,
voltaje.
Tamao, resolucin
ADC, ICSP.
Voltaje, Potencia.
Single Supply.
Fuente: Autores
3.2.2.
Con la ayuda del software CAD Solid Edge V18, se diseo las piezas de la
estructura y se ensamblaron teniendo as una visin final de la forma del
modulo.
A continuacin se muestran las piezas ms importantes que componen el
modulo.
25
26
Fuente: Autores
27
350 mm
330 mm
240 mm
Aluminio y Acrlico
1100 gr
Fuente: Autores
28
Fuente: Autores
29
30
31
32
Fuente: http://www.me.ucsb.edu/~me170c/Sensors/Range_SHARPGP2D120.pdf
[3]
33
34
36
37
Fuente: Autores
38
z = [5.857; -0.04923];
p = [0; 0; -5.857; -1.557];
k = -9.7601;
Gs = zpk(z, p, k)
sisotool(Gs, 1)
Figura 28. LGR, planta Ec. (15), controlador P,
39
sisotool(Gs, 0.3)
Figura 30. LGR, planta Ec. (15), controlador P,
Fuente: Autores/Matlab.
40
(16)
3.6.1.
(17)
]
, y las constantes
se
Control PID
42
[4]
[Gm,Pm,Wcg,Wcp] = margin(Gs);
Kcr=Gm
Pcr=2*pi/Wcg
Obteniendo:
0
0
PID
Fuente: Ingeniera de Control Moderna - Katsuhiko Ogata (3ra Edicin)
[4]
[
Reemplazando
en la frmula de la tabla 2;
Kp=0.6*Kcr
Ti=0.5*Pcr
Td=0.125*Pcr
Sustituyendo estos valores en la ecuacin (17);
s=tf('s');
Cs= Kp*(1+1/(Ti*s)+Td*s);
zpk(Cs)
Se obtiene:
(19)
Por tanto, el controlador PID tiene un polo en el origen y cero doble en
. Redibujando el lugar geomtrico de las races (LGR) con este
nuevo controlador, se obtiene:
sisotool(Gs,Cs)
44
Manipulando la constante
del controlador de la ecuacin (19) desde el
LGR mostrado en la figura 33, se logr disminuir el tiempo de establecimiento
a 4.13 segundos, pero el overshoot se incremento llegando al 78.2%, como
se muestra en la figura 35.
Nota: La prioridad en el diseo del controlador fue reducir el tiempo de
establecimiento.
45
Figura 35. Respuesta escaln unitario, planta Ec. (15), controlador Ec. (20)
(21)
Kc= 0.5912
Ti=1.6023/60
Td=0.4006/60
As:
46
47
Fuente: http://www.ni.com/pdf/manuals/322192a.pdf
[5]
48
Kc
Ti (min)
Td (min)
0.873413
0.022988
0.005747
49
50
51
4. CONCLUSIONES Y RECOMENDACIONES
El sistema Ball and Beam es una excelente herramienta para demostrar las
ideas de control moderno, ya que su dinmica, aunque es simple, es muy
cercana a la dinmica real encontrada en sistemas aero-espaciales.
Al implementar el lazo de control sobre el sistema se concluy que el sistema
es controlable.
La seal de los sensores de posicin puede llegar a variar dependiendo del
color, material o dimetro de la esfera.
El overshoot que presenta el sistema con el controlador en lazo cerrado se
puede variar en el momento de la sintonizacin automtica seleccionado el
rendimiento del lazo bien sea de forma rpida, normal o lenta.
Se Recomienda mejorar el sistema de lectura de posicin disminuyendo el
ruido sin importar el tipo de esfera.
52
BIBLIOGRAFIA
53
ANEXOS
Kc
Ti
-
Td
-
Fuente: http://www.ni.com/pdf/manuals/322192a.pdf
[5]
Kc
P
PI
PID
Ti
Td
Fuente: http://www.ni.com/pdf/manuals/322192a.pdf
[5]
Kc
P
PI
PID
Fuente: http://www.ni.com/pdf/manuals/322192a.pdf
54
Ti
Td
[5]
Kc
Ti
-
Td
-
Fuente: http://www.ni.com/pdf/manuals/322192a.pdf
[5]
Kc
Ti
-
Td
-
Fuente: http://www.ni.com/pdf/manuals/322192a.pdf
[5]
Kc
Fuente: http://www.ni.com/pdf/manuals/322192a.pdf
Ti
-
Td
-
[5]
55