Plantilla Reporte Electricidad y Magnetismo Ind 2022
Plantilla Reporte Electricidad y Magnetismo Ind 2022
Plantilla Reporte Electricidad y Magnetismo Ind 2022
https://www.youtube.com/channel/UCyocHq5iN-7DmFRPmLYJBcg
2. DISEÑO Y MODELADO
1. INTRODUCTION
El control de posición de un brazo con un grado de libertad
sobre su propio eje con una hélice y motor se ha vuelto muy
popular en campo del control. Este sistema está basado en
un péndulo simple, el cual es un sistema físico que exhibe
un movimiento mecánico. Este movimiento consiste en una
masa adherida a una barra de longitud fija y suspendida en
un punto de equilibrio. El movimiento ocurre en el plano
vertical comandado por la fuerza gravitacional. Los péndulos
son conocidos como buenos resonadores y adecuados para
el estudio de periodos largos de estabilidad de forma que se
proporcione un controlador robusto para sistemas dinámicos
con acciones de control que lleve al sistema a operar en regiones
estables [1].
en el apartado de instrumentación, para validar el movimiento C = 0,1078Nms/r. Finalmente se obtiene la función de trasfe-
óptimo del brazo. rencia.
El modelo matemático de este sistema es conocido en la lite-
ratura, en donde se sabe que para obtener el ángulo del pendulo θ (s) 5,13
= 2 (8)
suspendido con respecto a la fuerza de empuje correctiva, se es- V (s) s 1,9754 + 18,5214
cribe la ecuación 1 con base la figura 1, de acuerdo a los aportes
[4], [5], se determina la función de trasferencia presentando un 3. INSTRUMENTACIÓN
modelo no lineal para después ser aproximado a una función
A. Motor Brushless (sin escobillas)
lineal.
Deacuerdo al diagrama que muestra la figura 1, la ecuación La característica principal de los motores DC sin escobillas
diferencial modela al sistema: es que realizan la misma función de un motor DC normal, pero
remplazando el conmutador y las escobillas por switches de
T (t) = J θ̈ (t) + C θ̇ (t) + m · g · d · Senθ (t) (1) estado sólido que funcionan con una lógica para la conmuta-
ción de los embobinados [6], [7]. Los motores Brushless tienen
Donde T representa la fuerza de empuje, J el movimiento muchas ventajas a comparación de los motores con escobillas,
de inercia, C coeficiente de amortiguamiento, θ el angulo, m la debido a que son eficientes en cuestiones de consumo de energía,
masa, g la fuerza de gravedad y d la distancia al centro de masa. no requieren mantenimiento, pueden girar a altas revoluciones,
Partiendo de la ecuación (1), se determina que el voltaje V(t) entre otras.
aplicado al motor es proporcional a la fuerza de empuje T(t) y
A.1. Control de Velocidad Electrónico (ESC)
puede escribirse:
El Controlador de Velocidad Electrónico por sus siglas en
T (t) = k m · V (t) (2) inglés (ESC), es el encargado de suministrar la señal trifásica
necesaria para que los motores Brushless (Sin escobillas) puedan
Siendo θ (t) = 90 deg como el ángulo máximo de la planta, girar. El objetivo de este dispositivo es mantener las RPM del
entonces el Senθ (t) = 1, en el que se puede cosnsiderar que el motor constante ante condiciones de carga.
ángulo se encuentra en estado estable, por lo tanto θ̈ (t) = 0 y
θ̇ (t) = 0. Rescribiendo la ecuación (1) se obtiene. El control de estos dispositivos se realiza mediante PWM
(Modulación por ancho de pulsos) desde la unidad de control.
T (t) = m · gd (3) La señal corresponde normalmente a una señal de modulación
Considerando que k m es una ganancia para obtener el minimo de ancho de pulso PWM, cuya frecuencia y ciclo de trabajo están
ángulo con relación al voltaje. Se sustitye la ecuación (2) en la determinados por fábrica. El ciclo de trabajo normalmente está
ecuación (3). en el rango de 1 a 2ms y la frecuencia puede tomar valores de
50hz y 490hz [7].
mgd
km = (4) A.2. Unidad de Medición de Inercial
V (t)
Una Unidad de Medición Inercial por sus siglas en inglés
Retomando la ecuacion (1) y operando en el domino de la (IMU), es un dispositivo electrónico cuyo objetivo es obtener
Laplace se obtiene la función de trasferencia. mediciones de velocidad, rotación y fuerzas gravitacionales en
forma autónoma. Se utilizan como componentes fundamentales
θ (s) 1 en los sistemas de navegación de barcos, aviones, helicópteros,
= 2 (5)
T (s) Js + cs + mgd misiles o cualquier móvil en que sea necesario estimar estas
Tomando en cuenta las condiciones establecidas anteriormen- mediciones, sin la posibilidad de utilizar referencias externas
te de la ecuación (2) y de la ecuacion (5), la función de trasferen- o mediciones directas. Para el control del péndulo, se requiere
cia que en terminos de θ(s)/V(s) como se presenta en la ecuación saber la posición angular en la que se encuentra posicionado en
(6). todo momento por lo que se hizo uso del sensor MPU9250. Este
sensor está compuesto por un acelerómetro un giroscopio y un
θ (s) k m /J magnetómetro en un chip MEM, con la capacidad de medir en
= (6)
V (s) s2 + CJ s +
mgd sus tres ejes de manera independiente, es decir, que este sensor
J
tiene 9 grados de libertad por sus siglas en inglés (DOF). Que, a
Mediante la metodología para el cálculo de control de su vez, estos datos se procesan en algún sistema computarizado
modelos dinámicos [6] se desarrollaron los calculos para obtener y mediante filtros se obtiene la medición angular de la IMU. En
los siguientes parámetros para la planta del sistema. Para la tabla 3 se muestran las características del sensor.
una frecuencia natural de ωn = 4,3037 rad⁄s y un factor de
A.3. Microcontrolador ARM- F446RE
amortiguamiento de ζ = 0,2295.
El microcontrolador es un parte esencial del péndulo debido
Deacuerdo a la literatura la función de trasferencia de la a que se encarga de adquirir datos de los sensores con el que
ecuación (6) es relacionada con el polinomio característico de se instrumentó el brazo. Las señales que el microcontrolador
segundo orden como se muestra en la ecuacion (7). adquiere se utilizan para el algoritmo de control que estará
encargado de mantener la posición angular y mantener estable
C mgd el brazo ante cualquier perturbación a la que se pueda someter.
s2 + s+ = s2 + 2ζωn s + ωn2 (7)
J J
4. ESTRATEGIA DE CONTROL
Susituyendo los parametros físicos en la ecuación (8): m =
0,33kg, g = 9,8m/s2 y d = 0,12m puede obtenerse el movimien- El desarrollo de controladores difusos ha emergido como
to de inercia J = 0,0210kgm2 y la constante de amortiguamiento una de las más prosperas y fructíferas aplicaciones de la teoría
UPPue Electricidad y Magnetismo, Mayo - Agosto 2022 3
µ A (x) (9)
Donde: [13]
µ A ( x ) ={1 cuando x ∈ A
(10)
{0 cuando x ∈ A
Dicha función es llamada función de pertenencia de A, y está
definida para todos los elementos del universo, esta función hace
un mapeo de todo el universo U a su conjunto de evaluación de Fig. 3. Método de defuzificación de centro de área [13].
dos elementos [0, 1], como se muestra en la ecuación (10).
0, si x ≤ a
x−a
, si a < x ≤ m
m− a
µ A (x) = b− a (13)
b−m si m < x < b
Fig. 4. Respuesta al escalón planta real vs la estimada (Matlab
si x ≥ b
0, 2016).
mi texto
Cuadro 1.
e/de/det na nm nb m pb pm pa
na pa pa pm pm pb pb m
nm pa pm pm pb pb m nb
nb pm pm pb pb m nb nb
m pm pb pb m nb nb nm
pb pb pb m nb nb nm nm
pm pb m nb nb nm nm nb
pa m nb nb nm nm na nb
REFERENCIAS
1. M. Hasan, C. Saha, M. M. Rahman, M. R. I. Sarker, and S. K. Aditya,
“Balancing of an inverted pendulum using pd controller,” Dhaka Univ. J.
Sci. 60, 115–120 (2012).
2. M. C. Villarejo, “La génesis de la mecáncia de fluidos,”
urlhttp://rabfis15.uco.es/MecFluidos/Programa/Untitled-19.htm (2016).
3. H. de avión, “Pasion por volar-divulgación de arenáutica para todos,”
urlhttp://rabfis15.uco.es/MecFluidos/Programa/Untitled-19.htm (2016).
4. H. Kizmaz, S. Aksoy, and A. Mühürcü, “Sliding mode control of sus-
pended pendulum,” in Modern Electric Power Systems (MEPS), 2010
Proceedings of the International Symposium, (IEEE, 2010), pp. 1–6.
5. F. E. M. Garcia, J. A. B. Vargas, and Y. E. A. Garcia, “Desarrollo de
un módulo didáctico para control angular de un péndulo suspendido,”
Respuestas 17, 48–54 (2010).
6. J. Zhao and Y. Yu, “Brushless dc motor fundamentals application note,”
MPS, Futur. Analog. IC Technol pp. 7–8 (2011).
7. G. S. P. de Lazárraga, Control motor Brushless sensorless (Universidad
Pública de Navarra, 2015).
8. L. A. Zadeh, “My life and work–a retrospective view,” Appl. Comput.
Math. 10, 4–9 (2011).
9. M. Hasan, C. Saha, M. M. Rahman, M. R. I. Sarker, and S. K. Aditya,
“Balancing of an inverted pendulum using pd controller,” Dhaka Univ. J.
Sci. 60, 115–120 (2012).
10. M. Ramesh, J. Amarnath, S. Kamakshaiah, and G. Rao, “Speed control
of brushless dc motor by using fuzzy logic pi controller,” ARPN J. Eng.
Appl. Sci. 6, 55–62 (2011).
11. S. Kizir, Z. Bingul, and C. Oysu, “Fuzzy control of a real time inverted
pendulum system,” in Knowledge-Based Intelligent Information and
Engineering Systems, (Springer, 2008), pp. 674–681.
12. J. A. López, P. A. Muñoz, and J. E. Cardona, “Control de un motor utili-
zando lógica difusa con reglas sintonizadas por algoritmos genéticos,”
Sci. et technica 13 (2007).
13. P. Dadios Elmer, “Fuzzy logic–controls, concepts, theories and applica-
tions,” Croat. InTech, ISBN pp. 978–953 (2050).
14. R. Malhotra, N. Singh, and Y. Singh, “Fuzzy logic modelling, simulation
and control: A review,” Int. J. Comput. Sci. Technol. 1, 183–188 (2010).