Documentos de Académico
Documentos de Profesional
Documentos de Cultura
Informe Del Trabjo Final - Control
Informe Del Trabjo Final - Control
CURSO
Ingeniería de Control 1
PROFESOR
Sergio Nicolas Gonzales Lecaros
TEMA
Trabajo Final
INTEGRANTES
Alumnos Código Carrera
SECCIÓN
LS6B
SEMESTRE
2020 – 02
Hoverboard
INTRODUCCIÓN
El vehículo debido a que tiene que mantener el equilibrio similar a un péndulo invertido, tiene
un cierto grado de inestabilidad. Por ello, se considera al sistema como un gran ejemplo al
cual se pueden aplicar diversos conocimientos fundamentales de control. Para realizar la
debida implementación, el presente trabajo implicó usar herramientas como el MATLAB para
la elaboración de las ecuaciones necesarias y la simulación del sistema, así mismo, para
implementación del software se usará el MPLAB para la programación del PIC 18F4550, para
el correcto control de todo el sistema funcional de los hoverboards.
Figura 1
Partes del Hoverboard y sistema eléctrico de control
PLANTEAMIENTO Y ANÁLISIS DEL PROBLEMA
Error en sensores: Es común que existan problemas con el sensor de presión, el cual
se encarga de ajustar y equilibrar el dispositivo en base al peso del usuario. Al censar
correctamente al usuario, provoca que sea aún más inestable y sea más difícil
mantener el equilibrio.
Bloqueo en alguna de las ruedas: Debido al constante uso, con el tiempo, uno de los
lados del hoverboard suele fallar, bloqueando un solo lado y provocando que el
usuario no lo pueda usar
Dada la complejidad del dispositivo, este trabajo solo se enfocará en el problema del
posicionamiento del dispositivo debido al mal funcionamiento del giroscopio. La función de
este sensor dentro del dispositivo es medir el movimiento angular que ejerce la persona sobre
el hoverboard, con finalidad de avanzar, girar o retroceder. En otras palabras, el giroscopio
es el sensor encargado de medir el “equilibrio” de la persona sobre las plataformas, y con
esto, el sistema de control procesa la dirección hacia la que se moverá. Sin embargo, durante
su funcionamiento puede presentar fallas por las siguientes fuentes: perturbaciones al
sistema de control que afectan al sensor y controladores del equipo, además de fallas
mecánicas como el desgaste en las piezas, cables y motores, así mismo, que el sistema falle
durante su modo correctivo (la tara del sistema). Todos estos conjuntos de fallas dentro del
sistema de control pueden ser explicadas debido al mal funcionamiento del giroscopio.
El presente trabajo, tomará como planta al hoverboard por lo cual se analizará detalladamente
su modelo matemático. Una vez estudiado y comprendido, se buscará alterar la funcionalidad
de giroscopio alterando el modelo matemático previamente obtenido. En base a esto, se
realizará un riguroso estudio en Matlab y se analizará cómo estas perturbaciones llegan a
generar alteraciones o retrasos a la funcionalidad del sistema y se buscará corregir y prevenir
la mayor cantidad de errores, utilizando un modelo matemático que pueda prevenir estas
fallas, indicando al usuario por medio de un led, cuando es tiempo de una nueva calibración
o cambio de los sensores. Para que, finalmente, el usuario pueda disfrutar de manera más
sencilla y segura de su hoverboard en sus tiempos de ocio, haciendo de este tiempo uno
mucho más agradable.
OBJETIVOS
MODELAMIENTO DE LA PLANTA
Figura 2
Señal de la planta en lazo cerrado que se intentara modelar mediante el método de
identificación de sistemas
De la gráfica, se puede obtener el tiempo de establecimiento y el sobreimpulso. A partir de
estos parámetros, se calcula el factor de amortiguamiento y la frecuencia natural.
Posteriormente, se logra modelar una función transferencia de segundo orden que
representara la planta en lazo cerrado:
𝑀𝑝 = 63%
𝑇𝑝 = 7
𝜁 . 𝜋
−( )
0,63 = 𝑒 √1−𝜁2 → 𝜁 = 0,146
𝜋 𝜋
𝑇𝑝 = 𝑊𝑑 → 𝑇𝑝 = → 𝑊𝑛 = 0,454
𝑊𝑛√1−𝜁 2
Una vez obtenidas las variables necesarias se procede a armar la ecuación de 2° orden:
0,4542
𝐹. 𝑇. =
𝑠2 + 2 × 0,146 × 0,454𝑠 + 0,4542
0,2061
𝐹. 𝑇. =
𝑠2 + 0,1326𝑠 + 0,2061
Figura 3
Gráfica de la respuesta en el tiempo de la planta en lazo cerrado a un escalón unitario
Una vez se obtiene la función transferencia en lazo cerrado de la planta, se halla esta misma,
pero en lazo abierto. Para ello se hace uso de la simplificación de un sistema realimentado a
un bloque.
𝐶=2
𝑆=1
𝐺𝐶 0,2061
= 2
1 + 𝐺𝐶(𝑠𝑒𝑛𝑠𝑜𝑟) 𝑠 + 0,1326𝑠 + 0,2061
0,2061 1 + 𝐺(2)(1)
𝐺= ×
𝑠2 + 0,1326𝑠 + 0,2061 2
0,2061 0,4122𝐺
𝐺= + 2
2𝑠 2 + 0,2652𝑠 + 0,4122 2𝑠 + 0,2652𝑠 + 0,4122
0,4122 0,2061
𝐺 (1 − )=
2𝑠 2 + 0,2652𝑠 + 0,4122 2
2𝑠 + 0,2652𝑠 + 0,4122
0,2061
𝐺=
2(𝑠2 + 0,1326𝑠)
Figura 4
Grafica de la función de lazo abierto de la planta que se usara para determinar la función del
controlado
Análisis de LGR de la planta
Figura 5
Grafico del lugar geométrico de las raíces (LGR) que se obtuvo mediante el comando rlocus
en lazo abierto
De esta gráfica se puede observar que solo existe 2 asíntotas de +90° y -90°
Se puede observar que el sistema será estable para cualquier ganancia del LGR
Figura 6
Bode de la planta
Presenta un margen de fase de 23.3° en la frecuencia de ganancia de 0.308 rad/s.
El sistema tiene un margen de ganancia infinito, esto debido que la frecuencia de
cruce de fase nunca intercepta con el ángulo de -180°.
PD por LGR
0,2061
𝑃𝑙𝑎𝑛𝑡𝑎 =
2(𝑠 2 + 0,1326𝑠)
Se requiere obtener:
Mo ≥ 20%
Ts ≥ 30 s
−𝜋 . 𝜁
2
𝑀𝑜 = 100𝑒 √1− 𝜁 → 𝜁 = 0,4559
4
𝑇𝑠 = → 𝑊𝑛 = 0,2924
𝜁 . 𝑊𝑛
𝑃𝑑 = −0,133 + 0,2603𝑗
0,2603
D= → 𝐷 = 0,5045
𝑇𝑎𝑛(27,28)
Zc = −0,133 − 0,5045 → −0,6379
1
𝑇𝑑 = = 1,55678
0,6379
Gc = Kc(1,5678s + 1)
Hallamos Kc:
𝐺𝑐 = 0,8298 . (1,568𝑠 + 1)
Figura 7
Respuesta al escalón usando el controlador PD
PID por LGR
0,2061
𝑃𝑙𝑎𝑛𝑡𝑎 =
2(𝑠 2 + 0,1326𝑠)
Se requiere obtener:
Ts ≥ 1s
Kv ≥ 20
Mo ≥ 10
Solución:
−𝜋 . 𝜁
𝑀𝑜 = 100𝑒 √1− 𝜁2 → 𝜁 = 0,5912
4
𝑇𝑠 = → 𝑊𝑛 = 6,7664
𝜁 . 𝑊𝑛
−𝜁 . 𝑊𝑛 ± (𝑊𝑛 . √1 − 𝜁2 ) 𝑗 → −4 + 5,46𝑗
1
Hallamos LGR: (𝑃𝑙𝑎𝑛𝑡𝑎)
𝑠
𝛼 = 180 − 𝜃 → 𝜃 = 72,19
5,46 5,46
𝑇𝑔(𝛼) = → 𝐷= → 𝐷 = 1,75
𝐷 𝑇𝑔(72,19)
𝑍2 = −4 ± 1,75 → −2,25
El controlador quedaría:
𝐾𝑐 . (𝑠 + 4) . (𝑠 + 2,25)
𝐺𝑃𝐼𝐷 =
𝑠
𝐾𝑐 . (𝑠 + 4) . (𝑠 + 2,25) 0,2061
| . 2
| [𝑠 = (−4 ± 5,46𝑗) = 1
𝑠 2𝑠 + 0,2652𝑠
𝐾𝑐 = 95
Entonces el PID:
95 𝐾𝑝 . 𝑇𝑑 1 1
. (𝑠2 + 6,25𝑠 + 9) = . (𝑠2 + 𝑠+ )
𝑠 𝑠 𝑇𝑑 𝑇𝑑 . 𝑇𝑖
1
= 6,25 → 𝑇𝑑 = 0,16
𝑇𝑑
1
= 9 → 𝑇𝑖 = 0,69
𝑇𝑑 . 𝑇𝑖
𝐾𝑝 . 𝑇𝑑 = 95 → 𝐾𝑝 = 593,75
Verificamos:
𝐾𝑣 = 𝐼𝑛𝑓𝑖𝑛𝑖𝑡𝑜
1
𝑒𝑒𝑠_𝑟𝑎𝑚𝑝𝑎 = =0
𝐾𝑣
Figura 8
Respuesta al escalón usando el controlador PID
PD por BODE
Gc = Mp (Tαs + 1)
Se requiere obtener:
MF ≥ 45°
𝑒𝑠𝑠 𝑟𝑎𝑚𝑝𝑎 ≥ 5%
1
Kv = = 20 𝑠𝑒𝑐 −1
𝑒𝑠𝑠 𝑟𝑎𝑚𝑝𝑎
0,2061
𝑃𝑙𝑎𝑛𝑡𝑎 =
2(𝑠 2 + 0,1326𝑠)
Hallando Kp:
0,2061
lim(𝑠 ∗ ∗ 𝐾𝑝) → 𝐾𝑝 = 25,735
𝑠→0 2(𝑠 2 + 0,1326𝑠)
0,2061
𝐺1(𝑠) = 𝐾𝑝 ∗ 𝐺 (𝑠) → 25,735 ∗
2(𝑠 2 + 0,1326𝑠)
Figura 9
Bode de G1(s)
Hallando MF de G1(s):
𝑟𝑎𝑑
|𝐺1(𝑗𝑤𝑔) = 1 = 0𝑑𝑏 → 𝑤𝑔 = 1,626
𝑠
𝑟𝑎𝑑
𝑊𝑔_𝑐𝑜𝑚𝑝 = 𝑤𝑔 = 1,626
𝑠
tan(40,337)
𝑇𝑎𝑛 (∮ 𝑀) = 𝑇𝑑 ∗ 𝑊𝑔𝑐𝑜𝑚𝑝 → 𝑇𝑑 = → 𝑇𝑑 = 0,522 𝑠
1,626
Figura 10
Bode de planta con condensador PD
Figura 11
Respuesta al escalón usando el controlador PD
PI por BODE
0,2061
𝑃𝑙𝑎𝑛𝑡𝑎 =
2(𝑠 2 + 0,1326𝑠)
Se requiere obtener:
1
𝑒𝑠𝑠 = = 0,05 → 𝐾𝑣 = 20
𝐾𝑣
0,2061 𝐾𝑝 𝑇𝑖𝑠 + 1 𝐾𝑝
lim(𝑠 ∗ ∗ ∗ ) → =0
𝑠→0 2(𝑠 2 + 0,1326𝑠) 𝑇𝑖 𝑠 𝑇𝑖
𝐾𝑝 𝑝𝑙𝑎𝑛𝑡𝑎
𝐺𝑐𝑜𝑚𝑝 = ∗
𝑇𝑖 𝑠
Hallando Ti:
𝑇𝑎𝑛(∅)
= 𝑇𝑖 ∗ 𝑊𝑐𝑚 → 𝑇𝑖 = ∅
∅
𝐺𝑝𝑖 (𝑠) = ∅
𝐾𝑝
= ∅ → 𝐾𝑝 = ∅
𝑇𝑖
Figura 12
Respuesta al escalón usando el controlador PI
a) Hardware:
Figura 10
Carcasa de plástico para auto equilibrio
Figura 11
Base de Hoverboard
Figura 12 Figura 13
Almohadilla antideslizante derecha Almohadilla antideslizante izquierda
Figura 14
Motor/Rueda (Actuador)
Figura 15
Driver Puente H L298N
Figura 16
Tablero de led
Figura 17
Indicador de carga de carga
Figura 18
Cable de alimentación del motor
Figura 19
Cable de alimentación
Figura 20
Interruptor ON/OFF
Figura 21
Batería de lito
Figura 22
Cargador
b) Software:
Figura 22
PIC 18F4550
Figura 23
Giroscopio
Figura 24
Sensor de presión
c) Esquema electrónico:
Figura 25
d) Simulación del control:
DIAGRAMA DE BLOQUES
CONCLUSIONES Y OBSERVACIONES
REFERENCIAS
Aliexpress. (2019). Placa base de patinete eléctrico con Control remoto. Recuperado:
https://es.aliexpress.com/item/32746011964.html [Consulta: 19 de noviembre de
2020].