Documentos de Académico
Documentos de Profesional
Documentos de Cultura
Trabajo 05 J
Trabajo 05 J
1
DISEÑO E IMPLEMENTACION DE UN SISTEMA DE CONTROL BOLA Y VIGA
USANDO UN CONTROLADOR CON OBSERVADOR DE ESTADOS DE ORDEN
REDUCIDO.
Asesor Técnico
LUIS EDUARDO GARCIA JAIMES
Ingeniero en Instrumentación y Control
Asesor Metodológico
ÁLVARO URDINOLA RESTREPO
Sociólogo
2
Medellín, septiembre de 2016
3
Dedicado a mis padres, Luz Mila Álzate por ser una guía personal y enseñarme
tantos valores los cuales me formaron como una persona íntegra, Hernán Cadavid
por ser mi apoyo en una carrera de estudios y en especial a mi hija Julieta Cadavid
Barrientos quien es el motor para realizar todos los proyectos que me planteo.
4
Dedico este trabajo a mi familia, en especial a mis abuelos Esther Tobón y Jorge
Giraldo, los cuales me han enseñado el valor de las cosas, a mi madre Olga Giraldo
por su apoyo, a mi guía en la vida Omaira Barrera todas sus enseñanzas y a mi
compañera de vida por su comprensión y apoyo Manuela Betancur.
5
AGRADECIMIENTOS
6
RESUMEN
En este trabajo se presenta el diseño de una planta inestable de tipo bola y viga,
utilizando como controlador un observador de estados de orden reducido, para
implementar el controlador es necesario garantizar una rápida velocidad de logre
estabilizar la bola en el punto de referencia deseado.
El trabajo inicia con el desarrollo e implementación del prototipo realizando la
descripción de cada uno de los elementos que la comprende, desde la parte
mecánica como la parte electrónica, finalizando con su funcionamiento detallado.
7
TABLA DE CONTENIDO
LISTA DE FIGURAS ............................................................................................. 11
LISTA DE TABLAS................................................................................................ 12
GLOSARIO............................................................................................................ 15
1. GENERALIDADES ......................................................................................... 17
4.1 OBTENCIÓN DEL MODELO DEL CONTROLADOR CON OBSERVADOR DE ESTADOS DE ORDEN
REDUCIDO DE LA PLANTA. ............................................................................................................ 48
4.2 DISEÑO CONTROLADOR CLASICO PID. ................................. ¡Error! Marcador no definido.
9
4.3 COMPARACIÓN DE LOS CONTROLADORES DISEÑADOS POR MEDIO DE LAS METRICAS DEL
ERROR............................................................................................................................................ 60
10
LISTA DE FIGURAS
Figura 2.1 Prototipo planta Bola y Viga ................................................................. 27
Figura 2.2 Viga Móvil ............................................................................................. 27
Figura 2.3 Viga Fija ............................................................................................... 28
Figura 2.4 Palanca de Transmisión del Toque. ..................................................... 28
Figura 2.5 Palanca de Transmisión de Movimiento ............................................... 29
Figura 2.6 Mecanismo Transmisión Movimiento ................................................... 29
Figura 2.7 Servo Motor Futaba S3003 .................................................................. 30
Figura 2.8 Diagrama de conexión del servomotor futaba s3003 ........................... 31
Figura 2.9 Arduino UNO ........................................................................................ 32
Figura 2.10 Sensor Infrarrojo Sharp GP2Y0A21YK .............................................. 32
Figura 2.11 Diagrama de conexión del sensor infrarrojo ....................................... 33
Figura 2.12 Módulo de Voltaje............................................................................... 34
Figura 3.1Sistema viga y bola ............................................................................... 38
Figura 4.1 Diagrama bloques planta bola y viga ................................................... 51
Figura 4.2 Simulación obtenida de la planta ......................................................... 52
Figura 4.3 Código fuente del observador de estados ............................................ 53
Figura 4.4 Respuesta observador de estados de orden reducido ......................... 53
Figura 4.5 Sistema de control discreto en lazo cerrado ........................................ 54
Figura 4.6 Simulación obtenida de la planta ......................................................... 56
Figura 4.7 Simulación obtenida de la planta ......................................................... 57
Figura 4.8 Simulación obtenida de la planta ......................................................... 57
Figura 4.9 Simulación obtenida de la planta ......................................................... 58
Figura 4.10 Simulación obtenida de la planta........................................................ 58
Figura 4.11 Simulación obtenida de la planta........................................................ 59
Figura 4.12 Código fuente controlador PI experimental ........................................ 59
Figura 4.13 Gráfica de respuesta del observador ................................................. 61
Figura 4.14 Gráfica de respuesta del PI experimental .......................................... 62
11
LISTA DE TABLAS.
Tabla 2.1 Características Servo Motor Futaba S3003 ........................................ 300
Tabla 2.2 Características tarjeta arduino UNO R3 ................................................ 31
Tabla 2.3 Características sensor infrarrojo SHARP .............................................. 33
Tabla 2.4 Características módulo de voltaje.......................................................... 34
Tabla 3.1 Parámetros del sistema viga y bola……………………………………….. 43
Tabla 4.1 Criterios de error………………………………………………………………62
12
LISTA DE ABREVIATURAS
ABREVIATURA SIGNIFICADO
AC Alternating Current (Corriente Alterna)
A/D Conversión Análoga Digital
DC Direct Current (Corriente Directa)
PI Controlador Proporcional Integral
PWM Pulse Width Modulation (Modulación por ancho de pulsos)
Mp Máximo Sobreimpulso
AO Amplificador Operacional
FT Función de Transferencia
DSC Digital Signal Controller
ESS Error en Estado Estable (Steady State Error)
Ts Tiempo de Establecimiento
Tp Tiempo de Máximo Pico
DSP Digital Signal Processor (Procesador Digital de Señal)
POR Sistema de Primer Orden con Retardo
ICE Integral del Error Cuadrático (Integral of Squared Error)
IAE Integral del Error Absoluto (Integral Absolute Error)
PID Controlador Proporcional, Integral y Derivativo
13
LISTA DE SÍMBOLOS
SÍMBOLO SIGNIFICADO
𝐼𝑚𝑎𝑥 Corriente máxima
A Amperio
I Corriente
mV milvoltio
Ms milisegundos
mA miliamperios
Ω Ohm (Ohmio)
S Segundos
V Voltios
14
GLOSARIO.
ESFERA: Es un cuerpo geométrico que tiene esta forma y todos sus puntos son
equidistantes de una distancia interior que se llama centro.
INFRARROJO: Método que se extiende desde un extremo con una intensidad roja
visible y frecuencia alta, hasta otro extremo lejano llegando a frecuencias menores
y con poca intensidad. Se caracteriza por sus defectos ante variaciones en la
temperatura.
15
MECANISMO: Conjunto de elementos que se encuentran unidos entre si y cuando
utilizan energía mecánica cumplen con un trabajo o tarea.
PLANTA: Sistema físico el cual se espera controlar. Algunos ejemplos pueden ser:
un intercambiador de calor, un tanque cerrado, una autoclave, una banda
transportadora, un robot, et.
REFERENCIA: Valor escogido para llevar a que converja el proceso bajo unos
parámetros deseados.
SENSOR: Dispositivo con capacidad de tomar una señal física y convertirla en una
señal eléctrica para facilitar su medición y/o análisis
16
1. GENERALIDADES
1.1 INTRODUCCION
Actualmente las industrias migran sus procesos a las últimas tecnologías, dichas
tecnologías son aquellas que vuelven el proceso más autónomo para obtener el
producto final al menor costo y aumentar la productividad de la planta. En los
procesos industriales es necesario controlar las variables que impactan el proceso,
entre ellas se encuentra la posición, la cual presenta ciertas dificultades para
realizar un control de alta precisión y calidad.
El desarrollo de este trabajo de grado cumple con uno de los objetivos mencionados
anteriormente, el cual se trata de una planta prototipo de dinámica compleja no
lineal. El sistema se controlará por medio de un control avanzado con Observador
de Estado de Orden Reducido.
19
1.3 OBJETIVOS
1.4.1 Alcance
Se presenta en este trabajo de grado la implementación de un control tipo
observador de estados de orden reducido para controlar la posición de una bola
sobre una viga la cual tiene como actuador un servo motor de corriente continua DC
acoplado en uno de sus extremos.
1.4.2 Limitantes.
Diseño de la estructura de la planta prototipo y sus periféricos, al no tener una
estructura de referencia.
La cantidad de tiempo dedicado a investigar sobre el tipo de controlador
implementado debido a que es un tema nuevo y no visto en el programa académico.
1.5 ANTECEDENTES.
Oporto Paredo (2015). En su trabajo de grado Control design for a plant Ball an
Beam, Explica la implementación de la planta, es decir, los materiales que utilizó y
como los acopló para darle forma y estructura a la planta tipo bola y viga. En este
trabajo se utilizaron unos finales de carrera, los cuales se utilizan para limitar los
21
ángulos de trabajo de desplazamiento de la viga móvil, con una cámara de alta
resolución y que no necesita mucha luz para su buen desempeño como sensor,
para controlar el sistema de implementa un controlador de tipo PID. El diseño del
controlador se hace mediante el software Labview® donde se explica la
implementación de un algoritmo PID de doble realimentación o en cascada. Este
tipo de control funciona bien, no presenta errores considerables y permite el buen
posicionamiento de la bola, pero como aclaración que para mejorar el desempeño
se debería diseñar un controlador para cada sentido de giro del motor debido a que
esto permite controlar el sistema en el valor máximo del ángulo para la viga.
Herrera y Romero (2010). En su tesis de grado: Controlador digital para una planta
de levitación magnética con un grado de libertad, presentan el diseño de una planta
de levitación magnética, su control y las ventajas que tienen los sistemas
magnéticos frente a hidraulicos, neumáticos, entre otros. Explican que el grado de
libertad del levitador es solo vertical y que el controlador no fue desarrollado
matemáticamente ni con ayuda de ninguna teoría sino que se desarrolla sobre un
sistema digital ya existente el cual no es basado en un sistema operativo o tarjetas
de adquisición de datos, siendo este ventaja con respecto a un menor gasto de
energía y rendimiento computacional, pero careciendo de robustez o de respuesta
22
frente a algunas perturbaciones al sistema, se infiere del trabajo de grado una buena
estabilidad del sistema, lo que se traduce a un controlador óptimo.
23
Wen Yu (2010). En su artículo: Nonlinear PD regulation for ball and beam system,
asegura que el sistema viga y bola es uno de los experimentos más utilizados para
las prácticas de control en educación. En el artículo el autor utiliza un controlador
PD modificado para controlar la posición de la bola sobre la viga. Inicialmente
trabaja con un controlador PD paralelo y luego con un controlador PD serie para
controlar el modelo no lineal, obteniendo en ambos casos resultados satisfactorios.
El artículo es un buen ejemplo de cómo aplicar la teoría de control no lineal en
laboratorios dedicados a las aplicaciones académicas.
1.6 METODOLOGIA.
Para desarrollar el trabajo de grado se implementa una viga fija con un sensor de
posición ultrasónico HC-SR04, utilizado como referencia del sistema y una viga
móvil con un sensor ultrasónico de la misma referencia para obtener la posición de
24
la esfera sobre la viga; Para desarrollar el control se utiliza el software de
programación y simulación Labview®.
Al ajustar los sensores de posición sobre los extremos de las vigas, se aplica un
escalón al servomotor para ejercer un movimiento en la viga móvil y así obtener
valores, para conocer la respuesta de la planta; para este trabajo los métodos de
identificación en lazo abierto no son eficientes, por lo cual, se realiza la identificación
del sistema de forma matemática utilizando principios y leyes físicas e identificación
no paramétrica mediante la respuesta de la planta a una entrada de forma de
escalón unitario.
26
Figura 2.1 Prototipo planta Bola y Viga
4mm
36mm 32mm
500mm
27
2.3.1 Viga Fija: Estructura igual a la viga móvil, su importancia reside en ser el set
point del sistema, se encarga de sostener la bola de referencia para realizar
el control en la viga móvil.
En la figura 2.3 se presenta un esquema de la forma de la viga fija, esa tiene
las mismas características de la viga móvil.
4mm
36mm 32mm
500mm
28
Figura 2.5 Palanca de Transmisión de Movimiento
29
2.4 COMPONENTES UTILIZADOS EN LA IMPLEMENTACION DE LA PLANTA
Tabla 2.1
VARIABLES VALORES
Velocidad 0.23 seg/60 grados (260 grados/seg)
Torque 3.2 Kg-cm (0.314 N.m)
Voltaje 5 VDC
Dimensiones 40.4 x 19.8 x 36 mm
Peso 37.2 gr
Frecuencia 50Hz (20ms)
Giro 180 grados
30
En la figura 2.8 se presenta el diagrama de conexión del servomotor, donde
se puede observar los pines de alimentación y el pin se señal variable o salida
del PWM.
- +
5 VDC
31
Figura 2.9 Arduino UNO
32
En la tabla 2.3 se presentan las Características sensor infrarrojo Sharp
GP2Y0A21YK.
Tabla 2.3
Características sensor infrarrojo SHARP
VARIABLES VALORES
VOLTAJE 5 VDC
CONEXIÓN 3 Hilos
RANGO 5cm 80cm
CORRIENTE MAX 40mA
FRECUENCIA 40 Khz
OUTPUT SIGNAL -0.3 to Vcc
Fuente: http://www.bluetip.com.uy/GP2Y0A21YK
Fuente: http://www.naylampmechatronics.com/
En la tabla 2.4 se dispone de las características principales que posee el módulo de voltaje.
Tabla 2.4
VARIABLES VALORES
VOLTAJE IN 6.5V-12V
CONEXIÓN Jack o USB
VOLTAJE OUT 3.3V o 5V
CORRIENTE MAX 700mA
34
3. MODELO MATEMÁTICO DEL SISTEMA
Primera ley (Principio de inercia): Todo cuerpo tiende a seguir en su estado inicial
de reposo o movimiento rectilíneo uniforme excepto cuando hay una fuerza externa
que actué sobre él, dicha fuerza puede ser neta no nula.
Segunda ley: La suma vectorial de todas las fuerzas que actúan sobre un cuerpo
que se desplaza es igual al producto de su masa por la aceleración que
experimenta. La masa inercial es la resistencia que presenta un cuerpo a ser
acelerado en traslación.
𝑑𝑣(𝑡) 𝑑 2 𝑥(𝑡)
∑ 𝑓(𝑡) = 𝑚 ∗ 𝑎(𝑡) = 𝑚 =𝑚 3.1
𝑑𝑡 𝑑𝑡 2
Así mismo, la suma de todos los momentos (Torques) que actúan sobre un cuerpo
que rota es igual al producto de su momento de inercia por la aceleración angular
que experimenta. El Momento de Inercia es la resistencia que presenta un cuerpo
a ser acelerado en rotación
𝑑𝜔(𝑡) 𝑑 2 (𝜃)
∑ 𝜏(𝑡) = 𝐼 ∗ 𝛼(𝑡) = 𝐼 =𝐼 3.2
𝑑𝑡 𝑑𝑡 2
35
𝜏(𝑡) =Torques externos que actúan sobre el cuerpo [nxm]
𝐼 =Momento de inercia del cuerpo con respecto al eje de rotación
𝛼(𝑡) = Aceleración angular [rad/s2]
𝜔(𝑡) = Velocidad angular [rad/s]
36
3.2.2 Formulación de las ecuaciones de Lagrange: Si T es la energía cinética
total del sistema y V es la energía potencial total del sistema, las ecuaciones de
Euler- Lagrange para la j-exima partícula son, Gómez y Aguilar (2002):
𝑑 𝜕𝑇 𝜕𝑇
( )− = 𝑄𝑗 3.3
𝑑𝑡 𝜕𝑞̇ 𝑗 𝜕𝑞𝑗
En el caso de un sistema conservativo, se tiene que:
𝜕𝑉
𝑄𝑗 = − 3.4
𝜕𝑞𝑗
Entonces las ecuaciones de Euler-Lagrange resultan
𝑑 𝜕𝑇 𝜕𝑇 𝜕𝑉
( )− =− 3.5
𝑑𝑡 𝜕𝑞̇ 𝑗 𝜕𝑞𝑗 𝜕𝑞𝑗
𝑑 𝜕𝑇 𝜕𝑇 𝜕𝑉
( )− + =0 3.6
𝑑𝑡 𝜕𝑞̇ 𝑗 𝜕𝑞𝑗 𝜕𝑞𝑗
𝑑 𝜕𝑇 𝜕(𝑇 − 𝑉)
( )− =0 3.7
𝑑𝑡 𝜕𝑞̇ 𝑗 𝜕𝑞𝑗
El lagrangiano 𝐿 de un sistema se define como la diferencia entre su energía cinética
𝑇 y su energía potencial 𝑉 es decir:
𝐿 =𝑇−𝑉 3.8
Además, como en los sistemas mecánicos la energía potencial no depende de las
velocidades sino únicamente de las posiciones, resulta que: 𝑑 𝑉 ⁄𝑑𝑞̇ 𝑗 = 0, entonces
se obtiene:
𝜕𝑇 𝜕𝑇 𝜕𝑉 𝜕(𝑇 − 𝑉)
= − = 3.9
𝜕𝑞̇ 𝑗 𝜕𝑞̇ 𝑗 𝜕𝑞̇ 𝑗 𝜕𝑞̇ 𝑗
De lo anterior, se deduce que las ecuaciones del sistema pueden escribirse en
términos del Lagrangiano de la forma
𝑑 𝜕𝐿 𝜕𝐿
( )− =0 3.10
𝑑𝑡 𝜕𝑞̇ 𝑗 𝜕𝑞𝑗
37
El subíndice 𝑗 va desde 1 hasta 𝑛, por lo que éstas son 𝑛 ecuaciones (siendo 𝑛 el
número de grados de libertad del sistema), la resolución de estas 𝑛 ecuaciones dan
el estado del sistema en todo instante.
Generalizando al caso de sistemas sometidos a fuerzas externas, la ecuación 3.10
se puede escribir en la forma:
𝑑 𝜕𝐿 𝜕𝐿
( )− = 𝑄𝑖 3.11
𝑑𝑡 𝜕𝑞̇ 𝑗 𝜕𝑞𝑗
Donde 𝑄𝑖 representa el conjunto de fuerzas y momentos externos entre los que se
incluyen las fuerzas y torques de control y los efectos de la fricción que producen
disipación de energía.
39
Como se anotó anteriormente, la diferencia entre la energía cinética 𝑇 y la energía
potencial 𝑉 corresponde al Lagrangiano 𝐿 . Reemplazando las ecuaciones 3.11 y
3.12 en la ecuación 3.8 resulta:
1 1 𝑟̇ 2 1 1 𝑙
𝐿 = [2 𝑚𝐵 𝑟̇ 2 + 2 𝐽𝐵 (𝑅) + 2 (𝐽𝐵 + 𝑚𝐵 𝑟 2 )𝛼̇ 2 + 2 𝐽𝑏 𝛼̇ 2 ] − [2 𝑚𝑏 𝑔𝑠𝑒𝑛𝛼 + 𝑚𝐵 𝑔𝑟𝑠𝑒𝑛𝛼] 3.13
40
Para el sistema eléctrico la ecuación diferencial que describe el comportamiento del
motor es (Wahid y Rahmat, 2009)
𝑑𝑖
𝐿𝑚 + 𝑅𝑚 𝑖 + 𝐾𝑚 𝜃̇𝑚 = 𝑉 3.24
𝑑𝑡
𝐾𝑚 𝜃̇𝑚 = Fuerza contra electromotriz inducida debida a la velocidad del motor [Volt]
42
𝜕𝑓1 𝜕𝑓1 𝜕𝑓1 𝜕𝑓1 𝜕𝑓1
𝜕𝑥1 𝜕𝑥2 𝜕𝑥3 𝜕𝑥4 𝜕𝑉
𝜕𝑓2 𝜕𝑓2 𝜕𝑓2 𝜕𝑓2 𝜕𝑓2
𝜕𝑥1 𝜕𝑥2 𝜕𝑥3 𝜕𝑥3
𝐴= 𝐵 = 𝜕𝑉 3.36
𝜕𝑓3 𝜕𝑓3 𝜕𝑓3 𝜕𝑓3 𝜕𝑓3
𝜕𝑥1 𝜕𝑥2 𝜕𝑥3 𝜕𝑥4 𝜕𝑉
𝜕𝑓4 𝜕𝑓4 𝜕𝑓4 𝜕𝑓4 𝜕𝑓4
[𝜕𝑥1 𝜕𝑥2 𝜕𝑥3 𝜕𝑥4 ]𝑝 [ 𝜕𝑉 ]𝑝
𝑜
𝑜
En la tabla 3.1 se dan los parámetros del sistema viga y bola construida.
Tabla 3.1
43
𝑥1
𝑥2
𝐶 = [1 0 0 0] [𝑥 ] 3.37
3
𝑥4
La función de transferencia del sistema es:
𝑅(𝑆) −9.9225
𝐺(𝑆) = = 4
𝑉(𝑆) 𝑆 + 3.544𝑆 3 − 42.603
Las raíces de la ecuación característica son:
𝑆 = −4.143, 𝑆 = 1.976, 𝑆 = −0.6886 ± 𝑗2.174
El polo en 𝑆 = 1.976 hace que el sistema sea inestable. Así mismo, con los polos
estables se puede obtener una constante de tiempo equivalente igual a 𝜏 = 1.7 𝑠.
Para discretizar el sistema se toma como periodo de muestreo 𝑇 = 0.2 ∗ 𝜏 = 0.34 𝑠,
con lo cual se obtiene que:
−0.004422𝑧 3 − 0.03936𝑧 2 − 0.03106𝑧 − 0.002152
𝐺𝑝 (𝑧) =
𝑧 4 − 3.3712𝑧 3 + 3.6816𝑧 2 − 1.9384𝑧 + 0.2997
−0.004422𝑧 −1 − 0.03936𝑧 −2 − 0.03106𝑧 −3 − 0.002152𝑧 −4
𝐺𝑝 (𝑧) =
1 − 3.3712𝑧 −1 + 3.6816𝑧 −2 − 1.9384𝑧 −3 + 0.2997𝑧 −4
Con:
𝐴(𝑧 −1 ) = 1 − 3.3712𝑧 −1 + 3.6816𝑧 −2 − 1.9384𝑧 −3 + 0.2997𝑧 −4
𝐵(𝑧 −1 ) = −0.004422𝑧 −1 − 0.03936𝑧 −2 − 0.03106𝑧 −3 − 0.002152𝑧 −4
44
4. CONTROLADOR CON OBSERVADOR DE ESTADO DE ODEN
REDUCIDO.
En la práctica, algunas de las variables de estado del sistema pueden ser medidas
exactamente y, por lo tanto, no es necesario estimarlas. En este caso, es posible
diseñar un observador que estime menos de la n variables que conforman el vector de
estado. Un observador de este tipo se conoce con el nombre de Observador de Estado
de Orden Reducido. Si el número de variables a estimar es el mínimo posible, el
observador se llama Observador de Orden Mínimo. (García, 2010,42)
Sea 𝑥𝑎 (𝑘) la parte del vector de estado que puede medirse exactamente y sea 𝑥𝑏 (𝑘)
la parte no medible, el observador de orden reducido puede diseñarse dividiendo el
vector de estado en la forma:
𝑥𝑎 (𝑘)
𝑥(𝑘) = [ ] 4.1
𝑥𝑏 (𝑘)
𝑥𝑎 (𝑘)
𝑦(𝑘) = [𝐼|0] [ ]
𝑥𝑏 (𝑘)
45
Al comparar las ecuaciones del observador de orden completo, con la ecuación 4.5
y la de la salida del sistema con la ecuación 4.4 resulta:
𝑥(𝑘 + 1) = 𝐴𝑥 (𝑘) + 𝐵𝑢 (𝑘) 4.6
𝑥𝑏 (𝑘 + 1) = 𝐴𝑏𝑏 𝑥𝑏 (𝑘) + [𝐴𝑏𝑎 𝑥𝑎 (𝑘) + 𝐵𝑏 𝑢(𝑘)] 4.7
𝑦(𝑘) = 𝐶𝑥(𝑘) 4.8
𝑥𝑎 (𝑘 + 1) − 𝐴𝑎𝑎 𝑥𝑎 (𝑘) − 𝐵𝑎 𝑢(𝑘) = 𝐴𝑎𝑏 𝑥𝑏 (𝑘) 4.8
q(𝑘 + 1) = [𝐴 − 𝐿𝐶]𝑞(𝑘) + 𝐿𝑦(𝑘) + 𝐵𝑢(𝑘) 4.9
Es decir:
𝑞𝑏 (𝑘 + 1) = [𝐴𝑏𝑏 − 𝐿𝐴𝑎𝑏 ]𝑞𝑏 (𝑘) + 𝐿[𝑥𝑎 (𝑘 + 1) − 𝐴𝑎𝑎 𝑥𝑎 (𝑘) − 𝐵𝑎 𝑢(𝑘)] + 𝐴𝑏𝑎 𝑥𝑎 (𝑘) +
𝐵𝑏 𝑢(𝑘) 4.10
Entonces:
𝑞𝑏 (𝑘 + 1) = [𝐴𝑏𝑏 − 𝐿𝐴𝑎𝑏 ]𝑞𝑏 (𝑘) + 𝐿𝑦(𝑘 + 1) + [𝐴𝑏𝑎 − 𝐿𝐴𝑎𝑎 ]𝑦(𝑘) + [𝐵𝑏 − 𝐿𝐵𝑎 ]𝑢(𝑘)
46
La matriz 𝐿 se puede obtener por comparación directa entre la ecuación característica
deseada para el observador de orden reducido y la ecuación característica del mismo
dada por la ecuación 4.12 o utilizando la fórmula de Ackerman:
𝐴𝑎𝑏 −1 0
𝐴𝑎𝑏 𝐴𝑏𝑏 0
𝐿 = ∅(𝐴𝑏𝑏 ) 𝐴𝑎𝑏 𝐴2𝑏𝑏 0 4.13
⋮ ⋮
[𝐴𝑎𝑏 𝐴𝑏𝑏 ] 1]
𝑛−2 [
En donde:
∅(𝐴𝑏𝑏 ) = 𝐴𝑛−1 𝑛−2
𝑏𝑏 + 𝛼1 𝐴𝑏𝑏 + ⋯ 𝛼𝑛−2 𝐴𝑏𝑏 + 𝛼𝑛−2 𝐼 4.14
Siendo 𝛼1 , 𝛼2 … 𝛼𝑛−1 los coeficientes de la ecuación característica deseada y 𝑛 el orden
de la matriz A.
Para obtener la ecuación 2.69 se asume que 𝑦(𝑘) = 𝑥𝑎 (𝑘) y que la matriz de ganancia
de realimentación 𝐾, se particiona de tal forma que:
𝑢(𝑘) = −𝐾[𝑦(𝑘) 𝑞𝑏 (𝑘)]𝑇 = −[𝐾1 𝐾𝑏 ][𝑦(𝑘) 𝑞𝑏 (𝑘)]𝑇 4.15
𝑢(𝑘) = −𝐾1 𝑦(𝑘) − 𝐾𝑏 𝑞𝑏 (𝑘)
Para utilizar correctamente las ecuaciones 4.13 y 4.15 es necesario tener presente que
la matriz 𝐶 debe estar en la forma 𝐶 = [1 0 0 … 0], en caso contrario se precisa
utilizar una matriz de transformación 𝑇 tal que:
𝐶𝑇 −1 = [1 0 … 0]
𝐶 = [1 0 … 0]𝑇
47
𝑥̂(𝑘 + 1) = 𝐴̂𝑥̂(𝑘) + 𝐵̂ 𝑢(𝑘) 4.16
𝑦̂(𝑘) = 𝐶̂ 𝑥̂(𝑘) + 𝐷
̂ 𝑢(𝑘) 4.17
𝐴̂ = 𝑇𝐴𝑇 −1 𝐵̂ = 𝑇𝐵
𝐶̂ = 𝐶𝑇 −1 = [1 0 … 0] ̂=𝐷
𝐷 4.18
48
La ecuación obtenida del sistema es de cuarto orden, por lo tanto se adicionan dos
polos en z=0, así, se obtiene ecuación característica deseada es:
(𝑧 − 0.688 − 𝑗0.179)(𝑧 − 0.688 + 𝑗0.179)𝑧 2 = 0
𝑧 4 − 1.376𝑧 3 + 0.5053𝑧 2 = 0 4.24
Para el cálculo del observador de orden reducido se tiene que el observador debe ser
de orden tres, se asume, que solo se puede medir la variable de estado 𝑥1 (𝑘) = 𝑦(𝑘)
𝑥1 (𝑘 + 1) 3.3712 1 0 0
𝑥2 (𝑘 + 1)
= [ −3.6816 0 1 0]
𝑥3 (𝑘 + 1) 1.9384 0 0 1
[ 𝑥4 (𝑘 + 1) ] −0.29972 0 0 0
𝐴𝑎𝑎 = [3.3712] 𝐴𝑎𝑏 = [1 0 0]
−3.6816 0 1 0
𝐴𝑏𝑎 = [ 1.9384 ] 𝐴𝑏𝑏 = [0 0 1]
−0.29972 0 0 1
49
𝜃 = 57.3 ∗ 1.667 ∗ 0.34√1 − 0.82 𝜃 = 19.48° 4.29
𝑧 = 0.598 ± 𝑗0.211
Como el observador debe ser de orden tres, se adiciona un polo en 𝑧 = 0, por lo tanto
la ecuación característica es:
(𝑧 − 0.598 − 𝑗0.211)(𝑧 − 0.598 + 𝑗0.211)𝑧 = 0
𝑧 3 − 1.19𝑧 2 + 0.4021𝑧 = 0 4.30
50
𝑈(𝑧)
𝐷(𝑧) = − = 𝐾1
𝑦(𝑧)
+ 𝐾𝑏 [𝑧𝐼𝐼 − 𝐴𝑏𝑏 + 𝐿𝐴𝑎𝑏 + (𝐵𝑏 − 𝐿𝐵𝑎 )𝑘𝑏 ]−1 [𝐿𝑧 + 𝐴𝑏𝑎 − 𝐿𝑎𝑎 − 𝐾1 (𝐵𝑏 − 𝐿𝐵𝑎 ]
Reemplazando los valores obtenidos para las matrices K y L resulta:
𝐾0 = −0.625
Para realizar la simulación del sistema, en la figura 4.1 se muestra el diagrama de
bloques correspondiente al sistema.
52
Figura 4.3 Código fuente del observador de estados
53
4.2 DISEÑO DEL CONTROLADOR PID POR EL MÉTODO DEL LUGAR
GEOMÉTRICO DE LAS RAÍCES.
La aplicación del método del lugar geométrico de las raíces en el diseño de sistemas
de control es muy útil, ya que indica la forma en que se debe modificar la posición
de los ceros y de los polos de lazo abierto para que la respuesta de lazo cerrado
cumpla con las especificaciones de comportamiento establecidas para el sistema.
R(z) C(z)
G(z)
+
-
H(z)
54
Condición de módulo: permite calcular la ganancia asociada a los polos de lazo
cerrado especificados.
|𝐹(𝑧)| = 1 4.39
Los valores de 𝑧 que cumplen simultáneamente las dos condiciones anteriores, son
las raíces de la ecuación característica, es decir, son los polos de lazo cerrado del
sistema.
Para el diseño del controlador PID por el método del LGR se utilizan la condición de
módulo y la condición de ángulo escrita en la siguiente forma:
Condición de módulo:
|𝐷(𝑧). 𝐻𝐺(𝑧)| = 1 4.40
Condición de ángulo:
∠𝐷(𝑧). 𝐻𝐺(𝑧) = −180° 4.41
Para el diseño se procede así: se asume que los polos deseados para el sistema
en lazo cerrado están ubicados en 𝑧 = 0.1 ± 𝑗0.1
La suma de los ángulos del sistema en lazo abierto, incluido el controlador debe ser
igual a -180°.
El ángulo que aporta la planta en el punto 𝑧 = 0.1 ± 0.1 está dado por:
−0.004422𝑧 3 − 0.03936𝑧 2 − 0.03106𝑧 − 0.002152
𝜃𝑝 = ∠ |
𝑧 4 − 3.3712𝑧 3 + 3.6816𝑧 2 − 1.9384𝑧 + 0.2997 𝑧=0.1±𝑗0.1
−0.0052 − 𝑗0.0039
𝜃𝑝 = ∠ 𝜃𝑝 = −94.83°
0.1122 − 0.1270𝑖
Por lo tanto el controlador debe aportar un ángulo:
𝜃𝑐 = −180 − 𝜃𝑐 = −85.17°
La ecuación del controlador PID se puede escribir en la forma:
2 𝑞1 𝑞2
𝑞𝑜 𝑧 2 + 𝑞1 𝑧 + 𝑞2 𝑞𝑜 (𝑧 + 𝑞𝑜 𝑧 + 𝑞𝑜 )
𝐷(𝑧) = =
𝑧(𝑧 − 1) 𝑧(𝑧 − 1)
Para efectos del diseño se hace 𝑞2 = −0.25𝑞1 y 𝑞1 ⁄𝑞𝑜 = −𝑥, con estas condiciones
la ecuación del controlador es:
𝑞𝑜 (𝑧 2 − 𝑥𝑧 + 0.25𝑥)
𝐷(𝑧) =
𝑧(𝑧 − 1)
55
El ángulo suministrado por el controlador es:
𝑞𝑜 (𝑧 2 − 𝑥𝑧 + 0.25𝑥)
𝜃𝐶 = ∠ | = −85.17°
𝑧(𝑧 − 1) 𝑧=0.1±𝑗0.1
=1
(−0.0516 + 𝑗0.0544)(−0.0052 − 𝑗0.0039)
𝑞𝑜 | |=1
(−0.1 − 𝑗0.08)(0.1122 − 𝑗0.127)
Luego de simular la planta en lazo cerrado, la figura 4.7 evidencia que no basta con
ubicar los polos cerca al origen y la respuesta es inestable.
56
Figura 4.7 Simulación obtenida de la planta
57
Para este caso la figura 4.9 muestra nuevamente que la planta es inestable y que
estos polos no ejercen ningún tipo de control sobre ella.
58
El en actual caso se confirma que el diseño del controlador no logra evitar la
inestabilidad de la planta, así como se muestra en la figura 4.11.
59
En la figura 4.13 se puede apreciar cómo se da la respuesta del controlador PI
experimental en tiempo real sobre la planta viga y bola.
60
criterios que son: IAE y el ICE los cuales hacen referencia a la integral del
valor absoluto del error (4.42) y la integral del error al cuadrado (4.43)
respectivamente.
∫ |𝑒(𝑡)|𝑑𝑡 4.42
0
∫ 𝑒 2 𝑑𝑡 4.43
0
61
Después de estimular la planta con un escalón del 10% representado como el
cambio del 20% al 30%, en este caso se hace con el controlador PI calculado
experimentalmente. Se puede observar en la Figura 4.13 como es la respuesta del
controlador PI clásico.
Criterios de error
OBSERVADOR PI
DE ESTADOS EXPERIMENTAL
IAE 2528.4 3857.2
62
CONCLUSIONES
63
RECOMENDACIONES
Utilizar otro tipo de sensor que genere menos ruido en la señal de salida o
utilizar filtros en paralelo a la salida del sensor para que la señal no oscile
demasiado y se aprecie un poco mejor la respuesta del sistema con respecto
al valor de referencia.
64
REFERENCIAS
Gómez, F y Aguilar, E (2002). Control de sistemas no lineales basado en la
estructura Hamiltoniana. Tesis Doctoral. Escuela Superior de Ingenieros de la
Universidad de Sevilla. Sevilla. Recuperado el 16 de octubre de 2016 de:
http://www.esi2.us.es/~fabio/tesis.pdf.
65
Moriano, P y Naranjo, F. (2012). Modelado y control de un nuevo sistema bola viga
con levitación magnética. Open Access funded by Comité Español de Automática
(CEA). Recuperado el 3 de septiembre de 2016 de:
http://www.sciencedirect.com/science/article/pii/S1697791212000386
Oporto, M. (2015). Control design for a plant Ball and Beam. Escuela técnica
superior de ingenieros industriales y de telecomunicación universidad de Cantabria.
Recuperado el 10 de septiembre de 2016 de:
https://repositorio.unican.es/xmlui/bitstream/handle/10902/6366/374763.pdf?seque
nce=1
Wahid, H y Rahmat, M (2009). A study of different controller strategies for a ball and
beam system. Jurnal Teknologi, 50(D) Jun 2009: 93–108 © Universiti Teknologi
Malaysia. Recuperado el 22 de septiembre de 2016 de:
http://eprints.utm.my/13364/2/jurnalteknologi/article/view/169
Wen Yu (2010). Nonlinear PD regulation for ball and beam system. Departamento
de Control Automático, CINVESTAV-IPN, México D.E, México. Recuperado el 24
de septiembre de 2016 de:
http://masters.donntu.org/2012/etf/pugach/library/article_3.pdf.
Wahid, H y Rahmat, M (2009). A study of different controller strategies for a ball and
beam system. Journal Teknologi. 50(D) Jun 2009: 93–108. Universiti Teknologi
Malaysia. Recuperado el 22 de octubre de 2016 de:
http://www.jurnalteknologi.utm.my/index.php/jurnalteknologi/article/view/169.
66
ANEXOS
ANEXO 1
67
68
69
70
71
72
73
74
75
76
DISEÑO E IMPLEMENTACION PARA UN SISTEMA DE
VIGA Y BOLA UTILIZANDO UN CONTROLADOR CON
OBSERVADOR DE ESTADOS DE ORDEN REDUCIDO
𝑱𝒖𝒂𝒏 𝑪𝒂𝒎𝒊𝒍𝒐 𝑳𝒐𝒑𝒆𝒛 𝑮𝒊𝒓𝒂𝒍𝒅𝒐, 𝑱𝒐𝒓𝒈𝒆 𝑫𝒂𝒏𝒊𝒆𝒍 𝑪𝒂𝒅𝒂𝒗𝒊𝒅 𝑨𝒍𝒛𝒂𝒕𝒆𝟐
1
𝑃𝑜𝑙𝑖𝑡é𝑐𝑛𝑖𝑐𝑜 𝐶𝑜𝑙𝑜𝑚𝑏𝑖𝑎𝑛𝑜 𝐽𝑎𝑖𝑚𝑒 𝐼𝑠𝑎𝑧𝑎 𝐶𝑎𝑑𝑎𝑣𝑖𝑑
juan_lopez411@elpoli.edu.co
2
𝑃𝑜𝑙𝑖𝑡é𝑐𝑛𝑖𝑐𝑜 𝐶𝑜𝑙𝑜𝑚𝑏𝑖𝑎𝑛𝑜 𝐽𝑎𝑖𝑚𝑒 𝐼𝑠𝑎𝑧𝑎 𝐶𝑎𝑑𝑎𝑣𝑖𝑑
jorge_cadavid91103@elpoli.edu.co
RESUMEN
El trabajo consiste en una modelación y control para una planta inestable en la cual se
modifica el ángulo de una viga móvil por medio del torque ejercido por un servomotor
con el objetivo de estabilizar una esfera que se desplaza por la longitud completa de la
viga, para la posición de referencia del sistema se tiene otra viga fija con una esfera
estática, para medir la posición de la bola y obtener la posición de referencia se utiliza
un sensor infrarrojo el cual envía una señal análoga de voltaje según la posición deseada
y la controlada. El sistema es modelado a través de leyes físicas y de las ecuaciones de
Lagrange para poder obtener un modelo aproximado de la planta, con este modelo se
diseña un controlador avanzado tipo observador de estados de orden reducido y un
controlador clásico PID. Estos algoritmos de control son implementados en el software
LabVIEW®, en este también se implementa la interfaz que permite manipular y
controlar las variables de entrada y salida al sistema.
ABSTRACT
The job consists of a modeling and control for an unstable plant in which there is
modified the angle of a mobile girder by means of the torque exercised by a servomotor
with the aim to stabilize a sphere that moves for the complete length of the girder, for
the position of reference of the system another fixed girder is had by a static sphere, to
measure the position of the ball and to obtain the position of reference there is in use an
infrared sensor which sends an analogous sign of voltage according to the wished
position and the controlled one. The system is shaped across physical laws and of
Lagrange's equations to be able to obtain an approximate model of the plant, with this
model there is designed a control advanced observant type of conditions of limited order
and a controller classic PID. These algorithms of control are implemented in the
software LabVIEW®, in this one also there is implemented the interface that allows to
manipulate and to control the variables of entry and exit to the system.
Key words: Modeling, position, Infrared Sensor, Servomotor, State Observer.
77
1. INTRODUCCIÓN de sensores infrarrojos, estos entregan una
El control avanzado permite trascender el señal análoga de voltaje que es proporcional
control automático de las técnicas que a la distancia de la esfera sobre la viga y así
generalmente se usan en el control de el servomotor ejerce un torque para modificar
procesos, los observadores de estados el ángulo de la viga y estabilizar la esfera.
ofrecen algunas herramientas para que la Se plantean cuatro objetivos específicos
ley de control sea exacta y en todo los cuales son:
momento brinde una rápida velocidad de Describir la planta utilizada en el
respuesta al sistema incluso si hay proyecto, sus componentes y
perturbaciones con el paso del tiempo. funcionamiento.
La finalidad de este trabajo de grado es Obtener el modelo matemático de la
implementar un control con observador de planta utilizando principios y leyes
estados de orden reducido para controlar la físicas tomando como base la las
posición de una esfera sobre una viga ecuaciones de Lagrange.
móvil afectada por un torque mecánico Elaborar un algoritmo de control con
producido por un servomotor acoplado en observador de estados de orden
una esquina de la viga para variar su reducido que permita controlar la
ángulo, la posición de la esfera se medirá posición de la esfera sobre la viga.
mediante un sensor infrarrojo, dicho Analizar el comportamiento del
sensor envía una señal análoga de voltaje controlador con observador de estados
que es proporcional a la posición de la de orden reducido y comparar su
esfera sobre la viga. desempeño con un control clásico PID
El control del sistema al ser inestable hace utilizando los criterios de error.
que se tengan en cuenta muchos factores
externos que puedan afectar el desempeño 2.1 Descripción de la planta y
de los elementos de la planta como: el funcionamiento de los componentes
viento, humedad, ruidos, etc. Con la utilizados para su implementación y
medición de posición por medio de control.
sensores infrarrojos se busca aislar La planta está conformada por tres
algunos factores que interfieran en el elementos: el primero es un servomotor
control de la planta y responder Futaba s3003 que funciona como actuador
rápidamente a perturbaciones que se y es el encargado de modificar la posición
presenten en medio de la estabilización del de la viga móvil. El segundo es el arduino
sistema. UNO, que tiene dos funciones: la primera
es la de realizar la adquisición de datos y
2. MATERIALES Y MÉTODOS la segunda generar el PWM con el cual el
La finalidad del trabajo de grado es realizar el motor controla la posición de la viga móvil
prototipo de una planta inestable que permita para estabilizar la bola, por medio de un
desarrollar prácticas de laboratorio y controlador implementado en el software
próximos trabajos de grado, así también se LABVIEW®. El tercer componente es el
realiza este trabajo con la intención de sensor infrarrojo GP2Y0A21YK
implementar controladores no vistos en el encargado de detectar la posición de la
curso académico como el observador de bola sobre la viga móvil y también usada
estados de orden reducido para controlar la como referencia para el sistema sobre una
posición de una esfera sobre una viga móvil, viga fija, además de transmitir la distancia
la posición del sistema se obtiene por medio
78
al arduino para realizar el control de la 6) Sharp GP2Y0A21YK. Es un sensor
posición en el sistema. infrarrojo el cual mide la posición de un
En la Figura 1 se muestra el prototipo objeto en su trayectoria (en este caso la
final de la planta y todos sus esfera) por medio de un haz de luz que
componentes: emite y regresa, el sensor envía una señal
análoga de voltaje de 0 a 5 VDC
dependiendo de la posición, en el caso de
la esfera sería una señal de 0,5 a 3 VDC y
tiene un rango de trabajo de 5 cm a 80 cm,
con zonas muertas cercanas a él, es decir,
antes de 5 cm no capta el objeto.
7) Módulo de voltaje. Es un módulo de
alimentación, utilizado para entregarle una
alimentación externa al servomotor y
garantizar el buen funcionamiento de este
por medio de 5VDC fijos y una buena
Figura 1 Prototipo planta viga y bola. corriente de trabajo.
3. MODELO MATEMÁTICO
1) Viga Móvil. Es un mecanismo DEL SISTEMA.
encargado de soportar es afectada por un Para la obtención de un modelo
torque mecánico para variar el ángulo de aproximado de la planta se utilizaron leyes
inclinación. físicas y las ecuaciones de Lagrange dado
2) Viga Fija. Es el mecanismo encargado que al ser una planta inestable no se puede
de soportar la esfera, usada como identificar por métodos paramétricos o no
referencia de posición para controlar el paramétricos, además de obtener unas
sistema. ecuaciones para la viga y la bola y otras
3) Mecanismo de Transmisión de para el servomotor.
movimiento. Este mecanismo se encuentra 3.1 Deducción del modelo del sistema
acoplado al eje del servomotor y Tiene mecánico de la viga y bola.
como función variar el ángulo de la viga al Para determinar el modelo matemático de
transmitirle el torque ejercido por el la planta se utiliza un diagrama de cuerpo
servomotor. libre (Elaborado por los autores), como se
4) Servomotor Futaba s3003. Se utiliza un muestra en la figura 2.
servomotor el cual tiene un rango de
operación de 0° a 180°, su alimentación
oscila entre 4.8 VDC a 6.0 VDC,
produciendo un torque de 3.2 Kg*cm
sobre la viga.
5) Arduino UNO. La tarjeta arduino tiene
dos funciones principales las cuales son:
Adquirir la señal de los sensores para
realizar la realimentación de la planta,
también se utiliza para darle la salida
PWM al servo para que el ejerza el torque Figura 2 Diagrama de cuerpo libre de la
sobre la viga. planta viga y bola.
79
Dónde: energía potencial de la viga, se expresan
𝑚𝐵 =Masa de la esfera [Kg] así:
𝑚𝑏 =Masa de la viga [Kg] Energía potencial de la esfera:
𝐽𝐵 =Momento de inercia de la esfera 𝐸𝑃𝐵 = 𝑚𝐵 𝑔ℎ𝐵 = 𝑚𝐵 𝑔𝑟𝑠𝑒𝑛𝛼
[Kg.m2] Energía potencial de la viga:
𝐽𝑏 =Momento de inercia de la viga 𝑙
𝐸𝑃𝑏 = 𝑚𝑏 𝑔ℎ𝑏 = 2 𝑚𝑏 𝑔𝑠𝑒𝑛𝛼
[Kg.m2]
La energía potencial total está dada por:
𝑅 =Radio de la esfera [m] 𝑙
𝑙 =Longitud de la viga [m] 𝑉 = 𝑚𝑏 𝑔𝑠𝑒𝑛𝛼 + 𝑚𝐵 𝑔𝑟𝑠𝑒𝑛𝛼 (3)
2
𝑟 =Desplazamiento lineal de la esfera [m]
𝛼 =Desplazamiento angular de la bola Teniendo la energía total ahora se procede
sobre la viga [Rad] a reemplazar las ecuaciones 2 y 3 en la
𝑔 =Aceleración de la gravedad [9.8m/s2] ecuación 1, obteniendo el siguiente
Para el caso de la viga y la bola, dado que resultado:
Lagrange propone calcular el Lagrangiano 1 1 𝑟̇ 2 1
𝐿 = [ 𝑚𝐵 𝑟̇ 2 + 𝐽𝐵 ( ) + (𝐽𝐵 + 𝑚𝐵 𝑟 2 )
𝐿 es igual a la diferencia entre la energía 2 2 𝑅 2
1
cinética 𝑇 y la energía potencial 𝑉. + 𝐽𝑏 𝛼̇ 2 ]
𝐿 = 𝑇−𝑉 (1). 2
𝑙
− [ 𝑚𝑏 𝑔𝑠𝑒𝑛𝛼
se procede a calcular primero la energía 2
cinética total del sistema de la siguiente + 𝑚𝐵 𝑔𝑟𝑠𝑒𝑛𝛼] (4. )
manera: La energía cinética de un cuerpo Para el sistema viga y bola se cumple la
que rueda, en este caso la esfera, es la suma siguiente ecuación:
de la energía cinética de traslación del 𝑑 𝜕𝐿 𝜕𝐿
centro de masa, la energía cinética de ( )− =𝑄 (5)
𝑑𝑡 𝜕𝑞̇ 𝑗 𝜕𝑞𝑗
rotación alrededor del centro de masa y la 𝑑 𝜕𝐿 𝜕𝐿
( )− =𝑄 (6)
energía cinética al descender un ángulo 𝛼 𝑑𝑡 𝜕𝛼̇𝑗 𝜕𝛼𝑗
Energía cinética de traslación de la Por lo tanto:
1 1 𝜕𝐿 𝐽𝐵
esfera: 𝐸𝐶1 = 2 𝑚𝐵 𝑣𝐵2 = 2 𝑚𝐵 𝑟̇ 2 = 𝑚𝐵 𝑟̇ + 2 𝑟̇ (7)
𝜕𝑟̇ 𝑅
Energía cinética de rotación de la 𝑑 𝜕𝐿 𝐽𝐵
[ ] = [𝑚𝐵 + 2 ] 𝑟̈ (8)
1 1 𝑟̇ 2 𝑑𝑡 𝜕𝑟̇ 𝑅
esfera: 𝐸𝐶𝑟 = 2 𝐽𝐵 𝜔𝐵2 = 2 𝐽𝐵 (𝑅) 𝜕𝐿
= 𝑚𝐵 𝑟𝛼 2 − 𝑚𝐵 𝑔𝑠𝑒𝑛𝛼 (9)
Energía cinética de descenso de la 𝜕𝑟
1 Es decir:
esfera: 𝐸𝐶𝑑 = 2 (𝐽𝐵 + 𝑚𝐵 𝑟 2 )𝛼̇ 2 𝑑 𝜕𝐿 𝜕𝐿 𝐽𝐵
[ ]− = [𝑚𝐵 + 2 ] 𝑟̈ − 𝑚𝐵 𝑟𝛼 2
Energía cinética de la viga al girar un 𝑑𝑡 𝜕𝑟̇ 𝜕𝑟 𝑅
1 + 𝑚𝐵 𝑔𝑠𝑒𝑛𝛼 = 0 (10)
ángulo 𝛼: 𝐸𝐶𝑏 = 2 𝐽𝑏 𝛼̇ 2 Además:
Por lo tanto, sumando las energías 𝜕𝐿
= [𝐽𝐵 + 𝐽𝑏 + 𝑚𝐵 𝑟 2 ]𝛼̇ + 2𝑚𝐵 𝑟𝑟̇ 𝛼̇ (11)
anteriores, la energía cinética total está 𝜕𝛼̇
𝑑 𝜕𝐿
dada por: [ ] = [𝐽𝐵 + 𝐽𝑏 + 𝑚𝐵 𝑟 2 ]𝛼̈ (12)
𝑑𝑡 𝜕𝛼̇
1 1 𝑟̇ 2 1 𝜕𝐿 𝑙
𝑇 = 𝑚𝐵 𝑟̇ 2 + 𝐽𝐵 ( ) + (𝐽𝐵 + 𝑚𝐵 𝑟 2 )𝛼̇ 2 = − [ 𝑚𝑏 + 𝑚𝐵 𝑟] 𝑔𝑐𝑜𝑠𝛼 (13)
2 2 𝑅 2 𝜕𝛼 2
1 𝑑 𝜕𝐿 𝜕𝐿
+ 𝐽𝑏 𝛼̇ 2 (2). [ ]− = [𝐽𝐵 + 𝐽𝑏 + 𝑚𝐵 𝑟 2 ]𝛼̈
2 𝑑𝑡 𝜕𝛼̇ 𝜕𝛼
La energía potencial está dada por la 𝑙
energía potencial de la esfera más la + [ 𝑚𝑏 + 𝑚𝐵 𝑟] 𝑔𝑐𝑜𝑠𝛼
2
+ 2𝑚𝐵 𝑟𝑟̇ 𝛼̇ = 𝜏 (14)
80
La ecuaciones 10 y 14 corresponden al
modelo del sistema viga y bola y muestran 7
𝑚 𝑟̈ − 𝑚𝐵 𝑟𝛼 2 + 𝑚𝐵 𝑔𝑠𝑒𝑛𝛼 = 0 (18).
que el sistema es no lineal. 5 𝐵
2 1
3.2 Modelado del servomotor.
[ 𝑚𝐵 𝑅 2 + 𝑚𝑏 𝑙 2 + 𝑚𝐵 𝑟 2 ] 𝛼̈
5 3
Para que el modelo de la planta sea un 𝐾𝑖 𝐾𝑚 𝑙
poco más exacto, del servo se obtienen dos + 𝛼̇
𝑅𝑚 𝑑
subsistemas: uno eléctrico y uno 𝑙
mecánico. + [ 𝑚𝑏 + 𝑚𝐵 𝑟] 𝑔𝑐𝑜𝑠𝛼
2
Para el sistema eléctrico la ecuación + 2𝑚𝐵 𝑟𝑟̇ 𝛼̇
diferencial que describe el 𝐾𝑖
comportamiento del motor es: = 𝑉 (19).
𝑅𝑚
𝑑𝑖 Para obtener la función de transferencia
𝐿𝑚 + 𝑅𝑚 𝑖 + 𝐾𝑚 𝜃̇𝑚 = 𝑉 (15).
𝑑𝑡 del sistema Si se definen como variables
𝐾𝑚 𝜃̇𝑚 = Fuerza contra electromotriz de estado 𝑥1 = 𝑟, 𝑥2 = 𝑟̇ , 𝑥3 = 𝛼, 𝑥4 =
inducida debida a la velocidad del motor 𝛼̇ , se obtiene luego de simplificar:
[Volt] 𝑥̇ 1 = 𝑥2
Para el sistema mecánico el torque 5𝑥1 𝑥32 − 5𝑔𝑠𝑒𝑛𝑥3
producido por el motor y que corresponde 𝑥̇ 2 = (20).
al aplicado a la viga para generar su 7
𝑥̇ 3 = 𝑥4
movimiento, está dado por: 𝑥̇ 4
𝐾𝑖 𝐾𝑖 𝐾𝑚 𝐾𝑖 𝐾𝐾 𝑙 𝑙
𝜏𝑚 = 𝜏 = 𝑉− 𝜃̇ (16). 𝑉 − 𝑖 𝑚 𝑥4 − [ 𝑚𝑏 + 𝑚𝐵 𝑥1 ] 𝑔𝑐𝑜𝑠𝑥3 − 2𝑚𝐵 𝑥1 𝑥2
𝑅𝑚 𝑅𝑚 𝑑 2
𝑅𝑚 𝑅𝑚 𝑚 =
2 1
𝑅𝑚 = Resistencia de la bobinas del motor 𝑚 𝑅2 + 𝑚𝑏 𝑙 2 + 𝑚𝐵 𝑥12
5 𝐵 3
[Ω] Los puntos de equilibrio del sistema
𝐾𝑚 =Constante del motor [Volt.s/rad] serian:
𝜃̇𝑚 =Velocidad angular del motor [rad/s] 𝑝0 = [𝑥𝑜1 𝑥𝑜2 𝑥𝑜3 𝑥𝑜4 𝑉0 ] =
𝑙 𝑔𝑙𝑅𝑚 (𝑚𝑏 +𝑚𝐵 )
𝐾𝑖 =Constante de torque del motor [2 0 0 0 ] (21).
2𝐾𝑖
[N.m/A]
𝑉 =Voltaje aplicado al motor [Volt] En la tabla 1 se dan los parámetros del
𝑖 =Corriente en el motor [A] sistema viga y bola construida.
Tabla 1
Por semejanza de triángulos en la figura 2 Parámetros del sistema viga y bola
se puede establecer que la relación entre el
ángulo 𝜃 girado por el eje del motor y el
ángulo 𝛼 girado por la viga es: 𝜃 = 𝑙𝛼/𝑑
por lo tanto, la ecuación 16 se transforma
en:
𝐾𝑖 𝐾𝑖 𝐾𝑚 𝑙
𝜏𝑚 = 𝑉− 𝛼̇ (17).
𝑅𝑚 𝑅𝑚 𝑑
Utilizando la ecuación 10 Reemplazando
la ecuación 17 en la ecuación 14, además
de reemplazar los valores en estas
ecuaciones se obtiene las dos ecuaciones De esta manera luego de reemplazar todos
que permiten llevar el sistema a variables los valores y realizar el tratamiento en
de estado y son:
81
espacio de estados para las derivadas la 𝑥1 (𝑘)
función de transferencia del sistema es: 𝑥2 (𝑘)
𝑦(𝑘) = [1 0 0 0]
𝑅(𝑆) −9.9225 𝑥3 (𝑘)
𝐺(𝑆) = = 4 [ 𝑥4 (𝑘) ]
𝑉(𝑆) 𝑆 + 3.544𝑆 3 − 42.603 Se asume para el diseño del controlador un
Las raíces de la ecuación característica tiempo de establecimiento 𝑡 = 4𝑠, el
son: coeficiente de amortiguamiento 𝜉 = 0.8 y
𝑆 = −4.143, 𝑆 = 1.976, 𝑆 se obtiene la ecuación característica.
= −0.6886 ± 𝑗2.174 𝑧 4 − 1.376𝑧 3 + 0.5053𝑧 2 = 0
El polo en 𝑆 = 1.976 hace que el sistema Para obtener la matriz K del observador, se
sea inestable. Así mismo, con los polos parte de la fórmula de Ackerman ecuación
estables se puede obtener una constante de 22:
tiempo equivalente igual a 𝜏 = 1.7 𝑠. 𝐾
Para discretizar el sistema se toma como = [0 0 0 1][𝐵: 𝐴𝐵: 𝐴2 𝐵: 𝐴3 𝐵]−1 𝜙(𝐴)
periodo de muestreo 𝑇 = 0.2 ∗ 𝜏 = (22).
0.34 𝑠, con lo cual se obtiene que: Resulta:
𝐺𝑝 (𝑧)
𝐾=
−0.004422𝑧 −1 − 0.03936𝑧 −2 − 0.03106𝑧 −3 − 0.002152𝑧 −4
= [−53.807 −30.5772 −17.3873 −6.3641]
1 − 3.3712𝑧 −1 + 3.6816𝑧 −2 − 1.9384𝑧 −3 + 0.2997𝑧 −4
Con:
Para el cálculo del observador de orden
4. CONTROLADOR CON reducido se tiene que el observador debe
OBSERVADOR DE ESTADOS DE ser de orden tres, se asume, que solo se
ORDEN REDUCIDO. puede medir la variable de estado 𝑥1 (𝑘) =
En la práctica, algunas de las variables de 𝑦(𝑘).
estado del sistema pueden ser medidas Se asume para el observado un 𝑡𝑠 = 3𝑠
exactamente y, por lo tanto, no es ,𝜉 = 0.8 así la ecuación característica
necesario estimarlas. En este caso, es resulta:
posible diseñar un observador que estime 𝑧 3 − 1.19𝑧 2 + 0.4021𝑧 = 0
menos de la n variables que conforman el La matriz 𝐿 del observador se calcula con
vector de estado. Se asume 𝑥𝑎 (𝑘) como la la fórmula de Ackerman ecuación 23:
−1
parte del vector de estado que puede 𝐴𝑎𝑏 0
medirse exactamente y 𝑥𝑏 (𝑘) la parte no 𝐿 = 𝜙(𝐴) [𝐴𝑎𝑏 𝐴𝑏𝑏 ] [0] (23).
medible. 𝐴𝑎𝑏 𝐴2𝑏𝑏 1
La representación en el espacio de estados Resulta:
del sistema es: −1.196
𝑥1 (𝑘 + 1) 𝐿 = [ 0.402 ]
𝑥2 (𝑘 + 1)
= 0
𝑥3 (𝑘 + 1) Entonces la ecuación del observador es:
[ 𝑥4 (𝑘 + 1) ]
𝑞(𝑘 + 1) = [𝐴𝑏𝑏 − 𝐿𝐴𝑎𝑏 ]𝑞𝑏 (𝑘)
3.3712 1 0 0 𝑥1 (𝑘)
+ 𝐿𝑦(𝑘 + 1)
[ −3.6816 0 1 0] 𝑥2 (𝑘) +
1.9384 0 0 1 𝑥3 (𝑘) + [𝐴𝑏𝑎 − 𝐿𝐴𝑎𝑎 ]𝑦(𝑘)
−0.29972 0 0 0 [ 𝑥4 (𝑘) ] + [𝐵𝑏 − 𝐿𝐵𝑎 ]𝑢(𝑘) (24).
−0.004422 La ley de control del sistema se obtiene a
[ −0.03936 ] 𝑢(𝑘) partir de la ecuación 25:
−0.03106
−0.002152
82
𝑈(𝑧)
𝐷(𝑧) = −
𝑦(𝑧)
= 𝐾1
+ 𝐾𝑏 [𝑧𝐼𝐼 − 𝐴𝑏𝑏 + 𝐿𝐴𝑎𝑏
+ (𝐵𝑏 − 𝐿𝐵𝑎 )𝑘𝑏 ]−1 [𝐿𝑧
+ 𝐴𝑏𝑎 − 𝐿𝑎𝑎 − 𝐾1 (𝐵𝑏
− 𝐿𝐵𝑎 ] (25).
Reemplazando los valores obtenidos para
las matrices K y L resulta:
𝑈(𝑧)
𝐷(𝑧) = −
𝑦(𝑧)
−49.698𝑧 3 + 67.902𝑧 2 − 45𝑧 + 7.5788
=
2.0569𝑧 3 + 1.4164𝑧 2 + 0.81419𝑧 + 0.0541416
El factor de corrección del error, se tiene: Figura 4. Simulación controlador con
𝐺𝑝 (𝑧) observador de estados reducidos.
𝐾 lim
0 =1 (26).
𝑧−1 1+𝐺𝑝 (𝑧)𝐷(𝑧)
𝐾0 = −0.625 Luego de tener la simulación, se
implementa en el software LabView®, en
Para realizar la simulación del sistema, en la figura 5 se muestra la respuesta de la
la figura 3 se muestra el diagrama de planta en tiempo real.
bloques correspondiente al sistema.
83
Para el caso del sistema viga y bola se tiene
expresado el sistema de control en lazo
cerrado como se muestra en la figura 6.
R(z) C(z)
G(z)
+
- Figura 6 Simulación obtenida de la planta
85
A continuación se presenta la gráfica de la Tabla 2
respuesta del observador de estados ante el Criterios de error
escalón, en la figura 12 se aprecia el ruido Observador PI
de la respuesta debido a la sensibilidad en de estados experimental
la señal del sensor. IAE 2528.4 3857.2
ICE 8056 10234
CONCLUSIONES
El prototipo desarrollado de la planta viga
y bola, permite simular un proceso
inestable a baja escala, sirviendo de forma
académica en asignaturas de control y/o
Figura 12 Gráfica de respuesta del modelación de procesos, dado que es poco
observador común, con esta se puede afianzar la
Después de estimular la planta con un medición y control de la variable posición
escalón del 10% representado como el y permitiría a mas estudiantes conocer
cambio del 20% al 30%, en este caso se procesos inestables.
hace con el controlador PI calculado
experimentalmente. Se puede observar en Al simular el sistema con los controladores
la Figura 13 como es la respuesta del PID se obtuvo una respuesta inestable,
controlador PI clásico. explicable por la alinealidad del sistema y
al grado de su función de transferencia,
que hace que el controlador PID, aunque
ubica dos polos en el lugar deseado y dos
polos más dentro del círculo unitario, no es
suficiente para realizar el control sobre un
quinto polo que queda ubicado fuera del
círculo unitario y éste es el que produce la
inestabilidad.
86
bajo, en cuanto al controlador PID se bola viga con levitación magnética. Open
realizó el diseño por varios métodos y Access funded by Comité Español de
con ninguno de ellos se logró realizar Automática (CEA). Recuperado el 3 de
control sobre la planta pues no se pudo septiembre de 2016 de:
eliminar la presencia de un polo http://www.sciencedirect.com/science/arti
ubicado fuera del circulo unitario. cle/pii/S1697791212000386
87
Gómez, F y Aguilar, E (2002). Control de
sistemas no lineales basado en la
estructura Hamiltoniana. Tesis Doctoral.
Escuela Superior de Ingenieros de la
Universidad de Sevilla. Sevilla.
Recuperado el 16 de octubre de 2016 de:
http://www.esi2.us.es/~fabio/tesis.pdf.
http://s2is.org/Issues/v5/n1/papers/paper2
.pdf
88