Documentos de Académico
Documentos de Profesional
Documentos de Cultura
INGENIERÍA MECATRÓNICA
NIVEL: VII
GRUPO DE PROYECTO
DANIELA BASTIDAS
DAYANA GALLEGOS
JOHAN MACAS
FERNANDO RECALDE
JHON RODRÍGUEZ
1
Índice
Contenido
1. RESUMEN ................................................................................................................. 3
1. INTRODUCCIÓN ....................................................................................................... 3
3. FUNDAMENTO TEÓRICO .......................................................................................... 10
4. DISEÑO DE LA PROPUESTA .................................................................................... 17
5. IMPLEMENTACION Y PRUEBAS ............................................................................... 32
7. RECOMENDACIÓNES ................................................................................................ 51
8. BIBLIOGRAFÍA ........................................................................................................... 51
9. ANEXOS ..................................................................................................................... 51
2
1. RESUMEN
1. INTRODUCCIÓN
2.1 Título del proyecto
3
prácticas del laboratorio, desde modelamientos matemáticos hasta aplicar
diferentes técnicas de control, permitiendo así, aplicar el conocimiento adquirido de
manera experimental mediante la utilización de dicho módulo.
Línea base.
4
1. Diseñar un sistema de equilibrio automático como herramienta de
aprendizaje donde los estudiantes de la universidad de las Fuerzas Armada
ESPE-L puedan realizar prácticas implementando control moderno en un
sistema.
2. Registrar conceptos básicos sobre las materias ya llevadas a cabo y
logrando así el modelamiento de sistemas no lineales, elementos de
adquisición de datos, tipos de controladores y diseño de la estructura que
sean aplicables al péndulo Furuta.
3. Construir un módulo académico para el laboratorio de Ingeniería
Mecatrónica de la universidad de las Fuerzas Armadas ESPE-L que permita
al sistema obtener estabilidad en posición vertical invertida, según
requerimientos de diseño, donde los costos de su desarrollo no sean
costosos.
2.6. Hipótesis
¿Un módulo didáctico enfocado en un sistema de equilibrio automático del tipo
péndulo rotacional invertido implementando técnicas de control moderno ayudará a
los estudiantes a reforzar los conocimientos adquiridos durante el aprendizaje
teórico y poder implementarlo en la práctica en el laboratorio de mecatrónica de la
Universidad de las Fuerzas Armadas ESPE Extensión Latacunga?
2.7. Metodología
La metodología utilizada en el desarrollo del proyecto ha sido de orientación crítica
comunicativa. Se trata de una metodología con una importante base teórica y
práctica.
A nivel teórico incorpora nociones y conceptos de control digital, dibujo asistido por
computador, diseño electrónico, y a nivel práctico en la implementación del módulo
de aprendizaje en el laboratorio de Mecatrónica en el estudio del comportamiento
de diferentes sistemas ya sean sub, sobre o críticamente amortiguados. Esta
metodología ha sido empleada en diversos proyectos de investigación y desarrollo
a nivel nacional e internacional que han versado sobre temáticas afines a la
resolución de falta de equipos en Universidades públicas.
2.7.1. Enfoque Metodológico.
Para la recogida de información se han utilizado técnicas tanto cuantitativas como
cualitativas.
Cuantitativas.
Un cuestionario dirigido a estudiantes y docentes implicados en las áreas de
aprendizaje de sistemas de control y control digital orientado a recoger información
relativa a:
a) los conflictos que se generan en los salones de clase por la falta de una
visualización real de las diferencias existentes entre los diferentes tipos de sistemas
y controles.
5
b) cómo beneficiaria tener un equipo que permita facilitar el aprendizaje y hacerlo
más llamativo al estudiante.
2.7.2. Contexto de la Investigación
La situación que fue objeto de estudio en esta investigación fue el rendimiento
académico de los alumnos de sistemas de control y control digital de la Facultad de
Ingeniería de la Universidad de las Fuerzas Armadas ESPE-L. Influenciado
principalmente por la falta de comprensión en los temas impartidos por las antes
mencionadas cátedras al no poder apreciar un modelo real y solo haciendo uso de
los simuladores.
2.7.3. Metodología PMI
2.7.3.1. Grupo de Procesos
2.7.3.1.1 Iniciación
El proyecto merece consideración para su realización porque está enfocado hacia
la mejora de conocimientos prácticos en las aulas de clase dentro del laboratorio
de la carrera de Mecatrónica.
6
encuentra anexado a este trabajo, para gestionar el proyecto y cumplir con lo
planificado en las fechas establecidas.
2.7.3.1.3. Ejecutar
El proyecto se ejecuta con la integración de los participantes en conjunto para el
desarrollo de las actividades, integrando a docentes que impartan conocimientos
necesarios en diversas áreas de aplicación, el grupo que realiza el proyecto y el
grupo de estudiantes que hará uso del mismo, con los recursos necesarios
establecidos por todos los involucrados.
2.7.3.1.3 Cierre
Se entregará un producto didáctico e interactivo para los estudiantes cumpliendo
con los alcances y objetivos definidos.
2.7.3.2. Áreas de conocimiento en la gestión de proyectos
2.7.3.2.1. Gestión de calidad
El producto se evaluará de acuerdo a las necesidades de los estudiantes dando
como garantía un mejor rendimiento a los estudiantes en la materia de sistemas de
control.
2.7.3.2.2. Gestión de riesgo
Los riesgos parte de la planificación
Los riesgos que se pueden ocasionar es debido
La falta de interés por la materia en algunos estudiantes.
La falta de apoyo de los ingenieros para realizar el proyecto.
Incremento de impuesto para la adquisición de materiales
El mal cuidado del material de apoyo por parte de los estudiantes.
Planificar la Gestión de Riesgos
Dar la importancia a los estudiantes de la utilización de material de apoyo para
mejorar su vida profesional.
Recalcar a los ingenieros que es módulo es de gran apoyo a los estudiantes para
realizar prácticas.
Seguimiento y Control
Es necesario dar un uso adecuando el sistema para lo cual se podrá realizar
mantenimientos predictivos., por los mismos alumnos y profesores.
2.7.3.2.3. Gestión de adquisiciones
Planificar la gestión de las adquisiciones del proyecto.
Para la adquisición de los productos como es el motor y el encoder rotativo se tiene
muchos distribuidores pero no nacionales como son ALIEXPRESS, AMAZON y
WISH debido a su amplia gama de productos de este tipo y a su fiabilidad, para la
tarjeta de adquisición de datos y la pantalla TFT se usara vendedores nacionales
ya que los precios de estos dispositivos ya están a la par con los precios
extranjeros, para los materiales de la estructura se realizara un sondeo para
7
encontrar los mejores precios en la zona y el mejor centro de mecanizado en
relación precio y calidad.
Efectuar las adquisiciones.
Una vez encontrados el motor adecuado y el encoder rotativo idóneo se debe poner
en contacto con el distribuidor determinado y adjudicarle un contrato, este proceso
se realizará para todos los componentes necesarios
Controlar de adquisiciones
En estos procesos debemos controlar las relaciones de adquisiciones con el
proveedor determinado, monitorear el contrato y su cumplimiento para el final poder
cerrar el contrato una vez obtenidos los productos
8
2.7.3.2.4. Gestión de tiempo
Ilustración 1.Cronograma
9
2.7.3.2.4. Gestión de costos
Estimación Costos
Tabla 1 Estimación de costos
PROYECTO INTEGRADOR
CAPÍTULO 1.
3. FUNDAMENTO TEÓRICO
3.1 Péndulo Invertido de Furuta
El péndulo invertido es uno de los problemas principales e interesantes en el campo de
la teoría de control, este dispositivo utiliza una barra horizontal que gira alrededor de un
eje con lo que se provoca la oscilación del péndulo mostrado en la figura 1. Con la
dirección y la velocidad de giro proporcionada por el motor se puede llegar a estabilizar
el péndulo en posición vertical y que el sistema reaccione a las perturbaciones leves
existentes en el medio. (Toro, 2009)
10
Figura 1 Péndulo Invertido Rotativo
Fuente: (EcuRed, n.d.)
11
Figura 2 Aplicaciones
Fuente: (Endesa Educa, 2014)
3.4 Arduino
Arduino es una plataforma de hardware libre, basada en una placa mostrada en la figura
3 que tiene un microcontrolador y un entorno de desarrollo, diseñada para facilitar el uso
de la electrónica en proyectos multidisciplinares. (Arduino, 2014)
Para la realización de este proyecto, la implementación de un controlador como lo es
Arduino, ya se lo utilizara como una tarjeta de adquisición de datos o también para el
diseño de los controladores.
12
Importancia del uso de laboratorios
El artículo trata de dar un enfoque de que se necesitan módulos virtuales como se puede
observar la interfaz gráfica virtual en la figura 1, para entender de una mejor manera el
concepto de ingeniera de control, sin embargo es una implementación de módulo virtual
relacionándolo con nuestra necesidad puede ser mejorado a un módulo didáctico con
parte de hardware incorporado.
Fuente: scielo.conicyt.cl
El artículo científico con el tema de “Control clásico y moderno sobre células Peltier en
un entorno didáctico”, cita lo siguiente: Uno de los inconvenientes clásicos del desarrollo
docente de las asignaturas de Automática es el uso de las funciones de transferencia
(FDT), donde los sistemas físicos se representan por medio de cajas negras y sus
comportamientos dinámicos se modelan mediante las FDTs. Si bien este planteamiento
no se discute, por razones obvias, no es menos verdad que, muchas veces, el alumno
pierde las nociones físicas al aplicar las técnicas de análisis y diseño de la teoría del
Control. Además, el encuentro del estudiante con sistemas físicos reales, le introduce en
los usos prácticos típicos de la ingeniería, tales como: el empleo de la instrumentación,
la validación de las hipótesis y las aproximaciones ingenieriles, tan empleadas en el
trabajo de campo y tan desestimadas en las clases de teoría o en los problemas de
simulación con ordenador. Sin duda alguna, la llegada de programas como MATLAB,
SCILAB o CC han vitalizado enormemente la didáctica de la Automática, sobre todo, en
el laboratorio y como herramienta de estudio personal. Sin embargo, estas habilidades
no cubren muchos de los conceptos empleados en el trabajo experimental. El éxito del
laboratorio nace de la combinación del trabajo de la simulación acompañado con su
puesta en práctica. Por tanto, se requiere de una maqueta de entrenamiento que sea
capaz de ilustrar los conceptos básicos del control, que pueda integrar los conceptos de
la especialidad. (Platero, 2000).
14
Este articulo menciona la importancia de implementar módulos prácticos que puedan ser
de uso didáctico en las aulas de clase para conceptualizar de una mejor manera los
conceptos de ingeniería de control, ya que esta es base para partir hacia otros conceptos
de mayor alcance, presenta un módulo de control de células Peltier, con el objetivo de
garantizar una mejor enseñanza, sin embargo los métodos de enseñanza pueden ser en
diversos tipos de planta.
Tras la búsqueda de él porque utilizar un péndulo invertido como un módulo para reforzar
el aprendizaje en estudiantes se definió en tres documentos sobre el tema a tratar.
El péndulo invertido es conocido por ser uno de los problemas más importantes y clásicos
de la teoría de control. Se trata de un control inestable y no lineal. A menudo, es utilizado
como ejemplo académico, principalmente por ser un sistema de control más accesible, y
por otro lado, permite mostrar las principales diferencias de control de bucle abierto y de
su estabilización a bucle cerrado (Alonso, 2010)
El módulo de péndulo desafía a los estudiantes a no solo modelar y controlar un
péndulo, sino también a aprender sobre los sistemas de control híbridos ajustando
un sistema de control abatible. Además de enseñar conceptos de control
intermedio, el péndulo giratorio invertido se puede utilizar para la investigación en
diversas áreas, incluido el control difuso. (Quanser, n.d.)
El péndulo invertido es un sistema mecánico clásico para probar nuevas ideas en la
disciplina del control. Tiene la ventaja de ser, por un lado, un mecanismo relativamente
sencillo, y por el otro, un sistema que contiene puntos inestables. El péndulo invertido se
ha usado ampliamente como patrón para comparar tanto algoritmos de control, como el
hardware para implementarlos. (Luna, 2003)
En las referencias expuestas, el péndulo invertido se lo utiliza como módulos académicos
para aplicación en sistemas de control esto es debido a que el dispositivo es accesible
ya que abarca diferentes técnicas de control, y realizado para que los estudiantes
obtengan el conocimiento mediante prácticas, El módulo se vuelve ideal para introducir
conceptos de control intermedio y avanzado y puede ser usado para demostrar los
desafíos de control del mundo real relacionados.
El modelo de péndulo de invertido rotacional es debido a que la infraestructura básica
emplea características esenciales a comparación de a un péndulo invertido lineal o
controlado por un vehículo ya que posee portabilidad su costo es mucho menor y su
tamaño es reducido,
El péndulo invertido giratorio (RIP) es un problema difícil de controlar; se han realizado
varios estudios en los que se han aplicado diferentes técnicas de control. La literatura
informa que, aunque el problema no es lineal, los controladores PID clásicos presentan
rendimientos apropiados cuando se aplican al sistema. (Lima, Cajo, Huilcapi, & Agila,
2017)
Las diferencias entre los péndulos invertidos radican en el tipo de intervención que se le
realice a la barra invertida: unos dados por un movimiento lineal de un carro sobre un riel;
15
otros por la acción de la inercia de un volante; otros por la acción de una barra en
movimiento rotacional; etc. (Javier Gonzalo González Fontanet, 2016 )
El péndulo de Furuta (PF) ha resultado hasta nuestros días, el más implementado por los
investigadores de diversas ramas de la ciencia y la industria. (Valenzuela, 2012)
El control de un péndulo invertido rotatorio es uno de los problemas más interesantes en
el campo de control, ya que constituyen un banco de pruebas muy completo e
interesante. Inicialmente en los años 80 se podía ver este sistema en los laboratorios de
control de las Universidades más prestigiosas. Lo interesante de péndulo invertido es
su no linealidad y su alto grado de inestabilidad ya que en la vida real ningún sistema es
lineal y debe ser linealizado de acuerdo a un punto de trabajo. (Krishna, 2014)
El control del péndulo invertido es llevar el péndulo desde una posición inicial a las
proximidades de la posición deseada y el estabilizar el péndulo en la posición invertida.
El ‘Swing up’se trata de un problema no lineal, donde el tratamiento lineal insuficiente y
sirve como banco de pruebas para las diversas teorías de control no lineal.
Una ventaja clara de este sistema es que se pueden emplear controladores híbridos para
realizar el control uno para el Swing up y otro para el estabilizador, por lo tanto, se pueden
aplicar diferentes técnicas de control conmutadas. (Krishna, 2014)
Como antes mencionado en el módulo se podrá diseñar varios controladores para este
sistema. El primer método a utilizar es el más popular para controlar sistemas siso, pero
en este caso se aplicará un control PID con 2 grados de libertad, para se usará el lugar
geométrico de las raíces para diseñar los dos controladores PID. (Hartung, 2011)
Diseñar el controlador usando dos PID para los dos grados de libertar es una tarea
complicada ya que el péndulo invertido es altamente no lineal y en laso abierto es instable.
Los otros métodos a usar pertenecen a las técnicas de control moderno las cuales son
FSF ‘Full State Feedback’ y LQR ‘Linear Quadratic Regulator’, estas tecnicas son usadas
para realizar el control del péndulo si este se encuentra cerca de la referencia y si este
se encuentra en la posición inicial hacia abajo. (Hartung, 2011)
Análisis de la Investigación Bibliográfica
De acuerdo a la información obtenida de la investigación realizada se ha podido analizar
que para mejorar la comprensión y adquisición de los conocimientos impartidos en las
aulas de clase se requiere un módulo invertido rotacional de furuta, puesto que es la
alternativa más viable para llevar y cumplir con el objetivo de este proyecto, porque es el
mejor para el estudio de los diferentes tipos de sistemas de control, además también se
hace uso de los conocimientos adquiridos de otras asignaturas impartidas a lo largo de
16
la carrera haciéndolo más educativo e intuitivo al estudiante ya que se correlaciona con
conocimientos ya aprendidos.
El proceso de control y visualización de las gráficas se va a realizar mediante el software
Matlab 2015a teniendo en cuenta que el entorno de trabajo en comparación a otros
softwares de procesamiento es mejor y más intuitivo.
CAPÍTULO 2.
4. DISEÑO DE LA PROPUESTA
INTRODUCCIÓN
4.1 ASIGNATURAS
Para determinar un diseño adecuado en el desarrollo de la propuesta es necesario
presentar las materias que abarcan los conocimientos necesarios para poder hacer
desarrollo de la misma.
Diseño asistido por computadora - Nos permitió poder diseñar el CAD en
SolidWorks
Sistemas de Control - Nos ayudó a poder comprender los diferentes tipos de
técnicas de control.
Control Digital – Nos ayudó porque aplicamos técnicas en espacios de estado
debido a que el sistema es no lineal en lazo abierto y altanamente inestable.
Métodos Numéricos – Gracias a esta materia hemos podido obtener la derivada
computacional de la posición del sistema.
Mecánica de Materiales – Esta materia nos permitió analizar la inercia de la
estructura, los esfuerzo y cargas axiales a las que van a estar sometidas cada
parte del sistema, permitiéndonos de esta manera hacer una correcta selección
del material.
17
4.2 DESCRIPCIÓN DEL MÓDULO DIDÁCTICO TIPO PÉNDULO
Fuente: Autores
Para el diseño de la base se toma en cuenta las figuras geométricas más simples
tomando en cuenta la adquisición y fabricación de las mismas.
19
𝑏 ∗ ℎ3
𝐼=
36
(25𝑐𝑚) ∗ (15𝑐𝑚)3
𝐼=
12
𝑰 = 𝟐𝟑𝟒𝟑. 𝟕𝟓 𝒄𝒎𝟒
Momento de inercia del círculo
En comparación con las diferentes figuras se tiene que la que tiene mayor inercia es la
rectangular, por lo que se escogerá esa forma para la base de la maqueta.
También influyo el fácil acceso y facilidad de adquisición de una base de esta forma en
este caso rectangular, ya que las otras formas geométricas como el círculo o el triángulo
se hacen en base a un rectángulo para maquinar y obtener la figura deseada.
20
𝑅𝐶
𝑅𝐴
Figura 6. Fuerzas en X y Y
Fuente: Autores
∑𝐹𝑥 = 0
−𝑅𝐶 + 𝑅𝐴 = 0
𝑅𝐶 = 𝑅𝐴 = 0.3 ∗ 9.81 = 2.94 𝑁
Fuente: Autores.
21
Figura 8. Momentos en XZ
Fuente: Autores.
∑𝑀𝐴 = 0
La fuerza centrífuga causada por el péndulo al momento de rotar para que se quede en
posición vertical es calculada como:
𝑅𝐴𝑐𝑒𝑛 = 𝑀𝑝𝑒𝑛𝑑𝑢𝑙𝑜 ∗ 𝜔2 ∗ 𝑟
Considerando una velocidad angular dada por un motor de: 1.628 rad/seg o 16 rpm
𝑟𝑎𝑑 2
𝑅𝐴𝑐𝑒𝑛 = (0.08 𝑘𝑔) ∗ (1.628 ) ∗ (0.206𝑚)
𝑠𝑒𝑔
𝑅𝐴𝑐𝑒𝑛 = 0.04368 𝑁
Entonces
𝑇𝐴 − 𝑅𝐴𝑐𝑒𝑛 ∗ 20.6 𝑐𝑚 = 0
𝑇𝐴 = 0.04368 𝑁 ∗ 20.6𝑐𝑚 = 0.9 𝑁𝑐𝑚
𝑇𝐴 = 0.091 𝑘𝑔. 𝑐𝑚
22
Figura 9. Características de las dimensiones del motor.
Fuente: Autores.
Fuente: Autores.
Acero 1040
El modelo matemático del péndulo de Furuta se obtiene a partir del análisis dinámico
del movimiento y las fuerzas que lo originan, a partir de esto se obtienen las variables
del sistema que ecuaciones diferenciales correspondientes a coordenadas
generalizadas [1]. Esto corresponde a la ecuación de Euler-Lagrange:
𝑑 𝜕𝐿 𝜕𝐿
( )− =0 (1)
𝑑𝑡 𝜕𝑞̇ 𝑖 𝜕𝑞𝑖
𝐿 = 𝐾𝑇 − 𝑃𝑇
Siendo 𝐾𝑇 la energía cinética total y 𝑃𝑇 es la energía potencial total del sistema y para el
caso del péndulo de Furuta se tendrán las siguientes coordenadas generalizadas: 𝑞1 para
el ángulo 𝜑 y 𝑞2 el ángulo del péndulo 𝜃.
Toro (Toro, 2009) menciona: “Normalmente la energía potencial está en función sólo de
las coordenadas generalizadas, pero la energía cinética no sólo es función de las
coordenadas generalizadas, sino también de sus derivadas”. Así se puede inferir que la
respuesta 𝐿 de la ecuación de Euler-Lagrange (Lagrangiano) está en función de las
coordenadas generalizadas y sus derivadas.
Además, para el modelo matemático es necesaria la representación gráfica del sistema
que se logra con dos elementos del péndulo, el brazo (conectado al motor) y el péndulo,
como se tiene en la siguiente figura:
24
𝒛
Péndulo
Brazo
𝜽
𝝉
𝒍
𝝋
𝒓 𝒚
𝒙
Fuente: Autores.
Donde:
𝝉 , torque del motor aplicado al brazo.
𝝋 , ángulo de rotación (posición) entre el eje x y el brazo.
𝜽 , ángulo de rotación (posición) entre la paralela del eje z y el péndulo.
𝒓 , longitud del brazo.
𝟐𝒍 , longitud total del péndulo.
Además, el sistema del péndulo de Furuta tiene las siguientes coordenadas del centro
de masa:
𝒙𝑮 = 𝑟 cos(𝜑) − 𝑙 sin(𝜃) sin(𝜑) (2)
𝒚𝑮 = 𝑟 sin(𝜑) + 𝑙 sin(𝜃) cos(𝜑) (3)
𝒛𝑮 = 𝑙 cos(𝜃) (4)
4.3.1.1 ENERGÍA POTENCIAL
𝐾𝑇 = 𝐾𝐵 + 𝐾𝑃 (5)
Siendo 𝐾𝐵 y 𝐾𝑃 , representa la energía cinética del brazo y del péndulo,
respectivamente. Así, primero, la ecuación de energía para el brazo (Toro, 2009):
1
𝐾𝐵 = 𝐽0 𝜑̇ 2 (6)
2
𝐽0 es la inercia rotacional del brazo. Para el péndulo:
𝐾𝑃 = 𝐾𝜔 + 𝐾𝑉𝑥 + 𝐾𝑉𝑦 + 𝐾𝑉𝑧 (7)
25
En donde 𝐾𝜔 es la energía cinética producida por la velocidad angular, 𝑉𝑥 es la
velocidad radial, 𝑉𝑦 es la velocidad tangencial y 𝑉𝑧 es la velocidad vertical del péndulo,
entonces:
1
𝑲𝝎 = 𝐽1 𝜃̇ 2 (8)
2
𝐽1 es la inercia rotacional del péndulo.
𝑑 𝑥𝐺 𝑑
𝑉𝑥 = = [𝑟 cos(𝜑) − 𝑙 sin(𝜑) sin(𝜃)]
𝑑𝑡 𝑑𝑡
𝑽𝒙 = −𝑟𝜑̇ sin(𝜑) − 𝑙𝜑̇ sin(𝜃) cos(𝜑) − 𝑙𝜃̇ sin(𝜑) cos(𝜃) (9)
𝑽𝟐𝒙 = 𝑟 2 𝜑̇ 2 sin2 (𝜑) + 𝑙 2 𝜑̇ 2 sin2 (𝜃) cos2 (𝜑) + 𝑙 2 𝜃̇ 2 sin2 (𝜑) cos2 (𝜃)
+ 2 𝑟𝑙𝜑̇ 2 sin(𝜑) cos(𝜑) sin(𝜃) + 2 𝑟𝑙𝜑̇ 𝜃̇ sin2(𝜑) cos(𝜃) (10)
+ 2 𝑙 2 𝜑̇ 𝜃̇ sin(𝜑) cos(𝜑) sin(𝜃) cos(𝜃)
𝑑 𝑦𝐺 𝑑
𝑉𝑦 = = [𝑟 sin(𝜑) − 𝑙 cos(𝜑) sin(𝜃)]
𝑑𝑡 𝑑𝑡
𝑽𝒚 = 𝑟𝜑̇ cos(𝜑) + 𝑙𝜃̇ cos(𝜃) cos(𝜑) − 𝑙𝜑̇ sin(𝜑) sin(𝜃) (11)
𝑽𝟐𝒚 = 𝑟 2 𝜑̇ 2 cos2 (𝜑) + 𝑙 2 𝜃̇ 2 cos2 (𝜃) cos2 (𝜑) + 𝑙 2 𝜑̇ 2 sin2 (𝜑) sin2(𝜃)
+ 2 𝑟𝑙𝜑̇ 𝜃̇ cos 2 (𝜑) cos(𝜃) − 2𝑟𝑙𝜑̇ 2 cos(𝜑) sin(𝜑) sin(𝜃) (12)
− 2 𝑙 2 𝜑̇ 𝜃̇ sin(𝜑) cos(𝜑) sin(𝜃) cos(𝜃)
𝑑 𝑧𝐺 𝑑
𝑉𝑧 = = [𝑙 cos(𝜃)]
𝑑𝑡 𝑑𝑡
𝑽𝒛 = −𝑙𝜃̇ sin(𝜃) (13)
Así, reemplazando (6) y (16), la ecuación de energía cinética total de (5) es:
26
1 1 1 1 1
𝑲𝑻 = 𝐽0 𝜑̇ 2 + 𝐽1 𝜃̇ 2 + 𝑚𝑃 𝑟 2 𝜑̇ 2 + 𝑚𝑃 𝑙 2 𝜑̇ 2 sin2 (𝜃) + 𝑚𝑃 𝑙 2 𝜃̇ 2
2 2 2 2 2 (17)
+ 𝑚𝑃 𝑟𝑙𝜑̇ 𝜃̇ cos(𝜃)
𝑃𝑃 = 𝑚𝑃 𝑔𝑙 cos(𝜃) − 𝑚𝑃 𝑔𝑙
(20)
𝑷𝑷 = 𝑚𝑃 𝑔𝑙 [cos(𝜃) − 1]
Sumando las anteriores ecuaciones se obtienen la energía potencial total del péndulo de
Furuta:
𝑷𝑻 = 𝑚𝑃 𝑔𝑙 [cos(𝜃) − 1] (21)
27
𝑑 𝜕𝐿 𝜕𝐿
𝜏1 = ( )−
𝑑𝑡 𝜕𝜃̇ 𝜕𝜃
̈
𝝉𝟏 = 𝜃[𝐽1 + 𝑚𝑝 𝑙 ] + 𝜑̈ [𝑚𝑝 𝑟𝑙 cos(𝜃)] − 𝑚𝑝 𝑔𝑙 sin(𝜃) − 𝑚𝑝 𝑙 2 𝜑̇ 2 cos(𝜃) sin(𝜃)
2
La finalidad de este es que pueda cumplir con la respuesta del sistema a controlar con
una serie de especificaciones de funcionamiento dinámicas y estáticas y las
perturbaciones asociadas a su funcionamiento
Para ello se utilizó el control mediante la utilización de controladores complementarios.
Un control se encargara de ubicar a la respuesta designada del péndulo y el otro control
se basara en posicionar en si el péndulo para que se mantenga.
El trabajo estará enfocado en una retroalimentación de estado para establecer un control
de equilibrio
Control PID
Es un controlador realimentado cuyo propósito es hacer que el error en estado
estacionario, entre la señal de referencia y la señal de salida de la planta. En este caso
se aplicara para el uso manual de las personas que se va a ocupar dando total atención
a los estudiantes que estén incursionando a la materia de control como principiantes.
28
Figura 12. Estructura control del Péndulo de Furuta
Fuente: Autores
(22)
Con la anterior representación en espacios de estados se procede a realizar el algoritmo
mostrado en la figura 13 para poder encontrar las ganancias de estado con él se estabiliza
el sistema alrededor del punto de equilibrio.
29
Figura 13. Programación del Péndulo de Furuta
Fuente: Autores
30
Figura 14. Diagrama de Flujo del Control
Fuente: Autores
31
CAPITULO 3
5. IMPLEMENTACION Y PRUEBAS
5.1 IMPLEMENTACIÓN DEL SISTEMA EN SOFTWARE SIMULINK
Para la representación del sistema se hizo uso Simulink el cual podemos analizar en la
figura 16 debido a que se pueden representar un sistema en espacios de estados de una
manera mucho más sencilla, pero también se hizo el análisis del sistema paso a paso en
un script de Matlab.
En Simulink se introdujo las contantes de retroalimentación la señal de referencia y un
sistema modelado en V-Real-Builder como se muestra en la figura 15 y 17 para poder ver
de una más sencilla el comportamiento del sistema en cada una de sus elementos.
Fuente: Autores
Fuente: Autores
32
Figura 17. Estructura Simulink del Péndulo de Furuta
Fuente: Autores
#include <digitalWriteFast.h>
float uk = 0;
float uk_1 = 0;
float ek = 0;
float ek_1 = 0;
float ek_2 = 0;
// Quadrature encoders
// Left encoder
#define c_LeftEncoderInterrupt 4
#define c_LeftEncoderPinA 19
#define c_LeftEncoderPinB 25
#define LeftEncoderIsReversed
volatile bool _LeftEncoderBSet;
volatile long _LeftEncoderTicks = 200;
long angulo = 0;
long angulo_ant = 0;
long angulo2 = 0;
long angulo2_ant = 0;
float velocidad2 = 0;
float ang_rad2 = 0;
unsigned int t_ant = 0;
33
unsigned int t_act = 0;
int dt = 0;
float velocidad = 0;
float ang_rad = 0;
float u = 0;
float E = 0;
float Eresp = 0;
float coseno = 0;
float salida = 0;
unsigned char pwm_mot = 0;
#define w0 13
void setup()
{
Serial.begin(115200);
// Quadrature encoders
// Left encoder
pinMode(c_LeftEncoderPinA, INPUT_PULLUP); // sets pin A as input
pinMode(c_LeftEncoderPinB, INPUT_PULLUP); // sets pin B as input
attachInterrupt(c_LeftEncoderInterrupt, HandleLeftMotorInterruptA, RISING);
// Right encoder
// pinMode(c_RightEncoderPinA, INPUT); // sets pin A as input
// pinMode(c_RightEncoderPinB, INPUT); // sets pin B as input
// attachInterrupt(c_RightEncoderInterrupt, HandleRightMotorInterruptA, RISING);
pinMode(12, OUTPUT);
pinMode(13, OUTPUT);
pinMode(6, OUTPUT);
digitalWrite(12, LOW);
digitalWrite(13, LOW);
digitalWrite(6, LOW);
// TIMER4
TCCR4A = 0B10000001;
TCCR4B = 0B00000011;
OCR4A = 0;
digitalWrite(12, HIGH);
digitalWrite(13, LOW);
OCR4A = 150;
delay(200);
digitalWrite(12, HIGH);
}
void loop()
{
34
t_act = micros();
angulo = 0.9 * _LeftEncoderTicks;
// angulo2 = 3.6 * _RightEncoderTicks;
dt = t_act - t_ant;
ang_rad = angulo * 0.01745;
// ang_rad2 = angulo2 * 0.01745;
velocidad = (angulo - angulo_ant) * (17453);
velocidad /= dt;
// velocidad2 = (angulo2 - angulo2_ant) * (17453);
// velocidad2 /= dt;
//u = -3.16 * ang_rad2 + 301.57 * ang_rad - 11.35 * velocidad2 + 73.6 * velocidad;
//u *= 10.63;
///*
if (abs(angulo) > 12)
{
coseno = cos(ang_rad);
u = (velocidad * coseno);
E = 0.5 * pow((velocidad / w0), 2) + coseno - 1;
Eresp = E;
E *= 375;
salida = abs(E);
}
else
{
// */
ek = - angulo;
uk = uk_1 + 239.7 * ek - 306.8 * ek_1 + 69.91 * ek_2;
// uk = uk_1 + 217.4 * ek - 253.28 * ek_1 + 38.85 * ek_2;
ek_2 = ek_1;
ek_1 = ek;
uk_1 = uk;
u = uk;
salida = abs(u);
}
if (u >= 0)
{
digitalWrite(13, HIGH);
digitalWrite(12, LOW);
Serial.print("DERECHA: ");
Serial.print("\t");
}
if (u < 0)
35
{
Serial.print("IZQUIERDA: ");
Serial.print("\t");
digitalWrite(12, HIGH);
digitalWrite(13, LOW);
}
if (salida > 255)
salida = 255
pwm_mot = (unsigned char) salida;
OCR4A = pwm_mot;
Serial.print("`DT: ");
Serial.print(dt);
Serial.print("\t");
Serial.print("salida: ");
Serial.print(pwm_mot);
Serial.print("\t");
Serial.print("ang1: ");
Serial.print(angulo);
Serial.print("\t");
Serial.print("ang2: ");
Serial.println(angulo2);
_delay_ms(10);
t_ant = t_act;
angulo_ant = angulo;
angulo2_ant = angulo2;
}
// Interrupt service routines for the left motor's quadrature encoder
void HandleLeftMotorInterruptA()
{
// Test transition; since the interrupt will only fire on 'rising' we don't need to read pin A
_LeftEncoderBSet = digitalReadFast(c_LeftEncoderPinB); // read the input pin
// and adjust counter + if A leads B
#ifdef LeftEncoderIsReversed
_LeftEncoderTicks -= _LeftEncoderBSet ? -1 : +1;
#else
_LeftEncoderTicks += _LeftEncoderBSet ? -1 : +1;
#endif
if (abs(_LeftEncoderTicks) == 400)
_LeftEncoderTicks = 0;
}
5.3 IMPLEMENTACIÓN ESTRUCTURAL
36
Para la implementación estructural del péndulo rotacional invertido se ha incorporado
elementos necesarios para su funcionamiento, los cuales detallamos a continuación:
Encoder
Motor DC
Pesa 100g
Estructura Málica
Tarjeta Controladora
5.3.1 ENCODER
El péndulo rotacional invertido precisa de 2 encoders necesarios para leer la posición y
velocidad del péndulo y del motor respectivamente. Para leer la posición del péndulo se
escogió el encoder LPD3806. A continuación, se presenta las características tomadas del
datasheet referente al encoder que se indica en la figura
Tipo LPD3806-600BM-G5-24C
Señal de contacto Salida Colector abierto
Pulsos por Rev. 400 PPR
Funcionamiento Sistema operativo incremental
Voltaje de alimentación 5 – 24 VDC
Frecuencia máxima 30 KHz
Velocidad máxima 5000 rev/min
Consumo máximo 40mA
Fuente: Autores
37
5.3.2 MOTOR DC
Para realizar el levantamiento del péndulo se utilizó un motor DC de 24 V y velocidad, el
mismo que se muestra en la figura 2. Las características tomadas del datasheet del motor
se muestra a continuación.
Fuente: Autores
Tipo DSE38BE27-001
Velocidad máxima 4400 RPM
Voltaje de alimentación 24 VDC
Consumo máximo 1500 mA
38
Figura 20. Pesa 100 g Aluminio 6061-T6
Fuente: Autores
Fuente: Autores
39
5.4 PRUEBAS
Se realizó sintonización experimental para obtener valores de las constantes de control y
así se pudo determinar una estabilidad en base a la gráfica obtenida como se muestra en
la tabla 2 y figura 21
Tabla 4 Constantes de Control
Fuente: Autores
40
Pregunta 1
IMPLEMENTACIÓN DE ALGORITMO
3%
10%
1
3%
2
3
47% 37%
4
5
Fuente: Autores
Análisis
Pregunta 2
MÉTODOS DE SINTONIZACIÓN
5% 12%
1
0%
2
25% 3
58% 4
5
Fuente: Autores
41
Análisis
Pregunta 3
TIEMPO DE MUESTREO
0%
0%
8%
1
22% 2
3
4
70%
5
Fuente: Autores
Análisis
Pregunta 4
42
RECONOCIMIENTO DE VARIABLES
0%
13%
20% 1
2
27% 3
4
40% 5
Fuente: Autores
Análisis
Pregunta 5
CONSTANTE PROPORCIONAL
2%
5%
7% 1
8%
2
3
78%
4
5
Fuente: Autores
43
Análisis
Pregunta 6
CONSTANTE INTEGRAL
3%
7%
10%
1
2
25%
3
4
55% 5
Fuente: Autores
Análisis
Pregunta 7
44
CONSTANTE DERIVATIVA
7%
3%
15% 1
20% 2
3
4
5
55%
Fuente: Autores
Análisis
ANÁLISIS GENERAL
Se pueden interpretar como los resultados de todas las preguntas en un nivel intermedio
en su mayoría, sin embargo lo que se busca es alcanzar que los estudiantes dominen y
refuercen los conocimientos en base a los conocimientos adquiridos en las diferentes
materias de control.
45
Se explicó a los estudiantes cómo funcionaba el modulo, dándoles una guía de uso,
siguiendo los pasos propuestos en las guías, los estudiante pudieron identificar el
algoritmo implementado, los métodos existentes y como hacer uso en el módulo, luego
de dar una introducción al módulo, procedieron a manipular y cambiar variables con los
pasos mostrados en la guía y en base a esto se volvió a realizar la prueba obteniendo
los siguientes resultados.
Pregunta 1
IMPLEMENTACIÓN DE ALGORITMO
0%
7%
1
13%
2
25%
3
4
55%
5
Fuente: Autores
Análisis
Pregunta 2
46
MÉTODOS DE SINTONIZACIÓN
13%
7%
2%
1
2
3
38%
40% 4
5
Fuente: Autores
Análisis
Pregunta 3
TIEMPO DE MUESTREO
0%
10%
1
25%
2
25% 3
4
40% 5
Fuente: Autores
47
Análisis
Pregunta 4
RECONOCIMIENTO DE VARIABLES
0%
15% 10%
1
2
25%
3
4
50% 5
Fuente: Autores
Análisis
Pregunta 5
48
CONSTANTE PROPORCIONAL
0%
10%
0% 1
35% 2
3
4
55%
5
Fuente: Autores
Análisis
Pregunta 6
CONSTANTE INTEGRAL
2%
8%
0% 1
2
40% 3
50% 4
5
Fuente: Autores
49
Análisis
Pregunta 7
CONSTANTE DERIVATIVA
0%
7%
13%
1
2
37% 3
4
43%
5
Fuente: Autores
Análisis
ANÁLISIS GENERAL
7. RECOMENDACIÓNES
8. BIBLIOGRAFÍA
Arduino. (2014, Octubre). Arduino. Retrieved from Arduino:
http://arduino.cl/que-es-arduino/
Hartung, C. (2011). Robust Fuzzy Cascade Control Revised: Application to
the Rotary Invert Pensulum. 1-2.
Krishna, R. K. (2014). Modeling and Controller Designing of Rotary Inverted
Pendulum (RIP)-Comparison by Using Various Design Methods. 1-2.
Toro, R. (2009). Diseño y control de un péndulo Furuta para la utilización en
las aulas de clase en la universidad EAFIT. 12-15.
9. ANEXOS
51