Documentos de Académico
Documentos de Profesional
Documentos de Cultura
ISSN 0122-1701 16
Resumen— Este artículo presenta modelos matemáticos que comunicaciones y en general los procesos de producción, han
representan fenómenos físicos y comportamientos de una evolucionado aceleradamente hasta alcanzar niveles de
planta o sistema, dependientes exclusivamente de los seguridad y calidad impensados algunas décadas atrás [5].
requerimientos y necesidades de control y del grado de
exactitud necesario determinado por el diseñador. Para esto Por lo anterior, el componente investigativo de la ciencia se ha
se desarrollaron modelos del péndulo rotacional invertido a
enfocado en el desarrollo y la comprensión de sistemas físicos
partir de la mecánica de Lagrange y la mecánica de Newton,
logrando diseñar una tarea de control en el espacio global, que posean características no lineales dentro de su modelado
mostrando la rapidez y eficiencia empleando técnicas de matemático y en consecuencia un desafío para las técnicas
regulación de energía para el “Swing Up” y de realimentación clásicas de control, llevando a que los equipos conocidos como
de variables de estado para estabilización y posicionamiento péndulos logren una gran acogida en el campo de la
alrededor del punto de operación. De esta manera, se investigación, ya que son sistemas que poseen grandes
demuestra también que conmutación de controladores puede similitudes con los modelos de equipos comúnmente utilizados
ser una alternativa válida para control global de sistemas en el mundo laboral, creándose así nuevos prototipos y
físicos, reduciendo la complejidad en su diseño. esquemas de control [5,6].
Palabras clave— Control global, funciones de energía, Es de vital importancia para las técnicas de control basadas en
péndulo rotacional invertido, realimentación de variables de modelos matemáticos considerar diferentes eventos físicos
estado, “Swing up”. presentes en el comportamiento de la planta, con el fin de
asegurar un modelado de calidad, sin embargo estás condiciones
Abstract— This paper presents mathematical models that son imprácticas debido a la excesiva complejidad matemática
represent physical phenomena and behaviors of a plant or del modelo, es por esto que se tienen en cuenta algunas
system, dependent only on the requirements and needs of simplificaciones, que sin degradar la calidad del modelado,
control and the degree of accuracy determined by the presentan un alto grado de eficiencia en el momento de realizar
designer. Models were developed for this rotational inverted
la tarea de control. Algunas de las técnicas clásicas más
pendulum from Lagrangian mechanics and Newtonian
mechanics, making design a control task in the global space, destacadas para el modelado de sistemas físicos, son basadas en
showing the speed and performance using energy regulation las mecánicas Lagrangiana, Newtoniana y Hamiltoniana, cada
control technique for the swing up and feedback of state una de las cuales considera diferentes aspectos físicos y en
variables for stabilization and positioning around the general, encuentran representaciones matemáticas diferentes del
operating point. Thus, it also shows that switching controllers mismo sistema bajo estudio.
can be a valid alternative for global control of physical
systems, reducing complexity in design task. En la sección II de este artículo se presenta una descripción
general del péndulo rotacional invertido y se realiza un
Key Word —Global control, energy functions, feedback of modelado utilizando formulación a partir la mecánica de
state variables, rotational inverted pendulum, swing up. Lagrange. En la sección III se presenta el diseño de un
controlador para la planta a partir de un modelo matemático
basado en las ecuaciones de Newton para el “Swing up” y otro
I. INTRODUCCIÓN controlador por realimentación de variables de estado para la
región de equilibrio. En la sección IV se presentan las
En la actualidad, la investigación sobre robótica ha simulaciones y pruebas realizadas al modelo representativo del
impulsado en gran medida el desarrollo de lo que se conoce péndulo de Furuta, donde se evalúa el comportamiento del
como Ingeniería de Control debido a la necesidad de controlador ante las tareas de control para regulación y
automatización existente en todo lo relacionado a procesos seguimiento de trayectoria.
industriales que involucran el uso de maquinaria y por
tanto, riesgo para las personas. Es por ello que cosas tan
comunes hoy en día como el transporte, las
Fecha de Recepción: 14 de Septiembre de 2012
Fecha de Aceptación: 19 de Diciembre de 2012
17 Scientia et Technica Año XVII, No 52, Diciembre de 2012. Universidad Tecnológica de Pereira.
II. MODELO MATEMÁTICO PARA EL considera una masa de balance en el extremo restante del
PÉNDULO ROTACIONAL INVERTIDO péndulo de magnitud M . La posición angular θ del péndulo se
ha definido como cero en la posición vertical superior y con
A. Descripción del sistema físico sentido de giro positivo en la dirección de las manecillas del
reloj. El ángulo de la barra horizontal se ha definido con sentido
El péndulo de Furuta, también conocido como péndulo de giro positivo en la dirección opuesta a las manecillas del
rotacional invertido, fue diseñado por el Doctor Katsuhisa reloj.
Furuta del Instituto Tecnológico de Tokio en el año de
1992, como una variación del péndulo invertido, con el La Tabla 1, contiene los parámetros físicos del péndulo de
fin de eliminar la limitante física de movimiento que Furuta disponible en el Laboratorio de Investigación es Sistemas
impone el riel sobre el cual el carro se desliza, a través de Control de la Universidad Tecnológica de Pereira.
la inclusión en el sistema de una trayectoria de giro circular
infinita.
Parámetro Valor Unidades (SI)
El péndulo rotacional invertido es un mecanismo sub- Masa brazo horizontal ( ma ) 0,077752 kg
actuado con dos (2) grados de libertad y constituido por
Masa péndulo ( m p ) 0,013968 kg
dos (2) eslabones o brazos y dos (2) articulaciones. El
primer brazo tiene la posibilidad de girar libremente en el Longitud brazo horizontal ( la ) 0,084 m
plano horizontal; en uno de sus extremos se encuentra
ubicado el actuador o motor, quien es el elemento activo Longitud péndulo ( l p ) 0,203 m
que imprime sobre la barra la capacidad de movimiento, en Gravedad ( g ) 9,80665 m/s²
el extremo restante, a través de una articulación, se
encuentra sujeto el péndulo que puede girar libremente en
un plano vertical formando una trayectoria cilíndrica con Tabla 1. Parámetros físicos del péndulo de Furuta.
respecto al eje z.
La característica de sistema sub-actuado está determinada B. Modelado matemático del sistema
porque solo posee un elemento activo y cuenta con dos
brazos que pueden moverse en dos planos diferentes y El modelo matemático del sistema puede ser representado
perpendiculares entre sí. mediante una ecuación diferencial vectorial de segundo orden,
definida en las posiciones articulares q o cartesianas x , como
se observa en las ecuaciones (1) y (2). [5]
Masa de balance (MB) Donde L representa el Lagrangiano del sistema que puede ser
determinado como la diferencia entre la energía cinética y la
1 2 1 2 2 energía potencial presentadas en las ecuaciones (23) y (24),
K MB = M la + l p sin θ obteniendo como resultado la ecuación (28).
2 3
& & cos θ + Ml 2θ&2
+ 2 Mla l pφθ (21) 1 &2 1
p L= J φ + ma + m p + M la 2φ&2
(22) 2 3
U MB = Mgl p cos θ
1
Finalmente al tener descritas las energías cinética y + m p + M l p 2φ&2 sin 2 θ
potencial de cada uno de los componentes del péndulo 3
rotacional invertido, se calculan las energías totales del 1
sistema como (23) y (24). & & cos θ
+ m p + M la l pφθ
2
1 1 11
K= J + ma + m p + M la 2φ&2 + m p + M l pθ& 2
2 3 23
1 1
+ m p + M l p 2φ&2 sin 2 θ − m p + M gl p cos θ (28)
3 2
1 & & cos θ Para simplificar la ecuación (28), se definen unas constantes, en
+ 2 m p + M la l pφθ
2 función de los parámetros propios de la planta como se muestra
en el sistema de ecuaciones (29).
1 1
+ m p + M l pθ&2 α = J + ma + m p + M la 2
3 (23)
3
1
1 β = mp + M l p2
U = m p + M gl p cos θ (24) 3
2
1 (29)
3. Mecánica de Lagrange γ = m p + M la l p
2
La mecánica de Lagrange describe el comportamiento de 1
las posiciones y velocidades articulares (angulares) de un δ = m p + M gl p
sistema físico. Este modelo puede ser descrito en forma 2
compacta como (25).
Al aplicar esta reducción de términos a la ecuación del
M (q )q&& + C (q, q& )q& + g (q ) = τ (25) Lagrangiano, se obtiene (30).
1
Donde M ( q ) es la matriz de inercia, C ( q, q& ) es la matriz
L=
2 (α + β sin 2 θ ) φ&2 + 2γφθ
& & cos θ + βθ& 2
(30)
centrifuga y de Coriolis, g ( q) es el vector de pares − δ cos θ
gravitacionales y τ representa el vector de torques y Finalmente usando las ecuaciones de Lagrange para movimiento
fuerzas externas que actúan sobre el sistema, como se definidas por (26) y (27), sobre el Lagrangiano (30) y una
muestra en [5]. reducción algebraica se llega a las ecuaciones (31) y (32), que
describen en forma diferencial el comportamiento global del
Las ecuaciones de movimiento que describen el sistema físico péndulo de Furuta.
comportamiento de un sistema físico en función de sus
entradas activas (torques y fuerzas) se define como (26) y
(27). (α + β sin θ ) φ&& + 2βφθ& & sin θ cos θ
2
Los motores son los elementos activos que imprimen Con base en el modelo matemático que se presentó en las
capacidad de movimiento o giro a un sistema físico ecuaciones (31) y (32), para el péndulo rotacional invertido, es
determinado; en el caso del péndulo de Furuta es necesario posible construir un espacio de estados no lineal, con ecuaciones
determinar las características del circuito equivalente de un diferenciales de primer orden [7]. Se introducen las variables de
motor de corriente continua, para encontrar las relaciones estado x1 = φ , x2 = φ&, x3 = θ , x4 = θ& y se determina el
existentes entre las variables eléctricas y las variables
mecánicas [6]. espacio de estados no lineal como (37), (38), (39) y (40), las
cuales representan el comportamiento del sistema físico en
El circuito equivalente de un motor de corriente continua, cualquier punto de operación, y pueden ser linealizadas
puede expresarse en función del voltaje, la corriente y la alrededor de un punto de operación de interés particular [6].
velocidad de giro de su eje, como se observa en la ecuación
(33). x&1 = x2 (37)
di (33)
+ keφ&
v = Ri + L 1
dt x&2 = βτ φ
Donde los parámetros R, L, ke son las constantes αβ − γ + ( β 2 + γ 2 ) sin 2 x3
2
(
u = k ( E − E0 ) sign θ& cos θ ) (54)
regulación, adicional a esto se puede encontrar ganancias La figura 4, Muestra la interconexión de bloques y la
que permitan el seguimiento de referencia a una de las conmutación de controladores para la planta péndulo invertido
variables del sistema, siempre que este no posea ceros rotacional.
reales en el origen del plano complejo y que se determinan
a partir de la función de transferencia que relaciona la
entrada activa con la variable de interés, porque esta
característica conduce a ganancias infinitas para lograr un
seguimiento de referencia, lo que sería imposible de lograr
[7].
u (t ) = K r r (t ) − K f x (t ) (57)
Donde K r es la constante para seguimiento de referencia, Figura 4. Diagrama de bloques para control global del péndulo
de Furuta.
r (t ) es la señal de referencia para una de las variables del
sistema, K f es la ganancia de realimentación que modifica Los parámetros de diseño para la realización de las
simulaciones, se muestran en el sistema de ecuaciones (58).
los polos del sistema y x(t ) es el vector de variables de
estado, siendo u (t ) la señal de control aplicada a los Donde k representa la constante de diseño que permite alcanzar
termínales del actuador [7]. la posición de equilibrio para el controlador “swing up”. Ei y
E0 son las energías inicial y final del modelo del péndulo
simplificado. K f y K r , representan las ganancias de
realimentación para reubicación de polos y seguimiento de
referencia.
k = 22.99
Ei = −2mg
Figura 3. Esquema de control en lazo cerrado con (58)
regulación y seguimiento de referencia
E0 = 0.05
K r = [−0.6972]
La figura 3, presenta un diagrama de bloques donde se
define la realimentación se variables de estado con K f = [-0.6972 -0.5197 -30.6396 -2.3932]
seguimiento de referencia.
Con el fin de realizar un controlador que lleve la planta Esta sección presenta las simulaciones correspondientes al
desde su posición de equilibrio natural (posición vertical diseño del controlador para regulación de las variables de estado
inferior), hasta el punto de equilibrio inestable (posición y seguimiento de referencia. Para este propósito utilizó
vertical superior), se propone la realización de una MATLAB 2010a en un computador Intel Core 2 Duo E8400,
conmutación de controladores por “Swing up” y 4GB RAM.
realimentación de variables de estado en un punto lo
suficiente cercano a la zona de equilibrio, donde el A. Regulación de las variables de estado
controlador local, logre estabilizarlo de forma exitosa. Para
el diseño de este controlador se tomará como región de La regulación de variables de estado supone que después de
pasado el estado transitorio de un sistema controlable, todas las
conmutación el intervalo 15° ≤ θ ≤ 25° , sin querer decir variables de estado llegarán a cero en un corto periodo y se
que sea la única opción posible, ya que esto depende de la mantendrán allí, debido a la acción de la señal de control y
robustez del controlador y las limitaciones físicas de los mientras no se presenten perturbaciones que saquen la planta de
sistemas. [6] la región de operación que esté bajo de influencia del
controlador lineal.
Scientia et Technica Año XVII, No 52, Diciembre de 2012. Universidad Tecnológica de Pereira. 24
1. Seguimiento de referencia
REFERENCIAS
Figura 10. Posición angular del péndulo para seguimiento [1] J. Aracil, F. Gordillo, “El péndulo invertido: un desafío
de una señal de referencia tipo escalón. para el control no lineal,” Revista Iberoamericana de
Automática e Informática Industrial, vol. 2, pp. 8-19,
Apr. 2005.