Professional Documents
Culture Documents
ISSN 0122-1701 16
Resumen Este artculo presenta modelos matemticos que comunicaciones y en general los procesos de produccin, han
representan fenmenos fsicos y comportamientos de una evolucionado aceleradamente hasta alcanzar niveles de
planta o sistema, dependientes exclusivamente de los seguridad y calidad impensados algunas dcadas atrs [5].
requerimientos y necesidades de control y del grado de
exactitud necesario determinado por el diseador. Para esto Por lo anterior, el componente investigativo de la ciencia se ha
se desarrollaron modelos del pndulo rotacional invertido a
enfocado en el desarrollo y la comprensin de sistemas fsicos
partir de la mecnica de Lagrange y la mecnica de Newton,
logrando disear una tarea de control en el espacio global, que posean caractersticas no lineales dentro de su modelado
mostrando la rapidez y eficiencia empleando tcnicas de matemtico y en consecuencia un desafo para las tcnicas
regulacin de energa para el Swing Up y de realimentacin clsicas de control, llevando a que los equipos conocidos como
de variables de estado para estabilizacin y posicionamiento pndulos logren una gran acogida en el campo de la
alrededor del punto de operacin. De esta manera, se investigacin, ya que son sistemas que poseen grandes
demuestra tambin que conmutacin de controladores puede similitudes con los modelos de equipos comnmente utilizados
ser una alternativa vlida para control global de sistemas en el mundo laboral, crendose as nuevos prototipos y
fsicos, reduciendo la complejidad en su diseo. esquemas de control [5,6].
Palabras clave Control global, funciones de energa, Es de vital importancia para las tcnicas de control basadas en
pndulo rotacional invertido, realimentacin de variables de modelos matemticos considerar diferentes eventos fsicos
estado, Swing up. presentes en el comportamiento de la planta, con el fin de
asegurar un modelado de calidad, sin embargo ests condiciones
Abstract This paper presents mathematical models that son imprcticas debido a la excesiva complejidad matemtica
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 tcnicas clsicas ms
pendulum from Lagrangian mechanics and Newtonian
mechanics, making design a control task in the global space, destacadas para el modelado de sistemas fsicos, son basadas en
showing the speed and performance using energy regulation las mecnicas Lagrangiana, Newtoniana y Hamiltoniana, cada
control technique for the swing up and feedback of state una de las cuales considera diferentes aspectos fsicos y en
variables for stabilization and positioning around the general, encuentran representaciones matemticas 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 seccin II de este artculo se presenta una descripcin
general del pndulo rotacional invertido y se realiza un
Key Word Global control, energy functions, feedback of modelado utilizando formulacin a partir la mecnica de
state variables, rotational inverted pendulum, swing up. Lagrange. En la seccin III se presenta el diseo de un
controlador para la planta a partir de un modelo matemtico
basado en las ecuaciones de Newton para el Swing up y otro
I. INTRODUCCIN controlador por realimentacin de variables de estado para la
regin de equilibrio. En la seccin IV se presentan las
En la actualidad, la investigacin sobre robtica ha simulaciones y pruebas realizadas al modelo representativo del
impulsado en gran medida el desarrollo de lo que se conoce pndulo de Furuta, donde se evala el comportamiento del
como Ingeniera de Control debido a la necesidad de controlador ante las tareas de control para regulacin y
automatizacin 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 da como el transporte, las
Fecha de Recepcin: 14 de Septiembre de 2012
Fecha de Aceptacin: 19 de Diciembre de 2012
17 Scientia et Technica Ao XVII, No 52, Diciembre de 2012. Universidad Tecnolgica de Pereira.
II. MODELO MATEMTICO PARA EL considera una masa de balance en el extremo restante del
PNDULO ROTACIONAL INVERTIDO pndulo de magnitud M . La posicin angular del pndulo se
ha definido como cero en la posicin vertical superior y con
A. Descripcin del sistema fsico sentido de giro positivo en la direccin de las manecillas del
reloj. El ngulo de la barra horizontal se ha definido con sentido
El pndulo de Furuta, tambin conocido como pndulo de giro positivo en la direccin opuesta a las manecillas del
rotacional invertido, fue diseado por el Doctor Katsuhisa reloj.
Furuta del Instituto Tecnolgico de Tokio en el ao de
1992, como una variacin del pndulo invertido, con el La Tabla 1, contiene los parmetros fsicos del pndulo de
fin de eliminar la limitante fsica de movimiento que Furuta disponible en el Laboratorio de Investigacin es Sistemas
impone el riel sobre el cual el carro se desliza, a travs de Control de la Universidad Tecnolgica de Pereira.
la inclusin en el sistema de una trayectoria de giro circular
infinita.
Parmetro Valor Unidades (SI)
El pndulo rotacional invertido es un mecanismo sub- Masa brazo horizontal ( ma ) 0,077752 kg
actuado con dos (2) grados de libertad y constituido por
Masa pndulo ( 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 pndulo ( 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 travs de una articulacin, se
encuentra sujeto el pndulo que puede girar libremente en
un plano vertical formando una trayectoria cilndrica con Tabla 1. Parmetros fsicos del pndulo de Furuta.
respecto al eje z.
La caracterstica de sistema sub-actuado est determinada B. Modelado matemtico del sistema
porque solo posee un elemento activo y cuenta con dos
brazos que pueden moverse en dos planos diferentes y El modelo matemtico del sistema puede ser representado
perpendiculares entre s. mediante una ecuacin 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 energa cintica y la
1 2 1 2 2 energa potencial presentadas en las ecuaciones (23) y (24),
K MB = M la + l p sin obteniendo como resultado la ecuacin (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 energas cintica y + m p + M l p 2&2 sin 2
potencial de cada uno de los componentes del pndulo 3
rotacional invertido, se calculan las energas 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 ecuacin (28), se definen unas constantes, en
+ 2 m p + M la l p
2 funcin de los parmetros 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. Mecnica de Lagrange = m p + M la l p
2
La mecnica de Lagrange describe el comportamiento de 1
las posiciones y velocidades articulares (angulares) de un = m p + M gl p
sistema fsico. Este modelo puede ser descrito en forma 2
compacta como (25).
Al aplicar esta reduccin de trminos a la ecuacin 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 actan sobre el sistema, como se definidas por (26) y (27), sobre el Lagrangiano (30) y una
muestra en [5]. reduccin 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 fsico pndulo de Furuta.
comportamiento de un sistema fsico en funcin 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 matemtico que se present en las
capacidad de movimiento o giro a un sistema fsico ecuaciones (31) y (32), para el pndulo rotacional invertido, es
determinado; en el caso del pndulo de Furuta es necesario posible construir un espacio de estados no lineal, con ecuaciones
determinar las caractersticas 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 elctricas y las variables
mecnicas [6]. espacio de estados no lineal como (37), (38), (39) y (40), las
cuales representan el comportamiento del sistema fsico en
El circuito equivalente de un motor de corriente continua, cualquier punto de operacin, y pueden ser linealizadas
puede expresarse en funcin del voltaje, la corriente y la alrededor de un punto de operacin de inters particular [6].
velocidad de giro de su eje, como se observa en la ecuacin
(33). x&1 = x2 (37)
di (33)
+ ke&
v = Ri + L 1
dt x&2 =
Donde los parmetros R, L, ke son las constantes + ( 2 + 2 ) sin 2 x3
2
(
u = k ( E E0 ) sign & cos ) (54)
regulacin, adicional a esto se puede encontrar ganancias La figura 4, Muestra la interconexin de bloques y la
que permitan el seguimiento de referencia a una de las conmutacin de controladores para la planta pndulo 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 funcin de transferencia que relaciona la
entrada activa con la variable de inters, porque esta
caracterstica conduce a ganancias infinitas para lograr un
seguimiento de referencia, lo que sera 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 pndulo
de Furuta.
r (t ) es la seal de referencia para una de las variables del
sistema, K f es la ganancia de realimentacin que modifica Los parmetros de diseo para la realizacin 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 seal de control aplicada a los Donde k representa la constante de diseo que permite alcanzar
termnales del actuador [7]. la posicin de equilibrio para el controlador swing up. Ei y
E0 son las energas inicial y final del modelo del pndulo
simplificado. K f y K r , representan las ganancias de
realimentacin para reubicacin de polos y seguimiento de
referencia.
k = 22.99
Ei = 2mg
Figura 3. Esquema de control en lazo cerrado con (58)
regulacin y seguimiento de referencia
E0 = 0.05
K r = [0.6972]
La figura 3, presenta un diagrama de bloques donde se
define la realimentacin 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 seccin presenta las simulaciones correspondientes al
desde su posicin de equilibrio natural (posicin vertical diseo del controlador para regulacin de las variables de estado
inferior), hasta el punto de equilibrio inestable (posicin y seguimiento de referencia. Para este propsito utiliz
vertical superior), se propone la realizacin de una MATLAB 2010a en un computador Intel Core 2 Duo E8400,
conmutacin de controladores por Swing up y 4GB RAM.
realimentacin de variables de estado en un punto lo
suficiente cercano a la zona de equilibrio, donde el A. Regulacin de las variables de estado
controlador local, logre estabilizarlo de forma exitosa. Para
el diseo de este controlador se tomar como regin de La regulacin de variables de estado supone que despus de
pasado el estado transitorio de un sistema controlable, todas las
conmutacin el intervalo 15 25 , sin querer decir variables de estado llegarn a cero en un corto periodo y se
que sea la nica opcin posible, ya que esto depende de la mantendrn all, debido a la accin de la seal de control y
robustez del controlador y las limitaciones fsicas de los mientras no se presenten perturbaciones que saquen la planta de
sistemas. [6] la regin de operacin que est bajo de influencia del
controlador lineal.
Scientia et Technica Ao XVII, No 52, Diciembre de 2012. Universidad Tecnolgica de Pereira. 24
1. Seguimiento de referencia
REFERENCIAS
Figura 10. Posicin angular del pndulo para seguimiento [1] J. Aracil, F. Gordillo, El pndulo invertido: un desafo
de una seal de referencia tipo escaln. para el control no lineal, Revista Iberoamericana de
Automtica e Informtica Industrial, vol. 2, pp. 8-19,
Apr. 2005.