Control Global del Péndulo de Reacción
Control Global del Péndulo de Reacción
net/publication/317505315
CITATIONS READS
4 275
4 authors, including:
Víctor D. Correa-Ramírez
Instituto Tecnologico Pascual Bravo
8 PUBLICATIONS 21 CITATIONS
SEE PROFILE
Some of the authors of this publication are also working on these related projects:
Special Issue "Power System Simulation with Renewable Power: Protection, Optimization and Control" Electronics Journal (Ed. MDPI): IF-WOS 2.412, Q2 View project
All content following this page was uploaded by Oscar Danilo Montoya Giraldo on 24 January 2019.
Resumen
En este documento se presenta el diseño y la simulación de un controlador global
para el péndulo invertido con rueda de reacción empleando métodos de regulación de
energía y linealización extendida de las variables de estado. La regulación de energía
propuesta se fundamenta en la variación gradual de la energía del sistema para alcanzar
la posición vertical invertida. La señal de entrada requerida se obtiene a partir de la
aplicación del teorema de estabilidad de Lyapunov. El control por realimentación
extendida de las variables de estado se emplea para obtener una función no lineal suave
que extienda la región de operación del sistema en un rango mayor, en contraste con la
realimentación estática de las variables de estado que se obtiene mediante métodos de
linealización aproximada alrededor de un punto de operación. El controlador diseñado
opera a partir de la conmutación de las señales de control dependiendo de la región de
operación y para verificar su robustez y eficiencia se aplican perturbaciones en la señal
de control y en las variables medidas. Finalmente las simulaciones y pruebas realizadas
sobre el modelo del sistema físico, permiten observar la versatilidad y funcionalidad del
controlador propuesto en toda la región de operación del péndulo.
Palabras clave
Control global por conmutación, linealización extendida, péndulo con rueda de
reacción, regulación de energía, variables de estado.
Abstract
This paper presents the design and simulation of a global controller for the Reaction
Wheel Pendulum system using energy regulation and extended linearization methods for
the state feedback. The proposed energy regulation is based on the gradual reduction of
the energy of the system to reach the unstable equilibrium point. The signal input for
this task is obtained from the Lyapunov stability theory. The extended state feedback
controller design is used to get a smooth nonlinear function that extends the region of
operation to a bigger range, in contrast with the static linear state feedback obtained
through the method of approximate linearization around an operating point. The general
designed controller operates with a switching between the two control signals depending
upon the region of operation; perturbations are applied in the control signal and the
(simulated) measured variables to verify the robustness and efficiency of the controller.
Finally, simulations and tests using the model of the reaction wheel pendulum system,
allow to observe the versatility and functionality of the proposed controller in the entire
operation region of the pendulum.
Keywords
Switching global control, extended linearization, reaction wheel pendulum, energy
regulation, state variables.
[34] Tecno Lógicas, ISSN 0123-7799, Vol. 17, No. 32, enero-junio de 2014, pp. 33-46
O. D. Montoya-Giraldo et al. / Control global del péndulo con rueda de reacción mediante regulación de
energía y linealización extendida de las variables de estado
Tecno Lógicas, ISSN 0123-7799, Vol. 17, No. 32, enero-junio de 2014, pp. 33-46 [35]
O. D. Montoya-Giraldo et al. / Control global del péndulo con rueda de reacción mediante regulación de
energía y linealización extendida de las variables de estado
dor que varía la posición del sistema a integra los dos controladores. En el apar-
partir de mediciones con el fin de acercarlo tado 4 se presenta las pruebas desde simu-
a la región de operación. Se implementa el lación para el sistema péndulo con rueda
controlador en prototipo real del sistema de reacción y los diferentes efectos que
conocido como Mechkit [13]. causan las perturbaciones externas en su
En 2011 se desarrolla un modelo para operación. En la parte final del documento
la estabilización y control de un péndulo se presentan las conclusiones y trabajos
rotacional invertido basando en la veloci- futuros.
dad con la que varía la energía del sistema.
El método clásico de balance por funciones
de energía es modificado para asegurar que 2. MODELO DEL SISTEMA FÍSICO Y
el sistema alcance la posición de equilibrio DETERMINACIÓN DE LA SEÑAL DE
inestable, desde cualquier condición inicial. CONTROL POR REGULACIÓN DE
Una vez el sistema está en las proximida- ENERGÍA
des de la región de operación es empleado
un método de conmutación que intercam- 2.1 Descripción y modelado de la planta
bia las señales de control, del balance por
modelos energéticos a un controlador ba- El péndulo con rueda de reacción consta
sado en planos deslizantes. Los resultados de una barra que tiene una rueda giratoria
numéricos obtenidos al evaluar el modelo a acoplada a un motor DC en su extremo
través de métodos de simulación, reflejan libre. El par aplicado por el motor se usa
la robustez y eficiencia de la metodología activamente para controlar el sistema, el
propuesta [14]. cual está provisto de sensores de movi-
Como aporte fundamental en este pro- miento que entregan la posición relativa
yecto, se destaca la combinación de dos del ángulo para la rueda de reacción y la
modelos no lineales para representar el posición angular de la barra. La Fig. 1
comportamiento global del sistema y la presenta una representación bidimensional
integración de los controladores a través de del péndulo y las variables de interés. Los
la definición de tres zonas operativas para ángulos ϕ y α se obtienen de los sensores.
la conmutación de la señal de control, con El ángulo del péndulo es ϕ y la medida
lo que es suavizado el esfuerzo sobre el absoluta del ángulo θ de la rueda resulta
actuador y la saturación en los sensores. ser tal como se presenta en (1).
Adicional a esto, es presentado en detalle
la formulación por realimentación extendi-
da de las variables de estado para un sis-
tema no lineal, destacando las ventajas de
una formulación robusta y poco empleada
en la literatura especializada y la indus-
tria.
Este artículo es presentado de la si-
guiente manera. La sección 2 corresponde
a la determinación del modelo matemático
del sistema físico y la formulación por fun-
ciones de energía para el diseño del contro-
lador de balance. En la sección 3 se presen-
ta la formulación clásica de controladores
por linealización aproximada, se muestra
el desarrollo del controlador por linealiza- Fig. 1. Modelo bidimensional del péndulo con rueda de
ción extendida y presenta el modelo que reacción. Fuente: Autores
[36] Tecno Lógicas, ISSN 0123-7799, Vol. 17, No. 32, enero-junio de 2014, pp. 33-46
O. D. Montoya-Giraldo et al. / Control global del péndulo con rueda de reacción mediante regulación de
energía y linealización extendida de las variables de estado
Tecno Lógicas, ISSN 0123-7799, Vol. 17, No. 32, enero-junio de 2014, pp. 33-46 [37]
O. D. Montoya-Giraldo et al. / Control global del péndulo con rueda de reacción mediante regulación de
energía y linealización extendida de las variables de estado
mente. Entre las opciones más usadas se En esta expresión, sgn (x) es la función
seleccionó la regulación de energía por la signo. La ganancia Ku permite manipular
sencillez en su implementación [3], [16]. La la amplitud de la señal reguladora y la
estrategia consiste en plantear una función rapidez con la que el péndulo alcanza la
de energía que sea cero en el punto de posición invertida; su valor se ajusta de
equilibrio alrededor del cual se desea con- forma empírica. El término ̇ permite
trolar el sistema. Luego se define una en- que la señal de control refuerce el movi-
trada de control con la cual dicha energía miento del péndulo (se aplica torque en la
sea llevada a cero de forma gradual. En el misma dirección de movimiento), con lo
sistema de la Fig. 1, la relación entre el que se logra una oscilación de amplitud
ángulo del péndulo y su energía total se creciente hasta alcanzar la posición inver-
establece como (8). tida.
1
mgl cos 1
2
Ep Jp (8)
2 3. DISEÑO DEL CONTROLADOR POR
REALIMENTACIÓN DE LAS VARIABLES
La energía cinética de la rueda DE ESTADO
1
J p no se incluye en esta expresión
2
[38] Tecno Lógicas, ISSN 0123-7799, Vol. 17, No. 32, enero-junio de 2014, pp. 33-46
O. D. Montoya-Giraldo et al. / Control global del péndulo con rueda de reacción mediante regulación de
energía y linealización extendida de las variables de estado
g K K K
y * x u * x1 * x2 * xn (18)
(15) x1 x2 xn
x x0
x0 x0 x0
x Ax Bu
(16) Si no se ha especificado un punto de
y C x operación numérico, es posible hallar una
expresión para K(x) integrando estas con-
En el cual Δx, Δu y Δy representan las diciones con respecto a las variables
variaciones de los estados, la entrada y la x10 x20 … xn0. Aunque este problema pue-
salida respectivamente alrededor del punto de tener múltiples soluciones, se puede
de operación definido (Δx = x − x0, obtener un resultado sencillo si K(x) se
Δu = u − u0, Δy = y − y0). define de una forma conveniente [18].
Sobre el modelo linealizado se puede di-
señar un regulador lineal de la forma 3.3 Linealización extendida aplicada al
Δu = −K Δx (siempre que el par (A, B) sea péndulo con rueda de reacción
controlable). Las ganancias de realimenta-
ción K = [K1 K2 … Kn] se calculan de forma Por ser un sistema sub-actuado, el pén-
que en lazo cerrado se obtengan los polos o dulo con rueda de reacción solo se puede
valores propios deseados [17]. controlar en las posiciones de equilibrio (la
posición natural ϕ = ±, ±3, ±5, … o la
3.2 Método de linealización extendida invertida ϕ = 0, ±2, ±4, …). Aunque ini-
cialmente se considera un punto de opera-
Si en el modelo linealizado del sistema ción arbitrario en el cálculo del regulador
no se especifica un punto de operación no lineal u = −K (x), posteriormente se
dado, se obtienen expresiones genéricas en escogerá la posición invertida para realizar
función de los estados del punto de opera- las simulaciones.
ción x0 = [x10 x20 … xn0]T. Al diseñar un Si el conjunto de (6) que describe la di-
regulador, las ganancias ̅ quedan también námica del modelo se linealiza alrededor
Tecno Lógicas, ISSN 0123-7799, Vol. 17, No. 32, enero-junio de 2014, pp. 33-46 [39]
O. D. Montoya-Giraldo et al. / Control global del péndulo con rueda de reacción mediante regulación de
energía y linealización extendida de las variables de estado
[40] Tecno Lógicas, ISSN 0123-7799, Vol. 17, No. 32, enero-junio de 2014, pp. 33-46
O. D. Montoya-Giraldo et al. / Control global del péndulo con rueda de reacción mediante regulación de
energía y linealización extendida de las variables de estado
X1 X1 Angulo Perturbado X1
PERTURBACIÓN EN LA SEÑAL
DE CONTROL
Fig. 3. Diagrama de bloques para el controlador global del péndulo con rueda de reacción usando realimentación extendida y
regulación de energía. Fuente: Autores
Tecno Lógicas, ISSN 0123-7799, Vol. 17, No. 32, enero-junio de 2014, pp. 33-46 [41]
O. D. Montoya-Giraldo et al. / Control global del péndulo con rueda de reacción mediante regulación de
energía y linealización extendida de las variables de estado
Eje normalizado
Velocidad angular de la rueda (pu)
1
0.5
Posición angular del
2
0
péndulo (rad)
0 -0.5
-2 -1
0 2 4 6 8 10 12 14
-4
Tiempo (s)
Fig. 6. Comportamiento porcentual de las velocidades.
-6 Fuente. Autores
0 2 4 6 8 10 12 14
Tiempo (s) La señal de control global que hace po-
Fig. 4. Posición angular del péndulo en función del tiempo.
Fuente. Autores
sible el balanceo del sistema y la estabili-
zación del sistema alrededor del punto de
Como se observa en la Fig. 4, el tiempo operación, se observa en la Fig. 7, y es el
que tarde el péndulo en alcanzar el punto resultado de la conmutación de las leyes de
de operación en la posición vertical supe- control propuesta en el diagrama de blo-
rior es de 11 s aproximadamente, tiempo ques de la Fig. 3. Por otro lado de la Fig. 7,
durante el cual presenta oscilaciones de es posible inferir que la señal de control
amplitud creciente, hasta alcanzar el punto obtenida por regulación de energía, funcio-
de entrada en operación del controlador na como un inversor de corriente, y que se
local. Por otro lado, la Fig. 5 muestra como traduce como una polaridad alterna en los
la energía de la planta varía desde el punto terminales del actuador, permitiendo así
de mínima energía (posición de reposo que el péndulo se balance a medida que su
natural) hasta el valor máximo (punto de energía tiende a cero.
operación deseado), y que según el modelo 15
desarrollado toma una magnitud de cero,
Señal de control (UI)
10
según se presentó en (8).
Las velocidades angulares del péndulo 5
[42] Tecno Lógicas, ISSN 0123-7799, Vol. 17, No. 32, enero-junio de 2014, pp. 33-46
O. D. Montoya-Giraldo et al. / Control global del péndulo con rueda de reacción mediante regulación de
energía y linealización extendida de las variables de estado
péndulo (rad)
0
0.5
Por otro lado, la Fig. 9 presenta el com-
0
portamiento de la posición angular del
péndulo, en presencia de datos erróneos en -0.5
la señal medida alrededor de los 15 s el Fig. 10. Velocidades angulares en presencia de ruido.
péndulo pierde estabilidad y sale de la Fuente: Autores
posición de equilibrio, sin embargo el con-
trolador por regulación de energía, tras La señal de control que permite estabi-
una única oscilación del péndulo, lo lleva lizar el sistema desde su posición inicial,
nuevamente a la posición de equilibrio hasta el punto de operación en la posición
estable. Sólo se presentan pequeñas varia- vertical superior se presenta en la Fig. 11.
ciones en la posición angular inducidas por Es posible observar los momentos en que
las medidas tomadas por el sensor después actúan cada una de las leyes de control
de los 22 s, logrando el controlador mante- conmutadas, es decir, cuando el péndulo
nerlo alrededor del punto de operación sin sale de la región de operación actúa la
mayores esfuerzos. señal de control por regulación y durante
Tecno Lógicas, ISSN 0123-7799, Vol. 17, No. 32, enero-junio de 2014, pp. 33-46 [43]
O. D. Montoya-Giraldo et al. / Control global del péndulo con rueda de reacción mediante regulación de
energía y linealización extendida de las variables de estado
-5
15 -10
Señal de control (UI)
10 -15
0 5 10 15 20 25 30 35 40 45 50
5
Tiempo (s)
0 Fig. 12. Señal de control presencia de perturbaciones.
-5 Fuente: Autores
-10
8
péndulo (rad)
4
Tiempo (s)
2
Fig. 11. Señales de control ante perturbaciones.
0
Fuente: Autores
-2
-4
4.3 Perturbaciones en la señal de control -6
0 5 10 15 20 25 30 35 40 45 50
Tiempo (s)
Los comportamientos atípicos en los Fig. 13. Posición angular del péndulo ante perturbaciones
sensores, elementos de medida y actuado- en la señal de control. Fuente: Autores
res, son comunes cuando los equipos con-
trolados se encuentran sometidos a traba- En la Fig. 13 es claro que la primera
jos pesados en ambientes industriales; perturbación de baja magnitud no altera la
razón por la cual es esencial conocer los operación en el punto de equilibrio y solo se
comportamientos del sistema ante eventos presenta una pequeña variación alrededor
ajenos a su operación normal, con el fin de del ángulo de referencia; sin embargo a los
verificar que no se producirán daños o 30 s, cuando aparece un pulso en la señal
afectaciones físicas en la planta y en los de control de mayor magnitud, el punto de
mecanismos de control empleados. operación del sistema cambia dando una
Dado que los controladores normalmen- vuelta completa, hasta llegar el siguiente
te están desarrollados en función de seña- punto de operación, este comportamiento
les eléctricas, estas son propensas a per- físicamente implica que el péndulo después
turbaciones debidas a fenómenos electro- de caer, llega a la posición de equilibrio
magnéticos, razón por la cual se inducen estable con el impulso que lleva y la actua-
señales de tipo pulso en la señal de control, ción de la ley de control por regulación de
que producen comportamientos indeseados energía que lo impulsa lo suficiente lo-
sobre la planta. La Fig. 12, muestra una grando alcanzar el siguiente punto de equi-
señal de control con alteraciones produci- librio, sin la necesidad de hacer un balan-
das por pulsos de corta duración. ceo completo, como ocurrió en el evento
De la Fig. 12, se observa que existen simulado en la Fig. 9.
dos alteraciones de la señal de control, la El comportamiento de las velocidades
primera se presenta a los 15 s, cuando un angulares del sistema se muestra en la
pulso de magnitud 3UI y duración de 0,5 s, Fig. 14, donde se observa que para las dos
y un segundo pulso de duración 0,25 s y perturbaciones en la señal de control la
magnitud 8UI, las cuales producen varia- rueda de reacción se acelera con el fin de
ciones en la posición angular de la planta, mantener la planta en su punto de opera-
tal como se muestra en la Fig. 13. ción y la velocidad de rotación del péndulo
[44] Tecno Lógicas, ISSN 0123-7799, Vol. 17, No. 32, enero-junio de 2014, pp. 33-46
O. D. Montoya-Giraldo et al. / Control global del péndulo con rueda de reacción mediante regulación de
energía y linealización extendida de las variables de estado
alcanza un pico cuando la planta cae a los ñador, es decir, que no se comprometa el
30 s. Es de notar, que el actuador no solo estado operativo del sistema, o en otras
presenta operación en estado nominal por palabras, que ninguna de las señales so-
un corto lapso de tiempo, y este se da brepase sus límites de operación.
cuando las oscilaciones en la posición angu- Se propone implementar un control glo-
lar llegan al máximo justo antes de que bal para el péndulo invertido con rueda de
entre en operación en controlador por re- reacción que incluya todos los estados del
alimentación de las variables de estado. sistema y en el cual la señal de control sea
definida por la aplicación de un voltaje a
1.5
los terminales del motor y que no desprecie
la dinámica presente cuando se modela un
Eje normalizado
-0.5
Velocidad angular del péndulo (pu) 6. REFERENCIAS
Velocidad angular de la rueda (pu)
-1.5
0 5 10 15 20 25 30 35 40 45 50
Tiempo (s) [1] M. A. Martínez, J. Sanchis, and X. Blasco, “Algoritmos
Genéticos Aplicados al Diseño de Controladores
Fig. 14. Variación porcentual de las velocidades angulares
Robustos,” Rev. Iberoam. automática e informática
del sistema ante perturbaciones en la señal de control.
Ind. ( RIAI ), vol. 3, no. 1, pp. 39-51, 2006.
Fuente: Autores
[2] J. G. Hoyos, J. E. Cardona, and R. Arango, “Control en
linea con algoritmos genéticos y recocido simulado,”
Sci. Tech., vol. XIII, no. 35, pp. 113-116, 2007.
5. CONCLUSIONES Y TRABAJO FUTURO [3] L. F. Escobar Dávila, O. D. Montoya Giraldo, and D.
Giraldo Buitrago, “Control Global del Péndulo de
Furuta Empleando Redes Neuronales Artificiales y
Se desarrolló el diseño de un controla- Realimentación de Variables de Estado,” Tecno
Lógicas, no. 30, pp. 71-94, 2013.
dor integrado para el péndulo invertido con
[4] J. Wu, H. Su, and T. Wu, “ANN Control of Inverted
rueda de reacción que muestra un compor- Pendulum,” in 2008 First International Conference on
tamiento adecuado en todo el rango de Intelligent Networks and Intelligent Systems, 2008, pp.
9-12.
operación de la planta, logrando el objetivo [5] J.-X. Xu, Z.-Q. Guo, and T. H. Lee, “An optimal fuzzy
de control y manteniendo la señal de con- logic controller for an underactuated unicycle,” in
trol en una condición libre de saturación, IECON 2011 - 37th Annual Conference of the IEEE
Industrial Electronics Society, 2011, pp. 2335-2340.
es decir, que no se sobrepasan los límites [6] Ó. O. Rodríguez Díaz, E. L. Téllez Valderrama, and D.
operativos del actuador. A. Gutiérrez Ramírez, “Simulating a Rotational
Inverted Pendulum Model by using Matlab and Easy
Se presenta una aplicación de la técnica Java Simulations,” Tecno Lógicas, no. 28, pp. 15-32,
de control por realimentación de estados 2012.
mediante linealización extendida, que [7] L. B. Prasad, B. Tyagi, and H. O. Gupta, “Modelling
and Simulation for Optimal Control of Nonlinear
permite ampliar el rango de operación Inverted Pendulum Dynamical System Using PID
alrededor del punto de operación a través Controller and LQR,” in 2012 Sixth Asia Modelling
de las funciones no lineales continuas que Symposium, 2012, pp. 138-143.
[8] O. D. Montoya, J. G. Valenzuela, and D. Giraldo,
sustituyen las ganancias estáticas clásicas, “Control global del Péndulo Rotacional Invertido
que se obtienen con el método de linealiza- empleando modelos de energía,” Sci. Tech., vol. XVII,
no. 52, pp. 16-25, 2012.
ción aproximada.
[9] R. Iriarte, L. T. Aguilar, and L. Fridman, “Second
El control por regulación de energía order sliding mode tracking controller for inertia wheel
muestra ser una alternativa sencilla y pendulum,” J. Franklin Inst., vol. 350, no. 1, pp. 92-
106, Feb. 2013.
eficiente para realizar el balanceo de sis- [10] M. W. Spong, P. Corke, and R. Lozano, “Nonlinear
temas pendulares. Se logra a través de la control of the Reaction Wheel Pendulum,” Automatica,
manipulación de los estados energéticos de vol. 37, no. 11, pp. 1845-1851, Nov. 2001.
[11] B. Bapiraju, K. N. Srinivas, P. Kumar P, and L.
la planta y permite definir señales de con- Behera, “On balancing control strategies for a reaction
trol que obedezcan a los criterios del dise- wheel pendulum,” in Proceedings of the IEEE
Tecno Lógicas, ISSN 0123-7799, Vol. 17, No. 32, enero-junio de 2014, pp. 33-46 [45]
O. D. Montoya-Giraldo et al. / Control global del péndulo con rueda de reacción mediante regulación de
energía y linealización extendida de las variables de estado
INDICON 2004. First India Annual Conference, 2004., [15] D. Giraldo, V. D. Correa, and A. Molina, “Control
2004, pp. 199-204. global para el péndulo con rueda de reacción,” Sci.
[12] F. Jepsen, A. Soborg, A. R. Pedersen, and Z. Yang, Tech., vol. XIII, no. 35, pp. 95-99, 2007.
“Development and control of an inverted pendulum [16] M. Iwashiro, K. Furuta, and K. J. Astrom, “Energy
driven by a reaction wheel,” in 2009 International based control of pendulum,” in Proceeding of the 1996
Conference on Mechatronics and Automation, 2009, pp. IEEE International Conference on Control
2829-2834. Applications, 1996, pp. 715-720.
[13] A. A. Bobtsov, A. A. Pyrkin, and S. A. Kolyubin, [17] D. Giraldo and E. Giraldo, Teoría de control análogo.
“Adaptive stabilization of a reaction wheel pendulum Univ. Tecnológica de Pereira, 2010, p. 287.
on moving LEGO platform,” in 2009 IEEE [18] H. Sira-Ramírez, R. Márquez, F. Rivas-Echeverría,
International Conference on Control Applications, and O. Llanes-Santiago, Control de Sistemas No
2009, pp. 1218-1223. Lineales: Linealización aproximada, extendida, exacta.
[14] B. R. Andrievsky, “Global stabilization of the unstable Madrid: Pearson-Prentice-Hall, 2005.
Reaction-Wheel Pendulum,” Autom. Remote Control, .
vol. 72, no. 9, pp. 1981-1993, Sep. 2011.
[46] Tecno Lógicas, ISSN 0123-7799, Vol. 17, No. 32, enero-junio de 2014, pp. 33-46