Está en la página 1de 7

DESARROLLO Y CONTROL DE UN PÉNDULO DE FURUTA

A. Valera, M. Vallés, M. Cardo


Dpto. Ingeniería de Sistemas y Automática
Universidad Politécnica de Valencia
Camino de Vera 14, 46022 Valencia (Spain)
E-mail: giuprog@isa.upv.es, mvalles@isa.upv.es, mcardo@isa.upv.es

Resumen puesto que hace imposible tener un control directo en


los grados de libertad no actuados, de modo que el
Este trabajo presenta el desarrollo y control de un control de estos se debe realizar (siempre que sea
péndulo de Furuta. Éste se trata de un sistema posible) de forma indirecta por medio de los restantes
subactuado de dos grados de libertad rotacionales. grados de libertad actuados.
El primer elemento (brazo) tiene un giro alrededor de
un eje perpendicular a la base, mientras que el De este modo podemos definir como sistema
segundo elemento (péndulo) se encuentra colocado subactuado como aquel sistema que carece de al
en un extremo del brazo y su eje de giro es colineal al menos un actuador en uno de sus grados de libertad,
eje axial del brazo, realizando un giro en un plano es decir, un sistema subactuado será aquel que posee
perpendicular al brazo. un número de grados de libertad mayor que de
actuadores [4].
La ventaja del sistema desarrollado es doble, ya que
por una parte el péndulo se trata de un sistema La definición de sistema subactuado incluye no sólo
inestable, y en ocasiones es necesario disponer de el fallo en los actuadores, sino también la ausencia de
este tipo de sistemas para poder trabajar con los mismos provocada por consideraciones de diseño
cuestiones avanzadas de control. La segunda ventaja del sistema físico, falta de espacio, exceso de peso,
que tiene es que, por el material escogido, el coste de por cuestiones de presupuesto etc.
desarrollo es muy económico, siendo muy
conveniente porque permitiría replicarlo en el caso Dentro de los sistemas subactuados, un ejemplo
en el que fuera necesario (para un laboratorio comúnmente utilizado y ampliamente estudiado es el
docente de robótica, por ejemplo) sistema del péndulo invertido basado en un carro
móvil [2], [5]. Los péndulos se utilizaron inicialmente
como banco de pruebas para la aplicación de
conceptos de control lineal y no lineal como
Palabras Clave: péndulo invertido, aplicaciones estabilización de sistemas inestables [2], [3], control
digitales por computador, control por computador, con estructura variable [8], control de energía [1],
robótica. control por realimentación del estado [6], etc.

Sin embargo, los péndulos invertidos presentan el


1 INTRODUCCIÓN inconveniente de que la carrera del carro se encuentra
acotada, lo que puede limitar las maniobras de
A la hora de establecer el control por computador de control. Para salvar esta limitación se generó una
procesos físicos se tienen que implementar unos modificación a dicho sistema el cual se suple la
algoritmos de control que permitan que el sistema carrera lineal del carro por una trayectoria circular
pueda alcanzar una serie de especificaciones de cerrada, creando así al denominado sistema Péndulo
funcionamiento estáticas y dinámicas. Para ello de Furuta.
debemos tener en cuenta además las perturbaciones
inherentes a los sistemas reales como incertidumbres El sistema Péndulo de Furuta fue creado por el Dr. K.
en los parámetros o en la dinámica del modelo, ruidos Furuta del Instituto de Tecnología de Tokio, el cual es
etc. un sistema subactuado de dos grados de libertad
ambos rotacionales llamados brazo y péndulo. El
La existencia de las perturbaciones no sólo puede movimiento del brazo (primer grado de libertad) se
complicar de forma considerable el control del realiza en un plano horizontal girando alrededor de un
sistema, sino que además pueden incluso modificar eje perpendicular al plano, mientras que el péndulo se
también la dinámica del sistema, como cuando se encuentra colocado en un extremo del brazo y su eje
tienen desgastes mecánicos o fallos de los actuadores. de giro es colineal al eje axial del brazo y su
movimiento se realiza en un plano perpendicular al de
La existencia de fallos en los actuadores representa este último.
un problema muy interesante para la teoría de control
Lo interesante desde el punto de vista del control del m
Péndulo de Furuta está provocado por la
configuración que tiene puesto que no se puede
realizar una linealización exacta de su modelo por
retroalimentación de estados, lo cual limita la l
α
variedad de algoritmos de control que pueden serle
aplicados. r J

En este trabajo se va a mostrar el desarrollo de un θ


péndulo de Furuta. Debido a los materiales escogidos
se ha conseguido que su precio sea muy económico,
lo que facilita replicarlo en el caso que se necesite Figura 2: Modelo simplificado del péndulo
equipar un laboratorio docente con esta clase de
sistemas. Además del desarrollo, el artículo muestra
también el modelado del sistema, así como la Utilizando la formulación del Lagrangiano podemos
implementación de estrategias de control basado en la obtener las ecuaciones diferenciales del sistema:
realimentación del estado, utilizando para ello la
herramienta de Real-Time Windows Target, una
extensión del paquete de Matlab. ( mr 2
+ J )θ + mrαl cos (α ) − mrα 2 l sin (α ) = τ
mrl cos (α )θ − mrl sin (α )αθ
  + ml 2α − mgl sin (α ) = 0

2 MODELADO DE UN PÉNDULO La representación del sistema lineal en el espacio de


DE FURUTA estados viene dada por la ecuación de estado
siguiente:
Tal como se ha comentado, el péndulo de Furuta
consta de los dos elementos que se muestran en la 0 0 1 0 0
figura siguiente: brazo y péndulo. θ  0 0 
0 1    0 
θ
      
α 
   − mrg  α   1 
péndulo   = 0 0 0    +   τ (1)
θ J θ
brazo       J 
α  J + mr 2  α   −r 

0 g 0 0    
 Jl   Jl 

Si tenemos en cuenta que el par de control se genera


por un motor de corriente continua controlado por
tensión:
1 K
V = IR + K eθ ⇒ I = V − e θ
R R
donde R y Ke se corresponden con las constantes
eléctricas del actuador.
Figura 1: Modelo esquemático del péndulo
Considerando que el par es proporcional a la
El modelo simplificado del sistema se muestra en la
intensidad:
figura 2. En él se puede apreciar la posición del brazo
(θ) y la posición del péndulo (α), siendo r y l las K K2
τ = K e I ⇒ τ = e V − e θ
longitudes de los elementos, m la masa del péndulo y R R
J la inercia del actuador.
Sustituyendo la expresión de τ:
Las ecuaciones de la energía cinética y potencial del
péndulo vienen dadas por las expresiones siguientes: 0 0 1 0  0 

θ  0  0 0 1  θ   0 
U pen = mgl cos (α )       
α  
 −mrg − K e2  α   K e 
  = 0 0    +  V (2)
( )
K pen = 0.5  θr + α l cos (α ) + (α l sin (α ) )   θ   JR 
2 2
θ
   J JR
  α   α   − K e r 
  0 g J + mr 2 rK e2
K = 0.5 Jθ  2
 0  JRl 
base  Jl JRl 
3 DISEÑO EXPERIMENTAL DE UN medio de un tren de engranajes. Así, midiendo la
PÉNDULO DE FURUTA tensión que proporciona el potenciómetro podemos
saber directamente la posición del primer elemento.
Uno de los problemas más habituales que nos
encontramos a la hora de trabajar con los procesos Para conectar el actuador eléctrico con la base del
experimentales es el precio que estos suelen tener. El brazo del péndulo se ha mecanizado con un bloque de
alto precio que tienen suele dificultar la posibilidad NYLON (SUPER-POLIAMIDA-PA 6) una unión
de replicarlo para poder trabajar de una forma cilíndrica que se acopla perfectamente en el tubo
cómoda tanto en los laboratorios docentes como de hueco del brazo. La unión queda fijada atornillándose
investigación. tanto a la base del brazo como al eje del actuador, tal
como se muestra en la figura siguiente. Se ha
Por ello, una de las primeras premisas que se escogido este material porque es un material robusto,
consideraron en el diseño y desarrollo del péndulo de tiene un buen coeficiente de roce y es sencillo de
Furuta fue tratar que el coste de implementación de mecanizar.
éste fuera el más económico posible. Para ello se ha
escogido como actuador un motor de corriente
continua existente previamente en los laboratorios del
Dpto. de Ingeniería de Sistemas y Automática de la
Universidad Politécnica de Valencia. Para la
estructura mecánica del sistema se ha escogido el
aluminio, tanto por su peso como por su bajo precio.
La figura 3 muestra una vista general del péndulo
desarrollado.

Figura 4: Unión actuador-brazo

El extremo del primer segmento del brazo está


soldado con el segundo elemento, formando entre
ellos un ángulo de 90º. De esta forma, el eje de giro
del conjunto que forma brazo es colineal al eje
vertical Z, lo que provoca que el movimiento del
brazo sea circular en el plano horizontal XY.

Este segundo segmento del brazo es, al igual que el


primero, un tubo de aluminio hueco. Sobre él
descansa el segundo elemento: el péndulo. El péndulo
está constituido por dos barras macizas de aluminio
que forman un ángulo de 90º. Una barra se inserta en
el interior del segundo segmento del brazo, y para que
pueda girar libremente se han añadido dos
rodamientos. El eje de giro del péndulo es colineal al
eje axial del brazo, por lo que el movimiento del
péndulo describe una trayectoria circular contenida en
el plano perpendicular al eje axial del brazo.
Figura 3: Vista general del péndulo desarrollado
Para poder medir el ángulo del giro del péndulo
En la figura 3 se pueden observar los dos elementos: respecto al brazo añadido un potenciómetro en el
el brazo y el péndulo del péndulo de Furuta extremo de la primera barra del péndulo. Si bien se
propuesto. El primer elemento del brazo es un tubo podría haber utilizado cualquier potenciómetro, se ha
hueco de aluminio cuya base está conectada con el escogido uno de la serie P2200 de novotechnik© por
actuador eléctrico. El actuador utilizado es el Rotary tratarse de un potenciómetro con un par
Servo Plant SRV-02 de la empresa canadiense extremadamente bajo, gran linealidad, repetitividad y
Quanser Consulting©. El servo SRV-02 consiste en durabilidad, una velocidad de trabajo muy alta y un
un servomotor de corriente continua, de forma que la movimiento mecánico de 360º continuos.
salida del motor se conecta a un potenciómetro por
La unión entre la barra del péndulo y el eje del esta solución se dificulta la síntesis de la ley de
potenciómetro se realiza mediante un tornillo simple. control.
Debido a los diferentes diámetros de los elementos, la
unión entre el 2º segmento del brazo y el De este modo, la forma más habitual para establecer
potenciómetro se ha mecanizado con un bloque de el control del péndulo es mediante la utilización de
metacrilato una segunda unión cilíndrica. En un controladores complementarios. El primero se emplea
extremo de la unión se introduce a presión y se para asegurar la atracción del estado de sistema hacia
atornilla el potenciómetro, mientras que el otro una región cercana al origen, mientras que y el
extremo se introduce dentro del 2º elemento del segundo controlador se encarga de regular la posición
brazo. La elección de este material viene motivada del péndulo sobre el punto de equilibrio inestable.
por la elevada resistencia mecánica, rigidez, dureza y
un bajo coeficiente de fricción. Para llevar a cabo los dos controladores se han
desarrollado distintos reguladores y estrategias de
La figura 5 muestra con mayor detalle el control. Así por ejemplo, para el primer controlador
potenciómetro, la barra del péndulo y el elemento de se suelen basar en las propiedades energéticas
que nos permite la unión entre el potenciómetro y la utilizando una función candidata de Lyapunov que
barra del brazo. asegura la atracción del estado del sistema a la región
cercana al origen gracias a las propiedades pasivas
del péndulo de Furuta.

El segundo controlador puede ser un controlador


lineal (basado en un control lineal óptimo, por
ejemplo) que logra la estabilidad y permanencia del
péndulo en su punto de equilibrio inestable.

En este trabajo se ha utilizado un controlador basado


en la realimentación del estado para establecer el
control alrededor el punto de equilibrio inestable,
utilizándose la herramienta de Real-Time Windows
Target de Matlab para realizar la implementación del
control.

Figura 5: Unión péndulo-potenciómetro El esquema general de control por realimentación del


estado utilizado se muestra en la figura siguiente:

4 CONTROL DEL PÉNDULO DE


FURUTA
La finalidad del control de procesos es que la
respuesta del sistema a controlar cumpla con una
serie de especificaciones de funcionamiento
dinámicas y estáticas a pesar de las incertidumbres y
perturbaciones asociadas a su funcionamiento.

Habitualmente las estrategias de control se aplican a Figura 6: Control por realimentación del estado
sistemas físicos con el mismo número de actuadores y
de grados de libertad. Sin embargo estas técnicas no donde G, H y C se corresponden con las matrices que
se pueden aplicar directamente sobre sistemas forman las ecuaciones de estado y salida discretas:
subactuados. En este trabajo se ha abordado el control
de un sistema subactuado: el péndulo de Furuta, de x(k + 1) = Gx(k ) + Hu (k )
(3)
manera que se trata que controlar la posición del y ( k ) = Cx( k )
extremo del péndulo en su punto de equilibrio
inestable. La acción de control para resolver el problema de la
regulación del sistema viene dada por la ecuación
Para abordar el control de este sistema se debe tener siguiente:
en cuenta que las ecuaciones que describen la
dinámica del péndulo completo son esencialmente de u (k ) = − Kx(k ) (4)
naturaleza no lineal. Por ello se podría plantear una
linealización exacta del péndulo por medio de la donde K = [ k1 k2 " kn ] es la matriz de
realimentación de los estado, pero al no ser posible ganancias de realimentación del estado.
Para calcular la matriz K se pueden utilizar diversas adquisición de datos PCL-812PG. Una vez se calcula
técnicas, como por ejemplo el control lineal la acción de control u(k) se debe suministrar al
cuadrático, el cual calcula la matriz de realimentación actuador eléctrico del péndulo. Para hacerlo se utiliza
óptima tal que el sistema en bucle cerrado minimiza el bloque de salida analógica que accede a la tarjeta
un índice de desempeño cuadrático J: de convertidores D/A PCL-726.

J = ∫ ( x′Qx + rV 2 )dt
du/dt -K-
(5) Derivati ve1 k4

al fa

Otra técnica para el diseño del controlador por 6.36 -K- -K-

realimentación del estado que se puede utilizar es el Constant vol2rad k2


acontrol

diseño por asignación de polos. Este diseño se debe Analog


Output

calcular la matriz de ganancias K de forma que la Analog du/dt -K-


m Saturation Anal og Output
Input
Derivative k3 Adv antech

matriz del estado en bucle cerrado que viene dada por Analog Input
Adv antec h -K-
PC L-726 [200h]

la ecuación siguiente:
PC L-812PG [300h]
vol2rad theta

-K-

x(k + 1) = ( G − HK ) x(k ) k1

Figura 7: Esquema RTWin del control del péndulo


sea asintóticamente estable, por lo que para todo
x(0) ≠ 0 es posible hacer que x(t) tienda a cero en un Tal como se puede observar en (2), el vector de
periodo de tiempo aceptable. Para resolver la estado del péndulo está formado por las posiciones y
expresión: velocidades de los elementos del péndulo de Furuta.
Como el hardware del péndulo no incluye tacos-
zI − ( G − HK ) = α control ( z ) (7) dinamos que proporcionen las velocidades, éstas se
tienen que obtener a partir de los 2 bloques que
calculan las derivadas de las posiciones. Una vez se
podemos utilizar los comandos de Matlab place o tienen las 4 señales la acción de control se calcula
acker, a los que se les debe proporcionar las matrices mediante la realimentación de dichas señales,
de la representación interna del sistema (3), así como multiplicándolas por los elementos ki de la matriz de
los polos en bucle cerrado que se desean para la realimentación K.
dinámica de control.
Cabe destacar que se necesita pasar de las señales de
Una vez obtenida la matriz K del controlador se debe tensión a señales en ángulos (radianes). Para ello se
implementar un algoritmo con la ecuación de la utilizan las constantes vol2rad. Por último se necesita
acción de control (4). Para ello se puede utilizar restar a la tensión que suministra el ángulo del
cualquier lenguaje de alto nivel (como C) trabajando péndulo α el valor 6.36. Esto es debido a que dicha
en entornos de tiempo real. Básicamente, a cada tensión se corresponde a un ángulo de 0 rad. del
iteración del bucle de control el algoritmo de control péndulo.
debe:
• obtener el estado del sistema Una vez se ha desarrollado el esquema de control
• calcular la acción de control u(k) sólo hay que compilarlo para obtener un esquema
• proporcionar u(k) al péndulo ejecutable en el entorno de Windows. Las figuras
siguientes muestran las posiciones del péndulo y del
Para realizar este trabajo se ha escogido el entorno de brazo, así como las acciones de control.
la Real-Time Workshop (RTWin), de Matlab. Dicho
0.1
entorno permite utilizar todos los bloques gráficos de
Simulink, lo que facilita mucho el desarrollo de los
controladores. Además, también se pueden utilizar 0.05

unos bloques especiales que serán los encargados de


acceder a las tarjetas de adquisición de datos para
Angulo pendulo (rad)

0
obtener las señales del sistema y de suministrar las
acciones de control al proceso a controlar. En [7] se
puede encontrar una explicación más detallada de la -0.05

utilización de RTWin para el control de robots en


tiempo real. -0.1

La figura 7 muestra el esquema de control del


péndulo implementado. Para obtener la posición del -0.15
0 5 10 15 20 25 30 35 40 45 50

brazo (θ) y del péndulo (α) se utiliza un bloque de Tiempo (seg)

entrada analógica que accede a la tarjeta de Figura 8: Posición del péndulo (rad)
0.3
La figura 13 muestra las acciones de control, y se
0.2
puede observar como efectivamente en los instantes
0.1 donde se ha perturbado al sistema las acciones de
0 control son más grandes (más de 5 voltios) para tratar
de devolver al péndulo en la posición de equilibrio.
Angulo brazo (rad)

-0.1

-0.2

-0.3 0.25

-0.4 0.2

-0.5
0.15
-0.6

Angulo pendulo (rad)


0.1
-0.7
0 5 10 15 20 25 30 35 40 45 50
Tiempo (seg) 0.05

Figura 9: Posición del brazo (rad) 0

-0.05

3 -0.1

-0.15
0 2 4 6 8 10 12 14 16 18 20
2
Tiempo (seg)

1
Figura 11: Posición del péndulo ante perturbaciones (rad)
Accion de control (v)

0.8

-1
0.6

-2
0.4
Angulo brazo (rad)

-3 0.2
0 5 10 15 20 25 30 35 40 45 50
Tiempo (seg)
0
Figura 10: Acción de control (v)
-0.2

El periodo de muestreo utilizado para establecer el -0.4

control es de 5mS. Tal como se puede observar, la


posición del péndulo se mantiene durante el tiempo -0.6
0 2 4 6 8 10 12 14 16 18 20
de ejecución (1 minuto) en el origen con una Tiempo (seg)

oscilación de ángulo muy pequeña (alrededor de 0.09 Figura 12: Posición del brazo ante perturbaciones (rad)
radianes). La posición del brazo tiene una oscilación
alrededor del origen mayor (0.5 radianes), pero dicha
oscilación se debe a que éste es el elemento actuado
6
que se debe de encargar de mantener vertical al
péndulo. Por último, se puede apreciar como la
4
acción de control que se debe suministrar al actuador
no es muy grande, puesto que está acotada alrededor
2
de ±2 voltios.
Accion de control (v)

0
Para analizar el comportamiento del sistema ante
perturbaciones se ha realizado una nueva ejecución -2
en la cual se sacó al sistema de su equilibrio
(aplicando una fuerza en el extremo del péndulo) en 3 -4
instantes (en t = 2seg., t = 8seg., y t = 14.5seg.). Tal
como se puede observar en las figuras siguientes, el -6
sistema es capaz de mantener el equilibrio a pesar que 0 2 4 6 8 10
Tiempo (seg)
12 14 16 18 20

las perturbaciones sacaron al péndulo en .25 radianes.


Para ello el brazo se tiene que mover hasta los 0.7 Figura 13: Acciones de control (v)
radianes (aproximadamente) para que el péndulo
recupere el equilibrio.
5 CONCLUSIONES [4] Spong M.W. (1994) “The control of underactued
mechanical systems” Int. conf. Mechatron.
El trabajo ha mostrado el modelado, diseño, la
construcción y el control de un prototipo de sistema [5] Spong M. W. (1994) “Swing control of the
subactuado: el péndulo de Furuta. Para ello primero acrobot” Procedings IEEE international
se han obtenido las ecuaciones diferenciales del conference Robotics and automation, pag. 2356-
sistema, obteniendo un modelado en el espacio de 2361 (Vol 1)
estados.
[6] Torres H.I. (2002) “Control de Sistemas No
A continuación se ha mostrado el prototipo Linealizables en Forma Exacta”, documento
desarrollado. Debido a los materiales utilizados, este interno, Centro de Investigación y de Estudios
prototipo tiene como principal característica su bajo Avanzados del IPN, México.
coste, lo cual lo hace muy interesante si se pretende
replicarlo para poder equipar un laboratorio docente. [7] Valera, A., Vallés, M., Tornero, J. (2001) “Real-
Time Robot Control implementation with
Por último, se ha abordado el control del sistema. Matlab/Simulink”, Telematics Application in
Para ello primero hay que implementar un algoritmo Automation and Robotics, Ed. Pergamon, ISBN
de control que suministre la suficiente energía al 0 08 043856 3.
sistema como para llevar al péndulo a una zona
cercana al origen. Una vez en esta zona se debe [8] Yamakita, M, Furuta, K. (1992) “VVS Adaptive
conmutar de controlador, para regular al sistema para Control based on Nonlinar Model for TITech
que no salga del punto de equilibrio inestable. El pendulum”, IEEE 1488-1493.
artículo ha mostrado como no sólo el regulador es
capaz de controlar al sistema, sino que además es lo
suficientemente robusto como para eliminar el efecto
de perturbaciones que lo saquen de su punto de
equilibrio.

La plataforma desarrollada es un prototipo muy


interesante porque permite trabajar con cuestiones
muy diversas de control, como controladores lineales
y no lineales, conmutación entre controladores etc.

Agradecimientos

Los autores desean expresar su agradecimiento a la


Consellería de Innovación y Competitividad de la
Generalitat Valenciana, por la financiación parcial de
este trabajo bajo el proyecto de I+D:
CTIDIB/2002/22.

Referencias

[1] Astrom, K.J., Furuta K. (2000) “Swinging up a


Pendulum by Energy Control”, Automatica, vol
36, pag. 287-295

[2] Mori, S., Nishihara, H, Furuta, K. (1976)


“Control of Unstable Mechanical Systems:
Control of Pendulum”, Int. J. of Control, vol 23,
n5, pag. 673-692

[3] Schaefer, J.F., Cannon R.H. (1967) “On the


Control of Unstable Mechanical Systems”, Proc.
of 3rd Int. Federation on Automatic Control
(IFAC), vol 1 (6C.1-6C.13)

También podría gustarte