Documentos de Académico
Documentos de Profesional
Documentos de Cultura
Copia para uso personal, se prohbe la transmisin de este documento por cualquier medio o formato.
http://www.revista-riai.org
1. INTRODUCCIN
Posiblemente el mayor problema cuando se aborta del control de
fuerza mediante robots manipuladores sea el cambio abrupto de
la fase de movimiento libre a la de movimiento restringido. La
transicin de una fase a la otra, tambin llamada impacto, puede
ser considerada como la cuestin ms crtica de la tarea, puesto
que la diferencia en la dinmica del sistema durante las dos fases
es trascendental. Esto queda enfatizado por el hecho de que en
las aplicaciones industriales tpicas el entorno suele ser muy
rgido, provocando que el sistema sea altamente subamortiguado
con elevadas frecuencias de oscilacin.
De esta forma, durante el impacto pueden tener lugar altos picos
de fuerza, lo que puede provocar en el peor de los casos daos
irreversibles al robot, al entorno o a la herramienta. En el mejor
de los casos, los picos menores de fuerza deterioran
gradualmente la mecnica del robot.
Adems de los picos de fuerza, otro problema relacionado con el
impacto es la posibilidad de que aparezcan rebotes, en los cuales
la herramienta del robot pierde momentnea y repetidamente el
contacto con la superficie del entorno.
Si las caractersticas del entorno fueran conocidas, estos
inconvenientes se podran evitar diseando un regulador
sobreamortiguado. Por desgracia, generalmente ste no es el
caso. As, los parmetros seleccionados originalmente para el
regulador pueden ser inapropiados y puede requerir algn
cambio en dichos parmetros si el sistema tiene una respuesta
subamortiguada al realizarse el contacto. Un problema adicional
del control del impacto es su duracin extremadamente breve, de
pocos perodos de muestreo. Como consecuencia, un control
adaptativo, por ejemplo, puede ser demasiado lento para proteger
el sistema.
Algunos autores proponen la aplicacin de un controlador cuyo
nico fin sea tratar de suavizar del impacto y que sera aplicado
solamente durante la fase transitoria. Su objetivo no sera el
seguimiento de un valor de referencia, sino la disipacin rpida
Documento descargado de http://www.elsevier.es el 26/05/2016. Copia para uso personal, se prohbe la transmisin de este documento por cualquier medio o formato.
22
Reajuste de los Parmetros de la Impedancia Mecnica Para la Mejora de la Disipacin de la Energa Durante el Impacto
Documento descargado de http://www.elsevier.es el 26/05/2016. Copia para uso personal, se prohbe la transmisin de este documento por cualquier medio o formato.
R. Zotovic, . Valera
23
F ( s ) Ms 2 X + BsX + KX
K
=
= Ms + B +
v(s)
sX
s
(1)
(2)
donde Fext es la fuerza exterior que acta sobre el robot, Md, Bd, y
Kd la masa el amortiguamiento y la rigidez que se quieren
imponer al sistema, x, x,
x, la posicin, velocidad y
aceleracin del robot respectivamente, y xref , xref , xref , los
valores de referencia de la posicin, velocidad y aceleracin.
Las dos ltimas formulaciones son casos especiales de la
primera. sta se puede escribir de la siguiente forma:
Fext = M d x + Bd x + K d x (M d xref + Bd x ref + K d xref ) =
(3)
= M d x + Bd x + K d x ff
donde ff es la prealimentacin.
Documento descargado de http://www.elsevier.es el 26/05/2016. Copia para uso personal, se prohbe la transmisin de este documento por cualquier medio o formato.
24
Reajuste de los Parmetros de la Impedancia Mecnica Para la Mejora de la Disipacin de la Energa Durante el Impacto
(4)
X
X
F F = B( X ) X + C ( X , X ) + L( X )
(8)
(5)
f = K e ( x xe ) Be x
(9)
B( X ) = ( JD1 (Q) J T ) 1
CX = BJD1HQ BJQ
(6)
L( X ) = BJD1G
3.2 El control
Existen varias formas de implementar el control por impedancia.
Las dos ms comunes son mediante la realimentacin del estado
y mediante la dinmica inversa (Sciavicco y Siciliano, 96). La
primera forma tiene la ventaja de que es ms sencilla y que no
necesita un sensor de fuerza. Sin embargo no es adecuada para
ms de un grado de libertad. Por esta razn se utilizar la
segunda forma.
El propsito del regulador por dinmica inversa es obtener la
dinmica requerida (equivalente a la ecuacin (3)), pero de
forma independiente para cada direccin. As, el regulador se
compone de dos partes. La primera, que compensa la dinmica
del robot y desacopla el sistema, es bien conocida y se ha
utilizado a menudo para el control de robots, por ejemplo,
(Volpe y Khosla, 1993). La segunda parte del controlador se
encarga de imponer la dinmica requerida.
Para desacoplar el sistema, el vector de pares de los motores en
coordenadas cartesianas debe ser:
(7)
F = B( X ) X d + C ( X , X ) + L( X ) + F
donde X d es el vector de aceleraciones deseadas.
(10)
ff + K e xe
M d s + (Bd + Be )s + (K d + K e )
2
(11)
ff + K e xe
Kd + Ke
(12)
(13)
s1, 2 =
(14)
Documento descargado de http://www.elsevier.es el 26/05/2016. Copia para uso personal, se prohbe la transmisin de este documento por cualquier medio o formato.
R. Zotovic, . Valera
25
3
2.5
2
1.5
1 2 1 2
mv + kx
2
2
(15)
2E
K
x ( x = 0) =
2E
m
Velocidad [m/s]
0.5
0
-0.5
-1
-1.5
-2
-2.5
7
10
Posicin [m]
11
12
13
(16)
(17)
0.12
0.1
0.08
0.06
Velocidad [m/s]
Velocidad [m/s]
X0
-2
-4
0.04
0.02
-6
-0.02
2
10
12
Posicin [m]
14
16
18
-0.04
-1.5
-1
-0.5
0.5
1
Posicin [m]
1.5
2.5
3
-5
x 10
1
1
mmin v 2 + k max x 2
2
2
(18)
Documento descargado de http://www.elsevier.es el 26/05/2016. Copia para uso personal, se prohbe la transmisin de este documento por cualquier medio o formato.
26
Reajuste de los Parmetros de la Impedancia Mecnica Para la Mejora de la Disipacin de la Energa Durante el Impacto
1
1
mmax v 2 + k min x 2
2
2
(19)
1.
2.
x 0 =
m max
(20)
La sobreoscilacin es menor.
La posibilidad de prdidas de contacto tambin es menor.
2E 1
(22)
k max
(23)
Velocidad [m/s]
x1 =
0.5
X0
X1
X2
3
Ek < Ek 1
(24)
k
k min
k
m
m
E 2 k 1 = min min E 2 k 2 = .... = min min
k max
k max mmax
k
m
max max
E 2 k 1 =
mmin
mmax
k min mmin
k max mmax
2 E2 k 1
=
k2
-2
4
6
Posicin [m]
10
12
14
-4
x 10
E 0
k 1
(25)
E0
k m
2 min min E2 k 3
k m
k max mmax
= min min x2 k 3
k2
k max mmax
x2 k 1 =
4
-1
-4
Se puede deducir:
E2k =
-0.5
(27)
(26)
E 2 k = E 2 k 1 =
E 2 k 1 =
m
mmin
E 2 k 2 = .... = min
mmax
mmax
m
mmin
E 2 k 2 = min
mmax
mmax
E0
(28)
E0
Documento descargado de http://www.elsevier.es el 26/05/2016. Copia para uso personal, se prohbe la transmisin de este documento por cualquier medio o formato.
R. Zotovic, . Valera
27
mmin
x2 k 3
mmax
(29)
6. CONMUTACIN DE PARMETROS DE LA
IMPEDANCIA MECNICA
Las consideraciones anteriores han sido hechas para un sistema
idealizado. Un sistema real conlleva dos factores nuevos:
1 2 1
x + (x x )2
2
2
(30)
ff + K e xe ( Bd + Be ) x ( K d + K e ) x
Md
(31)
(32)
(33)
(34)
A partir de este resultado, a continuacin se va a proceder a
obtener los criterios de conmutacin para cada uno de los tres
parmetros.
La funcin del control del impacto debe ser disipar la energa
inicial del sistema tan rpidamente como sea posible. De esta
manera, se amortiguan las oscilaciones, los picos de la fuerza
son reducidos, el sistema se protege mejor y la posibilidad de
rebotes se reduce.
V
con
(35)
Su derivada ser:
V = xx + x ( x x )
(36)
si
si
xx < 0
xx > 0
(37)
Documento descargado de http://www.elsevier.es el 26/05/2016. Copia para uso personal, se prohbe la transmisin de este documento por cualquier medio o formato.
Reajuste de los Parmetros de la Impedancia Mecnica Para la Mejora de la Disipacin de la Energa Durante el Impacto
400
300
200
100
0
-100
-200
-300
500
1000
1500
2000
2500
Tiempo [Microsegundos]
3000
3500
4000
500
400
200
V
xx
ff + K e xe
=
+ x
=
K d
Md
( K d + K e )2
100
= x(
300
Fuerza [N]
500
Fuerza [N]
28
(38)
-100
-200
-300
ff + K e xe
x
)
2
( Kd + Ke ) M d
500
1000
1500
2000
2500
Tiempo [Microsegundos]
3000
3500
4000
K max
Kd
K min
si
si
ff + K e xe
x
)<0
( K d + K e )2 M d
ff + K e xe
x
x(
)>0
( K d + K e )2 M d
x(
(39)
Documento descargado de http://www.elsevier.es el 26/05/2016. Copia para uso personal, se prohbe la transmisin de este documento por cualquier medio o formato.
R. Zotovic, . Valera
29
x
Md
(40)
(45)
M d ( 2 k 2) M d ( 2 k )
Bd ( 2k 2) ! Bd ( 2k )
(42)
donde
BTot Bd Be
Kd Ke
4Z 2
BTot ( 2k 2) BTot ( 2k ) ! 1
(47)
BTot ( 2k 2) BTot ( 2k ) ! 4Z 2
(48)
BTot ( 2k 2) ! BTot ( 2k ) 4Z 2
(49)
Bd ( 2k 2) ! Bd ( 2k ) 4Z 2
(50)
400
2
BTot
4 K Tot M d
(46)
2
500
2
2
BTot
( 2k 2) BTot
( 2k ) ! 4Z 2
(41)
lo es equivalente a:
K Tot
el
2
2
BTot
( 2k 2) ! BTot
( 2k ) 4Z 2
(43)
(44)
300
200
Fuerza [N]
GV
GB d
aumenta
100
0
-100
-200
-300
200
400
600
1600
1800
2000
Documento descargado de http://www.elsevier.es el 26/05/2016. Copia para uso personal, se prohbe la transmisin de este documento por cualquier medio o formato.
30
Reajuste de los Parmetros de la Impedancia Mecnica Para la Mejora de la Disipacin de la Energa Durante el Impacto
Fuerza [N]
200
150
100
50
1000
2000
3000
8000
9000 10000
9. CONCLUSIONES
El propsito del artculo es la bsqueda de una forma de
amortiguar el impacto en el control de impedancia mecnica si
las caractersticas del entorno son desconocidas. Para ello se ha
propuesto un mtodo basado en la conmutacin de los
parmetros de la impedancia mecnica. Los criterios de
REFERENCIAS
B. Armstrong, J. McPherson y Y. Li, Stability of Nonlinear PD
control. Applied Mathematics and Computer Science, 7 (2),
101120 (1997);
B. Armstrong, D. Neevel y T. Kusik New results in NPID
control: Tracking, integral control, friction compensation and
experimental results IEEE Trans. on Control Systems
Technology, 9 (2), 399406 (2001);
B. Armstrong, J. Gutierrez, B. Wade y R. Joseph Stability of
Phase-Based Gain Modulation with Designer-Chosen Switch
Functions, The International Journal of Robotics Research 25
(8), 781-796 (2006).
R. Brach, Mechanical Impact Dynamics- Rigid Body Collisions
(John Wiley & Sons Publishers, New York, 1991);
B. Brogliato, Nonsmooth mechanics. (Springer Verlag, London,
1999);
Documento descargado de http://www.elsevier.es el 26/05/2016. Copia para uso personal, se prohbe la transmisin de este documento por cualquier medio o formato.
R. Zotovic, . Valera
31