INGENIERA MECNICA
TEORA DE CONTROL
CONTROL DE POSICIN DE UN BALANCN CON
ARDUINO
LAURA LUGMANIA
TATIANA ANDRADE
RODRIGO CISNEROS
ALEX HERNANDEZ
MAURICIO MARTNEZ
JUAN GARZN
02/08/2017
INDICE
2. Marco terico...........................................................................................................................4
2.1 Introduccin.......................................................................................................................4
2.2 Estructura del PID...............................................................................................................5
2.3 Accin de control proporcional..........................................................................................6
Accin PROPORCIONAL (1/4)...............................................................................................6
Accin INTEGRAL (2/4).........................................................................................................6
Accin DERIVATIVA (3/4)......................................................................................................7
Acciones de control (4/4).....................................................................................................8
2.4 del controlador PID............................................................................................................8
2.5 Mtodo de Ziegler y Nichols en Lazo Cerrado o de la Oscilaciones sostenidas................9
2.5 Mtodo de Ziegler y Nichols en Lazo Abierto o de la Curva de respuesta..........................9
2.6 LAZOS DE CONTROL..........................................................................................................10
2.7 QU ES PWM EN ARDUINO?...........................................................................................11
3. MODELO MATEMTICO..........................................................................................................13
3.1 Estudio del movimiento....................................................................................................13
3.2 Torque..............................................................................................................................14
3.2.1 Torque fuerza de la gravedad...................................................................................14
3.3 Momento de inercia.........................................................................................................14
3.4 Momento de inercia de la barra.......................................................................................15
3.5 Momento de inercia del motor y hlice...........................................................................15
3.6 Momento de inercia total.................................................................................................16
3.7 Obtencin de la funcin de transferencia.........................................................................16
1. INTRODUCCIN
1.1. RESUMEN
En el presente proyecto se pretende controlar la posicin de un sistema mediante el uso
de dos barras ancladas a modo de balancn, en uno de los extremos de la barra se
encuentra un motor con una hlice que ser el encargado de producir la fuerza de
empuje proporcional al giro de su hlice que ser la responsable de los cambios de
posicin de nuestro sistema. Para controlar el motor y visualizar un circuito utilizaremos
un montaje que incluir una tarjeta de Arduino.
1.2. OBJETIVOS
O Conocer el funcionamiento de las tarjetas arduino y su entorno.
O Conocer las posibilidades de manejo de nuestro sistema.
O Conocer los pasos a seguir para la instalacin y construccin del prototipo
O Obtener el modelo matemtico del sistema a travs de las leyes fsicas y con
datos extrados de ensayos.
O Elaborar de un sistema en lazo abierto que nos permita darle diferentes entradas
al sistema.
O Elaborar de un sistema en lazo cerrado con un controlador PID, ante posibles
perturbaciones ajenas al sistema.
O Identificar los parmetros de un controlador PID a travs del mtodo Ziegler-
Nicholls.
O Introducir mejoras que haga nuestro sistema ms estable y fiable.
2. MARCO TERICO
2.1 INTRODUCCIN
El control PID es un mecanismo de control que a travs de un lazo de retroalimentacin
permite regular la velocidad, temperatura, presin y flujo entre otras variables de un
proceso en general. El controlador PID calcula la diferencia entre nuestra variable real
contra la variable deseada. En sistemas de bombeo, regularmente nos interesa mantener
la presin o flujo constante, por lo tanto, el control PID mide la diferencia entre la
presin en la tubera y la presin requerida y acta variando la velocidad del motor para
que podamos tener nuestra presin o flujo constante. [CITATION Maz02 \l 2058 ]
El controlador PID es un controlador realimentado cuyo propsito es hacer que el error
en estado estacionario, entre la seal de referencia y la seal de salida de la planta, sea
cero. El control PID es con diferencia el algoritmo de control ms comn, siendo
utilizado en el 95% de los lazos de control que existen en la industria.[ CITATION
Pam13 \l 2058 ]
Figura. 4 Control PI
Caractersticas
Figura. 6 Control PD
Mismo valor de las acciones P e I pero diferente valor de la derivada del error.
Su objetivo es corregir la seal de error antes de que se haga est demasiado grande. La
prediccin se hace por la extrapolacin del error de control en la direccin de la
tangente a su curva respectiva, como se muestra en la figura.[ CITATION Fer07 \l
2058 ]
Figura. 7 Curva PD[ CITATION Fer07 \l 2058 ]
ACCIONES DE CONTROL (4/4)
Comparacin de las acciones de control cuando se ha Comparacin de las acciones de
control cuando se ha producido un cambio brusco en la referencia.[ CITATION Fer07 \l
2058 ]
Por ser un mtodo en lazo abierto, primero se realiza un ensayo en lazo abierto,
introduciendo un escaln en la seal de control (salida del controlador que acta sobre
el elemento final de control) y se registra el transitorio de la variable medida o
controlada.[ CITATION Uni17 \l 2058 ]
El ajuste del controlador (vlido para relaciones L/t menores que 1) se hace segn:
Pulse Width Modulation. Son seales cuadradas a las cules se les cambia el periodo.
Figura. 12 seales cuadradas a las cules se les cambia el periodo
Si el ciclo de trabajo es del 25% se pasa el 25% de su periodo arriba y el 75% abajo.
El periodo es lo que dura la onda sin repetirse. Por eso se va repitiendo con el tiempo
porque el periodo se repite durante todo el tiempo. El periodo es la suma de la parte alta
y baja una vez, cuando vuelve a subir ya es otro periodo y la onda vuelve a empezar otra
vez. El ancho de la onda, su altura, siempre es la misma. Va de 0 a 5 Voltios. Lo nico
que vara es el tiempo que est en ON/OFF. La frecuencia de los pines es de 490Hz ms
o menos, excepto el 5 y el 6 que es de 980 Hz para el Arduino UNO y lo mismo pero en
los pines 3 y 11 para el Leonardo. La locura es simplemente porque dependen de
los timers (temporizadores) internos que tienen. Hay 3 y uno de ellos tiene el doble de
frecuencia lo que afecta a nuestros pines.[ CITATION Adr16 \l 2058 ]
El PWM tiene varias aplicaciones pero a nosotros la que nos interesa es la de
convertidor ADC, lo que nos permite simular una salida analgica con una salida
digital. El control digital se usa para crear una onda cuadrada, una seal que conmuta
constantemente entre encendido y apagado. Este patrn de encendido-apagado puede
simular voltajes entre 0 (siempre apagado) y 5 voltios (siempre encendido) simplemente
variando su ciclo de trabajo.[ CITATION Adr16 \l 2058 ]
3. MODELO MATEMTICO
Donde es la aceleracin angular del cuerpo. A partir de estas dos frmulas podemos
obtener las ecuaciones de nuestro sistema.
Primero calcularemos el momento de inercia de la barra y del motor y los torques de las
fuerzas. En la siguiente figura vemos un resumen de las fuerzas a las que se ve expuesto
nuestro sistema.
Fe es la fuerza que proporciona el giro del motor y a la encargada de hacer cambiar de
posicin a la barra.
Las otras fuerzas son debidas a la gravedad, Fr es la fuerza total gravitatoria de la masa
del motor, Fgb es la debida a la barra, que se representa en la parte derecha por ser en
este lado ms larga.
3.2 TORQUE
3.2.1 TORQUE FUERZA DE LA GRAVEDAD
La fuerza de la gravedad acta tanto sobre la barra como sobre el motor y hlice por lo
que lo calcularemos por separado.
Si el punto de gravedad de la barra estuviera en su eje de gravedad el torque total que
produce la gravedad sobre la barra sera nulo ya que se compensaran los torques de un
lado del eje de giro con el otro. En nuestro caso el centro de gravedad estar desplazado 3
cm por lo tanto la accin de la gravedad si producir torque que ser:
Para calcular el torque del motor y de la hlice, suponemos todo el conjunto como una
masa puntual que se encuentra en el punto medio del motor. Por lo tanto, el torque de
este conjunto ser:
El conjunto tiene una masa m=0.076Kg y se encuentra a una distancia r=0.245m, por lo
tanto, su momento de inercia ser:
3.6 MOMENTO DE INERCIA TOTAL
Sera la suma de los dos elementos anteriores:
Como ya tenemos los torques del sistema calculados y los momentos de inercia solo
tendremos que sustituir. Es la aceleracin angular por lo tanto se puede poner como
4. IMPLEMENTACIN
4.1 LAZO ABIERTO
Para el control utilizamos un controlador PI, con valores P = 2,3 I = 0,91. Estos han sido
obtenidos mediante el mtodo de Ziegler-Nicholls que se aplica en circuitos de lazo cerrado y
un posterior ajuste mediante prueba-error.
5. CONCLUSIONES
Los resultados conseguidos con estos proyectos han sido satisfactorios. Se han
cumplido los objetivos que nos marcados al principio del inicio de este, obteniendo un
correcto funcionamiento y control, as como un completo conocimiento de todo lo que
nos ha permitido llegar a ello.
Con la realizacin de este proyecto no ha permitido poner en prctica y desarrollar los
conocimientos anteriormente adquiridos en nuestra formacin, en especial los
relacionados con la automtica, control y electrnica en general. Esto nos ha permitido
llevar a nuestro proyecto hacia una solucin que podemos considerar ptima.
Nuestro sistema describe un movimiento circular, el trabajo con l nos ha permitido
conocer sus caractersticas en las que destacamos: conceptos como momento de inercia
y torque. Estos conocimientos junto a la 2 ley de Newton nos permitido identificar el
sistema, as como sacar la funcin de transferencia.
En referencia al circuito elctrico lo ms destacable ha sido conocer el uso del
potencimetro como sensor de posicin angular y el uso necesario del diodo en anti
paralelo con el motor, como elemento protector del circuito.
Hemos realizado un control en lazo cerrado de nuestro sistema con un controlador PID,
con la ayuda del mtodo de Ziegler-Nicholls y su posterior ajuste hemos identificado los
parmetros del controlador PID, que hacen que nuestro circuito funciona de una manera
correcta. Esto no ha permitido llegar a la conclusin que el controlador PID es idneo
para nuestro sistema y que a travs del mtodo de Ziegler-Nicholls nos da una idea
aproximada para la identificacin de sus parmetros.
Este proyecto tiene amplio uso didctico, ya que su uso sencillo permitir a los futuros
alumnos trabajar con conceptos como lazo abierto, lazo cerrado, funcin de
transferencia, controlador PID viendo reflejado sus resultados en un medio fsico.
6. ANEXOS