Escolar Documentos
Profissional Documentos
Cultura Documentos
net/publication/284062877
CITATION READS
1 310
1 author:
Felipe Sorcia-Vázquez
University of Guadalajara
8 PUBLICATIONS 10 CITATIONS
SEE PROFILE
All content following this page was uploaded by Felipe Sorcia-Vázquez on 17 November 2015.
Resumen—Se presenta: a) el modelado de un brazo robot de éstas mismas. Estos “reconstructores integrales” presentan
eslabón flexible de un grado de libertad; b) el análisis, diseño, un “off-set” o desviación del valor verdadero del estado.
simulación e implementación en tiempo real de dos esquemas Una de las ventajas de este controlador (GPID) es que se
de control: 1) el control PID Generalizado basado en el modelo implementa únicamente con la medición de la variable de
lineal del sistema; 2) Control Sin Modelo para seguimiento de salida del sistema.
trayectoria. Se realizó un análisis comparativo de estas También se propone el uso de una técnica de control sin
metodologías de diseño, así como del desempeño de ambos
modelo a la cual los autores le dieron el nombre de control
esquemas. Tanto en simulación como la aplicación en tiempo
real se obtuvieron resultados satisfactorios en el desempeño de PID inteligente (Flies y Join, 2008) y (Flies y Join, 2009), y
los controladores propuestos. a la cual nos referiremos en lo subsecuente como Control
Palabras clave: Brazo robot de eslabón flexible, control PID Sin Modelo (CSM). Este control toma en cuenta partes
generalizado (GPID), Control Sin Modelo. desconocidas de la planta que se desean controlar sin tener
que modelarlas. Estas partes desconocidas pueden ser no
I. INTRODUCCIÓN linealidades ó parámetros variantes en el tiempo.
Entre de los dispositivos electromecánicos se encuentran los El objetivo final de este trabajo es comparar dos
robots accionados mediante motores eléctricos, que son de esquemas que se derivan del control PID clásico: el control
uso muy frecuente en la industria manufacturera. El GPID, que se basa en el conocimiento parcial ó total de
principal objetivo de control para estos sistemas, es llevar al modelo del sistema, mientras que el esquema de CSM, no
efector final del robot a una posición deseada para que éste requiere del modelo del sistema. Ambos esquemas se
cumpla con la tarea asignada. En la actualidad, se busca que aplican para seguimiento de trayectoria en un prototipo
las estructuras de los robots sean más ligeras. Esto, se didáctico de la marca Quanser, que consiste en un brazo de
obtiene modificando su geometría o utilizando materiales eslabón flexible de un grado de libertad.
más livianos, lo que origina un fenómeno de oscilación del Este artículo se encuentra estructurado de la forma
efector del brazo al acercarse a la posición final. Dichas siguiente: en la Sección II se expone el modelado del brazo
oscilaciones se presentan por la flexibilidad de las de eslabón flexible. En la Sección III se muestra el análisis
articulaciones ó la flexibilidad en el eslabón (Feliu, 2006). de los esquemas de GPID y CSM. En la Sección IV se
Para resolver el problema de control de brazos flexibles, realiza el diseño, simulación e implementación de los
se abordaron distintas técnicas de control. Entre éstas se controladores propuestos. Finalmente, en la Sección V se
encuentran: Control Robusto (Etxebarria et ál. 2005), presentan las conclusiones del trabajo.
Control H (Yeon et ál. 2008) y (Hiessien y Lohmann, II. MODELADO DEL SISTEMA.
2001), Control Adaptable (Yang et ál. 1997), (de Queiroz et
El sistema de brazo flexible consiste en un motor de CD de
ál. 1999) y (Yim, 2001), Control por Redes Neuronales
alto par, acoplado a un eslabón de material flexible
(Gutiérrez et ál. 1998), Control Óptimo (Carusone et ál.
mediante dos sistemas de engranajes, uno incorporado en la
1993) y Control por Platitud Diferencial (Sira y Agrawal
carcasa del motor y otro montado en la estructura. La
2004).
Figura 1 muestra el sistema de eslabón flexible
En este artículo se propone la aplicación del control
GPID robusto para perturbaciones constantes para el
seguimiento de trayectoria del eslabón flexible. Esta técnica
de control, que se usa en (Chávez et ál. 2005) y (Sira et ál.
Figura 1. Brazo de eslabón flexible.
2001), integra la estimación de estados no medibles con un
Para obtener el modelo del sistema, se parte del modelo
controlador retroalimentado. Se basa en la estimación
matemático del motor de CD. En la Figura 2 se muestra el
estructural de las variables sin tener que utilizar
circuito de armadura del motor:
estimadores asintóticos. Tales variables se estiman usando
las entradas y salidas del sistema y las integrales iteradas de
Congreso Anual 2010 de la Asociación de México de Control Automático. Puerto Vallarta, Jalisco, México.
donde J hub es la inercia del sistema de engranaje y Beq es el Figura 4. Modelo simplificado del brazo flexible.
coeficiente de fricción viscosa total del sistema. Después de El desplazamiento del sistema de engranaje se representa
sustituir (5) en (6) y de realizar el álgebra correspondiente,
se obtiene la ecuación diferencial del motor de CD de con el vector X h y la deflexión del eslabón con el vector
imanes permanentes: Xl . Este sistema rotatorio se describe por
J R B R K K K K K V (7)
2
eq m load eq m g m m T g load g m g T m
J arm K stiff (10)
2
dónde J eq J hub g K g J m .
Congreso Anual 2010 de la Asociación de México de Control Automático. Puerto Vallarta, Jalisco, México.
2 2 2
derivadas sucesivas, sin tomar en cuenta la perturbación
La función de disipación de Rayleigh se obtiene a partir * n*
del coeficiente de fricción viscosa total del sistema, esto es: u y (23)
1 Se define la siguiente ecuación de error
load Beq
2
(16) n
2 load e y eu (24)
Sustituyendo (15) y (16) en (8) y realizando las donde e y y y y eu u u
*
operaciones se obtiene:
De (24) se puede obtener un conjunto de reconstructores
J eq J load load J load TL Beqload (17)
integrales de la dinámica del error de la salida basadas en el
J loadload J load K stiff 0 (18) error de entrada mediante integrales
iteradas†
Despejando y de (17) y (18), respectivamente, y n 1
usando (5), que describe el par de entrada, se obtiene e y eu d 1 d 1
2
Kstiff gm Km KT Kg Beq Rm gm K g KT t 1 t 1
load load Vm (19) ey
n 2
eu d 2 d 1 d 2 d 1
J eq Rm J eq Rm J eq 0 0 0 0
ey eu d n d 2 d 1 d n
d 2 d 1
A partir de las ecuaciones (19) y (20) se puede obtener 0 0 0 0 0 0
una representación en espacio de estado:
Con los reconstructores integrales del estado se propone
0 0 1 0 la siguiente ley de control u , basada en la
0
load 0 0 1 load retroalimentación del estado, con una compensación
K K K K 2
B R integral de los errores de reconstrucción; y que considera la
0 stiff
g m m T g eq m
0 presencia de una perturbación constante y la señal de
load J eq Rm J eq load
control nominal u :
*
0
J eq J load Rm Jeq
0
u u k2n1ey kn1ey kney kn1 ey k0 ey (25)
* n1
( n)
t 1 2
1
( )
†
0
t denota a la integral iterada d d d (Chávez et 2 1
0 0 0 0
ál. 2005)
Congreso Anual 2010 de la Asociación de México de Control Automático. Puerto Vallarta, Jalisco, México.
u K p e K i e K d e
(30) nj
donde [ y j ( k )]e corresponde a la estimación de la derivada
n
donde y es la trayectoria de referencia, y es la n-ésima en el instante de tiempo k .
derivada de la trayectoria de referencia, y e y y es el IV. DISEÑO Y SIMULACIÓN DE LOS ESQUEMAS GPID Y CSM PARA EL
error de seguimiento. ESLABÓN FLEXIBLE.
El diseño del controlador se basa, entonces, en la En esta sección se muestran los resultados en simulación y
identificación de F y en la selección de , K p , K i y K d . tiempo real de la aplicación del los esquemas GPID y CSM
al sistema de brazo flexible.
Configuración libre de modelo.
A. DISEÑO DEL CONTROLADOR GPID PARA EL BRAZO FLEXIBLE.
Considere el sistema SISO de dimensión finita
Considérese el modelo lineal del eslabón flexible descrito
por (21). En (Sira y Agrawal, 2004) se demuestra que un
E t , y , y , , y , u , u , , u
l k
0 (31) sistema es diferencialmente plano si, y sólo si, es
controlable, y se reporta el procedimiento para obtener la
Este sistema puede ser lineal o no lineal. E es una salida plana de un sistema lineal. La salida plana para el
función suficientemente suave de sus argumentos. Se asume sistema de brazo flexible es la suma de los ángulos load
Congreso Anual 2010 de la Asociación de México de Control Automático. Puerto Vallarta, Jalisco, México.
y , es decir, y load . Se tiene que las derivadas de la usando (40), se propone el siguiente polinomio
4
salida plana son: característico Hurwitz de lazo cerrado s 2 n s n 2 2
y load , y 1 , y 1
y 1 ,
( 4)
con n 25 y 1 . La trayectoria de referencia deseada
K stiff K stiff se construyó a partir de polinomios de Bezier de diferentes
donde 1
J eq J eq J load amplitudes, éstas son: 2 5 , 4 y 3 . Se introdujo a
Una vez que la salida plana y sus derivadas sucesivas se la simulación ruido de sensor con desviación estándar
3
han obtenido, se puede determinar el controlador nominal 1 10 .
del sistema basado en la salida plana y sus n derivadas Los resultados de la simulación del controlador tipo
sucesivas, que está definido por: GPID se muestran en la Figura 5. La figura muestra el
Vm 1 y 2
y 3 seguimiento de trayectoria del eslabón flexible, el voltaje de
* * * * *( 4 )
y 4y (36)
control aplicado el motor de CD así como el resultado de los
donde
criterios de desempeño evaluados. Las simulaciones
2 2 1 1 corrieron durante 20 segundos. La masa de la punta del
1 , 2 , 3 , 4
3 13 1 3 13 brazo m1 se propuso de 0.025 Kg así como para la parte
K stiff J eq J load
2
g m K m K T K g Beq Rm experimental.
1 , 2 a) Posición Deseada vs Posición Final
2
J eq J load Rm J eq Referencia
1
Posición (rad)
Salida
g m K g KT
3 0
Rm J eq
-1
-2
0 2 4 6 8 10 12 14 16 18 20
De acuerdo con (25), el controlador tipo GPID para el
eslabón flexible tiene la forma b) Señal de control
4
2
Vm Vm k 7
ey k 6 ey k 5 ey k 4 e y k3 e y k 0
*
e y (37) 1
Volts (V)
m
ey 4 e y (38) -1
-2
Al sustituir (38) en (37), así como los reconstructores 0 2 4 6 8 10 12 14 16 18 20
Criterios de desempeño:
integrales de las derivadas del error de salida, se obtiene la ITAE=0.7087,IAE=0.0758,ISE=0.0004
Tiempo (seg)
siguiente ecuación dinámica del error Figura 5. Resultados de la simulación del control GPID.
e y 7 e y 6 e y 5 e y 4 e y
(8) (7) ( 6) (5) (4)
Posición (rad)
Salida
0 0
-1 -1
-2 -2
0 2 4 6 8 10 12 14 16 18 20 0 2 4 6 8 10 12 14 16 18 20
1 1
Volts (V)
Volts (V)
0 0
-1 -1
-2 -2
0 2 4 6 8 10 12 14 16 18 20 0 2 4 6 8 10 12 14 16 18 20
Criterios de desempeño: Criterios de desempeño: Tiempo (seg)
Tiempo (seg)
ITAE=3.515,IAE=0.378,ISE=0.013 ITAE=0.7786, IAE=0.0818, ISE=0.0004
Figura 6. Resultados de la simulación del esquema de CSM. Figura 8. Resultados experimentales del control GPID.
0 0
-1
-2
0 1 2 3 4 5 6 7
-2
b) Posición Brazo (rad) 0 2 4 6 8 10 12 14 16 18 20
0.05 Criterios de desempeño: Tiempo (seg)
ITAE=3.685, IAE=0.513, ISE=0.012
la salida y de la señal de control. Esto da origen a la función Michel Fliess y Cédric Join(2008). Intelligen PID controlers. 16th
Mediterrean Conference on Control and Automation, Ajaccio: France.
F. Este esquema de control no requiere conocimiento del Michel Fliess y Cédric Join(2009). Model-free control and intelligen PID
sistema y, por ende, resulta menos complicada su controllers: towards a possible trivialization of nonlinear control. 15th
aplicación, a diferencia del controlador GPID que presenta IFAC Symposium on system identification.
un diseño más complejo.
Ambos esquemas se implementaron en tiempo real con
éxito, obteniendo resultados aproximados a los que las
simulaciones arrojaron. Para determinar el desempeño de
los controladores, tanto en simulación como en tiempo real,
se evaluaron tres criterios de error, estos son: ISE, IAE e
ITAE (por sus siglas en inglés). Como se puede observar, el
control GPID tiene un mejor desempeño que el esquema de
CSM en los tres criterios evaluados, tanto en simulación
como en la aplicación en tiempo real. Basándose en los
valores del criterio de desempeño ITAE, se puede observar
de las Figuras 8 y 9, que el desempeño del controlador
GPID es mejor que el del esquema de CSM. Sin embargo, el
controlador GPID requiere del modelo del sistema y el
esquema de CSM no. El diseño del esquema CSM es menos
complejo y aún se obtiene un desempeño aceptable.
VI. AGRADECIMIENTOS.
Al Consejo Nacional de Ciencia y Tecnología por haber
financiado este proyecto.
REFERENCIAS
Victor Etxebarria, Arantza Sanz e Ibone Lizarraga (2005). Control of a
Lightweight Flexible Robotic Arm Using Sliding Modes. International
Journal of Advanced Robotic Systems. Volume 2, pp 103-110.
Je S. Yeon, Jong H. Park y Sang-Hun Lee (2008). Practical Robust Control
for Flexible Joint Robot Manipulators. 17th IFAC World Congress
(IFAC'08).
Dadi Hissein y Boris Lohmann (2001). Robust control for a flexible-link
manipulator using sliding modes techniques and nonlinear H∞
control design methods, IEEE International Conference on Robotics
& Automation. Seoul, Korea.
Jung Hua Yang, Feng Li Lian y Li Chen Fu (1997). Nonlinear Adaptive
Control for Flexible-Link Manipulators. IEEE Transaction on
Robotics and Automation, VOL. 13, NO. 1, pp 140-148.
M. S. de Queiroz, D. M. Dawson, M. Agarwal y F. Zhang (1999).
Adaptive Nonlinear Boundary Control of a Flexible Link Robot Arm,
IEEE Transaction on Robotics and Automation, VOL. 15, NO.
Woosoon Yim (2001). Adaptive Control of a Flexible Joint Manipulator,
IEEE International Conference on Robotics & Automation. Seoul,
Korea.
L. B. Gutiérrez, F. L. Lewis y J. Andy Lowe (1998). Implementation of
a Neural Network Tracking Controller for a Single Flexible Link:
Comparison with PD and PID Controllers. IEEE Transactions on
industrial electronics, VOL. 45, NO. 2
J. Carusone, Keir S. Buchan, y G. M. T. D’Eleuterio(1993). Experiments
in End-Effector Tracking Control for Structurally Flexible Space
Manipulators. IEEE Transaction on Robotics and Automation, VOL.
9, NO. 5, pp 553-560.
Vicente Feliu Batlle (2006). Robots flexibles: hacia una generación de
robots con nuevas prestaciones. Revista iberoamericana de
automática e informática industrial. VOL 3, NO. 3.
Herbert Sira-Ramírez y Sunil K. Agrawal (2004). Differentially Flat
Systems. Marcel Dekker Inc.
E. Chávez-Conde, H. Sira-Ramírez y J. Álvarez-Gallegos (2005). Diseño
mecatrónico, modelado y control PI generalizado de un sistema
mecánico rotacional. IEEE 3° congreso internacional de innovación y
desarrollo tecnológico, 28 al 30 de septiembre 2005, Cuernavaca,
Morelos, México.
Hebertt Sira-Ramírez , Richard Marquez y Michel Fliess (2001). On the
Generalized PID Control of Linear Dynamic Systems. European
Control Conference. Portos, Portugal.