Sunteți pe pagina 1din 13

Ingeniera 11 (1,2): 81-91, 2 001 San Jos.

Costa Rica

RECUPERANDO LA PRDIDA DE MOVILIDAD


EN MANIPULADORES SERIALES POR MEDIO
DE LA TEORA DE TORNILLOS
Jaime Gallardo Alvarado1
Vctor
Jos Mara RicoM. Alfaro 2
Martnez

Resumen

Un manipulador serial se encuentra en una configuracin singular cuando su rgano terminal es incapaz de moverse con una
velocidad arbitraria dentro del espacio de trabajo. Esta situacin es en general indeseable y debe evitarse o eliminarse. La primera
opcin es fcil de realizar aunque conlleva una reduccin del espacio de trabajo. La mayora de los manipuladores deben ser
capaces de operar en configuraciones singulares. Si la singularidad es inevitable, es necesario implementar un procedimiento que
permita eliminar la singularidad en que se encuentra el manipulador serial para tratar de recuperar su completa movilidad. En este
trabajo se muestra cmo el producto de Lie, una operacin fundamental del lgebra de Lie que es isomrfica con el lgebra de
tornillos, permite identificar los tornillos asociados a los pares cinemticos del manipulador, responsables de provocar la singu-
laridad. A diferencia de otros procedimientos reportados en la literatura, el aqu empleado es aplicable a manipuladores que pier-
den ms de un grado de libertad.

1. INTRODUCCIN Una singularidad ocurre cuando el rgano termi-


nal de un manipulador serial es incapaz de
Un manipulador serial redundante posee ms moverse con una velocidad arbitraria dentro del
grados de libertad que los estrictamente nece- espacio de trabajo. Esta situacin conduce a una
sarios para colocar su rgano terminal dentro solucin fsicamente irrealizable del anlisis de
del espacio de trabajo. Gracias a los citados velocidad inverso.
grados de libertad excedentes que conforman la
conocida redundancia del manipulador, ste Tradicionalmente, el anlisis de singularidades,
posee una alta capacidad de ser manipulable y las llamadas pesadillas cinemticas por
en consecuencia es capaz de ejecutar trayecto- Hollerbach, se ha estudiado extensamente, igua-
rias ms sofisticadas que las realizables con un lando a cero el determinante de la matriz
manipulador no redundante. Jacobiana. No obstante, debido a que la matriz
Jacobiana de un manipulador redundante no es
El anlisis de velocidad directo, dado un con- cuadrada, el clculo de su determinante no tiene
junto de velocidades generalizadas, consiste en sentido.
determinar cul es el efecto final sobre el
rgano terminal. Por su parte, el anlisis de A continuacin, se resumen algunas contribu-
velocidad inverso, suponiendo las condiciones ciones que abordan el tema de las singularidades
de velocidad sobre el rgano terminal, consiste en manipuladores seriales redundantes.
en determinar cules deben ser las velocidades
generalizadas necesarias para satisfacer las Baker y Wampler II (1988) desarrollaron un pro-
condiciones de velocidad impuestas al rgano cedimiento basado en conceptos de topologa
terminal. matemtica para analizar singularidades en

1 Doctor en Ciencias
2 PhD
82 INGENIERA

manipuladores seriales redundantes que se com- tornillos para detectar la singularidad y al tornil-
ponen exclusivamente de pares prismticos o de lo responsable de causarla. Cuando un manipu-
revoluta. El mismo Wampler II (1988) aplic lador serial no redundante pierde un grado de lib-
dichos conceptos en la determinacin de las ertad, el rango de la correspondiente matriz
trayectorias factibles que permitan al manipu- Jacobiana es 5, por lo tanto se tienen cinco
lador abandonar la singularidad en que se tornillos linealmente independientes con un
encuentra. Ramdane-Cherif et al. (1996) resuel- tornillo recproco comn. Hunt (1986) determin
ven el anlisis de velocidad inverso mediante que en una configuracin singular, el tornillo que
redes neuronales y de esta manera, analizan la es linealmente dependiente, no interviene en la
redundancia del manipulador. determinacin del tornillo que es recproco. Un
resultado similar fue reportado previamente por
Sin duda, la teora de tornillos infinitesimales es Sugimoto et al. (1982).
una alternativa confiable que permite de una
forma sistemtica y exacta explicar la naturaleza Parikian (1996) emple los determinantes de la
fsica de las singularidades. matriz Jacobiana y la matriz Gramiana para
determinar la proximidad de singularidades en
Lipkin y Duffy (1985) mostraron que una singu- manipuladores seriales no redundantes. La com-
laridad est presente cuando la cilindroide, binacin de los gradientes de esas matrices
generada entre dos tornillos coaxiales, degenera provee informacin para liberar al manipulador
en una lnea. de la singularidad en que se encuentra. En ese
mismo ao, Karger (1996) utiliz el lgebra de
Cuando el determinante de una matriz es cero, Lie para describir las posibles configuraciones
condicin necesaria para la existencia de la sin- singulares en manipuladores seriales no redun-
gularidad en manipuladores seriales no redun- dantes.
dantes, existe dependencia lineal entre las
columnas que la componen. Esta situacin per- En un trabajo previo Rico et al. (1995) introdu-
mite ubicar como una primera aproximacin jeron un mtodo para identificar a los tornillos que
los posibles elementos que provocan la singu- provocan dicha singularidad, dado un manipulador
laridad. Chevallier (1995) desarroll un algo- serial no redundante en una configuracin singular.
ritmo basado en el lgebra de Lie para probar la A diferencia de los procedimientos anteriormente
dependencia lineal en conjuntos de tornillos. mencionados, en particular el de Hunt (1986). El
Podhorodeski et al. (1993) investig la prdida mtodo propuesto por Rico et al. (1995) es aplica-
de movilidad en manipuladores redundantes ble a manipuladores no redundantes que pierden
agrupando los tornillos asociados a los pares ms de un grado de libertad, tarea que se considera
cinemticos del manipulador linealmente adems de compleja, extremadamente laboriosa.
dependientes.
En este trabajo se extiende el mtodo introduci-
Es interesante mencionar que, si bien es cierto, do por Rico et al. (1995), aplicable en manipu-
existe una cantidad bastante respetable de con- ladores seriales no redundantes a los manipu-
tribuciones que tratan el problema de las singu- ladores seriales redundantes.
laridades en temas como la identificacin y la
caracterizacin de singularidades, sorprendente-
mente, el tema de escape de singularidades ha 2. CONCEPTOS PRELIMINARES
llamado poco la atencin.
Supongamos dos cuerpos rgidos que
El primer estudio formal que trata del tema del
escape de singularidades se debe a Hunt (1986), s
quien recurri a la matriz de cofactores de la $=
matriz Jacobiana y a la teora de sistemas de so (1)
GALLARDO y RICO: Recuperando la prdida de movilidad... 83

se encuentran conectados por medio de un par birse como una combinacin lineal de los torni-
helicoidal $. En coordenadas de Plucker, se llos infinitesimales asociados a los pares cinem-
representa en trminos de una componente pri- ticos que conforman al manipulador como
maria s y una componente dual sO de la siguiente
manera:

Donde s es un vector unitario a lo largo del eje 1$1 + 2$2 + ... + m 1$ m 1 + m $ m = 0 V m


instantneo del par helicoidal, mientras que sO es
(5)
el momento producido por un punto arbitrario O,
fijo a uno de los dos cuerpos, el cual se determi- donde i representa el cambio instantneo de
na en trminos del paso h del tornillo como velocidad relativo entre dos cuerpos adyacentes.
so = hs + so r (2) Por lo tanto, reescribiendo en forma matricial la
ecuacin (5), el anlisis de velocidad directo se
Donde r es un vector que se inicia en un punto resuelve mediante la expresin:
del eje instantneo del tornillo que conecta a los
dos cuerpos y termina en el punto O, mientras
que representa al producto cruz usual del lge-
1
bra vectorial tridimensional.
2
A principios del siglo pasado Ball (1 900) defi-
[$1 $2 ... $ m 1 $ m ] ... = 0 V m
ni el estado de velocidad de un cuerpo rgido
cuando se observa desde otro cuerpo o sistema m 1
de referencia, como el arreglo de una compo-
nente primaria y una componente dual vO de m
la siguiente manera: (6)
Por su parte, el anlisis de velocidad inverso se
V = resuelve mediante:
vo (3)
1

Donde y vO son los vectores velocidad angu- 2
lar y velocidad de un punto O fijo al cuerpo r- ... = J-1 0
Vm
gido, como se observan desde el sistema de re- (7)
ferencia seleccionado. m 1

m
El mismo Ball (1 900) defini el estado de velo-
cidad como un giro infinitesimal sobre un torni-
llo, as el estado de velocidad, ecuacin (3), pue- Donde J es la matriz Jacobiana que se forma por
de reescribirse como: el subespacio generado por los tonillos $ 1, $ 2,
, $ m-1 y $ m.
V = $ (4)
Cuando la matriz Jacobiana es singular, el manip-
ulador serial se encuentra en una configuracin
Se sabe que en un manipulador serial el estado de singular; sin embargo, es evidente que para el
velocidad del rgano terminal, cuerpo m, con anlisis de velocidad inverso, si la matriz
respecto al eslabn base, cuerpo 0, puede escri- Jacobiana no es cuadrada, el clculo de su inversa
84 INGENIERA

carece de sentido. Por lo tanto, es necesario producto de Lie posee las caractersticas nece-
recurrir a un procedimiento alterno que permita sarias para tratar de efectuar un escape de la
detectar las posibles singularidades. configuracin singular en que se encuentra el
manipulador.
Yoshikawa (1 985) defini al ndice de manipu-
labilidad como:
2. FUNDAMENTOS DEL MTODO
= J JT (8)
Esta seccin se inicia con una definicin for-
Donde T denota la transpuesta de la matriz. Es mal del concepto de singularidad en manipu-
evidente que en una configuracin singular el ladores seriales, este concepto puede analizarse
ndice de manipulabilidad es nulo. desde diferentes perspectivas, todas ellas vli-
das e igualmente tiles.
Una vez que la singularidad se ha detectado, es
necesario identificar el tornillo o tornillos infi- Los siguientes conceptos son equivalentes:
nitesimales causantes de la singularidad a fin
de que el manipulador recupere su movilidad. Un manipulador serial se encuentra en una
En el trabajo de Rico et al. (1 995) se muestra configuracin singular.
que el producto de Lie, una operacin funda-
mental del lgebra de Lie, es una herramienta El anlisis de velocidad inverso requiere
eficaz para identificar los tornillos responsa- de una solucin fsicamente imposible de
bles de provocar singularidades en manipula- realizar.
dores seriales no redundantes.
El ndice de manipulabilidad es cero.
Sean $1=(s1,sO1) y $2=(s2,sO2) dos elemen-
tos del lgebra de Lie (3). El producto de Lie, Si el manipulador serial es no redundante,
[$1 $2] se define como: el determinante de la matriz Jacobiana es
cero o equivalentemente, las columnas de
la matriz Jacobiana son linealmente depen-
s1 s2
[$1 $2] = (9) dientes.
s1 sO2 - s2 sO1
Puesto que los manipuladores seriales no
Por su parte, Hausner y Schwartz (1968) redundantes son casos particulares de los
definen el producto de Lie en trminos de manipuladores seriales redundantes, es evi-
desplazamientos Euclidianos: dente que un procedimiento que permita elimi-
nar singularidades en estos ltimos tambin
[$1 $2] =
d
dt
{m (t)$ [m (t) ] }
1 2 1
-1
t= 0
ser vlido para los primeros.

(10) Consideremos un manipulador serial redun-


dante, en el que el cuerpo designado como 0 es
el eslabn base y el cuerpo designado como m
Donde $1 es un vector tangente al desplaza- es el rgano terminal.
miento Euclidiano m1(t) en el tiempo t=0.
Sea S=$1, $2, , $m-1, $m, al conjunto S se
Puesto que para remover una singularidad en le denomina conjunto ordenado de tornillos.
un manipulador serial es necesario que la En particular, el tornillo $1 es el que conecta
trayectoria sea ortogonal y tangente a la direc- el eslabn base con la cadena serial mvil y el
cin de la singularidad, por simple inspeccin tornillo $m es el que conecta el rgano terminal
de las expresiones (9) y (10) se deduce que el con el resto de la cadena serial.
GALLARDO y RICO: Recuperando la prdida de movilidad... 85

Sea SS = $j,,$k un subconjunto de S, con En Rico et al. (1 995) se introducen las condi-
k>j y j 1, k m. Si los elementos de SS son ciones necesarias para eliminar la dependencia
adyacentes, entonces SS es un subconjunto lineal en el conjunto ordenado de tornillos,
ordenado de S, que se denota como SOS. stas se resumen y en su caso se adecuan al pre-
sente trabajo.
Puesto que la dimensin mxima del conjunto
ordenado de tornillos S es 6, el conjunto S se Sea S el conjunto ordenado de tornillos de un ma-
divide en varios subconjuntos ordenados cuya nipulador serial que se encuentra en una configura-
cardinalidad mxima es de 6. cin singular:

Se dice que el i-simo subconjunto ordenado de En Waldron et al. (1 985) se indica que los tor-
S, SOS(i), es un subconjunto ordenado singular nillos extremos $1 y $m no afectan las posi-
de S, SSOS(i), si: ciones relativas entre los restantes tornillos,
por lo tanto, cualquier desplazamiento alrede-
dim[SOS(i)] k - j dor de stos no puede sacar al manipulador
(11) serial de la singularidad en que se encuentra ni
Adicionalmente, la diferencia pueden ser descartados de inmediato.
(k-j+1)-dim[SOS(i)] se conoce como los grados
de libertad que ha perdido el subconjunto orde- Si se desea evitar configuraciones singulares
nado. es necesario que ningn subconjunto ordena-
do genere una sublgebra del lgebra de
Un subconjunto ordenado singular es un sub- Lie. Un resultado similar fue reportado pre-
conjunto ordenado singular mnimo viamente por Hunt (1978).
SOSM(i), si el subconjunto ordenado singular
pierde como mximo un grado de libertad y si Un desplazamiento alrededor del tornillo $j
su cardinalidad es la menor posible para provo- afecta a cada uno de los tornillos $k con k>j
car este grado de libertad perdido. A fin de iden-
tificar los tornillos que son linealmente inde- Si $j(t) y $k(t) junto con k>j son elementos del
pendientes dentro del subconjunto ordenado conjunto ordenado de tornillos en el tiempo
singular mnimo, es necesario determinar los t=0, el tornillo $k(t) puede calcularse aproxi-
subconjuntos de ste que son singulares, sin madamente como:
necesidad de ser ordenados. Un subconjunto
singular de un subconjunto ordenado singular $ k (t) $k(0) + [$j(0) $k(0)] t
mnimo, es un subconjunto singular mnimo
SSM(i) si ste pierde como mximo un grado de = $k + [$j $k] t
libertad y su cardinalidad es la menor posible Supongamos los elementos $f(i) y $h(i),
para provocar la singularidad. junto con h>f, que pertenecen al i-simo
subconjunto ordenado singular mnimo
Es razonable suponer que en una configuracin SOSM(i). Si $h(i) es, adems, un elemen-
singular, el subconjunto ordenado singular mn- to del subconjunto singular mnimo aso-
imo contiene al tornillo causante de por lo ciado al subconjunto ordenado singular
menos una singularidad. Por lo tanto, analizan- mnimo, entonces, existen elementos que
do los diferentes subconjuntos de un subconjun- resultan de los diferentes productos de Lie
to ordenado singular mnimo y su dimensin, es presentes entre las combinaciones de los
posible identificar al tornillo asociado a la sin- elementos del subconjunto ordenado sin-
gularidad. Es importante mencionar que en este gular mnimo con su subconjunto singular
punto no es necesario que los elementos de un mnimo, tales que algunos de ellos no per-
subconjunto del subconjunto ordenado singular tenecen al subespacio generado por el sub-
mnimo sean adyacentes. conjunto ordenado singular mnimo.
86 INGENIERA

La dimensin del subespacio generado por el 3. Calcule el determinante del producto de la


subconjunto ordenado singular mnimo que matriz Jacobiana por su transpuesta, si ste es
se obtiene al sustituir $h(i)+[$f(i) $h(i)] en cero, entonces el manipulador serial se
lugar de $h(i), es equivalente a la cardinalidad encuentra en una configuracin singular.
del subconjunto ordenado singular mnimo.
De esta manera, con la sustitucin el subcon- 4. Identifique y descarte los tornillos que no son
junto ordenado singular mnimo deja de ser los responsables de la singularidad.
singular. Al tornillo $f(i) se le denomina actu-
ador y al tornillo $h(i) se le denomina recep- 5. Determine un subconjunto ordenado singular
tor. Los desplazamientos de los tornillos aso- mnimo y su correspondiente subconjunto sin-
ciados a la singularidad no afectan a la dimen- gular mnimo.
sin de los subconjuntos de los restantes
tornillos. 6. Calcule los productos de Lie resultantes de
combinar cada uno de los elementos del sub-
Los productos de Lie que no se encuentran en conjunto ordenado singular mnimo con los
el subespacio generado por el subconjunto del subconjunto singular mnimo, tomando en
ordenado singular mnimo, contienen los cuenta que los subndices de los posibles
tornillos causantes de la singularidad. De esta tornillos actuadores son inferiores a los de los
manera, por inspeccin de esos productos de receptores.
Lie, se identifican los tornillos actuador y
receptor. 7. Seleccione los productos de Lie calculados en
el punto 6 que no se encuentren en el subespa-
Un tornillo actuador puede restaurar la dimen- cio generado por el subconjunto ordenado sin-
sin de ms de un subconjunto ordenado sin- gular mnimo.
gular mnimo. Una vez que se ha restaurado
la dimensin de cada uno de los subconjuntos 8. Identifique al tornillo asociado a la singulari-
ordenados singulares mnimos, resulta evi- dad, inspeccionando los productos de Lie
dente que el manipulador serial se encuentra seleccionados en el punto 7.
fuera de la configuracin singular y con ello
recupera su completa movilidad. 9. Determine el nuevo subconjunto ordenado
singular mnimo, calculando los correspondi-
entes productos de Lie y determine su nueva
3.1 UN ALGORITMO PARA ELIMINAR dimensin.
SINGULARIDADES
Una vez que se han completado satisfactoria-
En esta seccin se proporcionan los pasos necesar- mente los 9 pasos indicados para cada uno de los
ios para restaurar la dimensin de cada uno de los subconjuntos ordenados singulares mnimos, el
subconjuntos ordenados singulares mnimos, en el manipulador se encuentra fuera de la configu-
caso de que un manipulador serial se encuentre en racin singular y con ello ha recuperado su com-
una configuracin singular. pleta movilidad.

1. Determine en coordenadas de Plucker los 4. EJEMPLOS


tornillos infinitesimales asociados a los pares
cinemticos que conforman al manipulador Para mostrar la eficiencia de la metodologa selec-
se-rial. cionada en esta seccin se analizan tres ejemplos
de manipuladores seriales redundantes, los cuales
2. Determine el conjunto ordenado de los se encuentran intencionalmente en configura-
tornillos S. ciones singulares.
GALLARDO y RICO: Recuperando la prdida de movilidad... 87

4.1 MANIPULADOR SERIAL DE concurrentes y generan una sublgebra de e(3),


SIETE GRADOS DE LIBERTAD sta corresponde al subgrupo de rotaciones del
grupo Euclideo E(3). Los tornillos $1, $2, $5, $6
Considere el manipulador serial redundante que y $7 no son los causantes de provocar la singu-
se muestra en la figura 1. laridad y pueden descartarse de inmediato.

Por inspeccin, un subconjunto ordenado singu-


lar mnimo viene dado por:

SOSM(1) = =$1, $2, $3, $4, $5,

y su correspondiente subconjunto singular mni-


mo viene dado por:

SSM(1) = =$1, $3, $4, $5.

Por lo tanto, es necesario considerar los siguien-


tes productos de Lie:

Figura 1: Manipulador RCRRRR [$2 $3], [$2 $4], [$2 $5], [$3 $4], [$3 $5]
y [$4 $5].
Los tornillos infinitesimales en coordenadas de
Plucker, asociados a los pares cinemticos que Sin embargo, slo los productos de Lie [$3 $4],
conforman al manipulador serial vienen dados por: [$3 $5] y [$4 $5] no pertenecen al subespacio
generado por el subconjunto ordenado singular
mnimo SOSM(1), por consiguiente, los tornillos
$1=(1,0,0;0,0,-1), causantes de la singularidad pueden ser $3 y $4.
$2=(0,0,0;0,1,0),
$3=(0,1,0;0,0,0), La sustitucin de $5+[$4 $5]t en lugar de $5 en
$4=(0,1,0;0,0,5), el subconjunto ordenado singular mnimo
$5=(1,0,0;0,0,0), SOSM(1) conduce a:
$6=(0,0.7071,0.7071;0,-7.071,7.071),
$7=(0,0.7071,-0.7071,0,7.071,7.071), dim [$1 $2 $3 $4 $5+[$4 $5]t]=5,

mientras que la sustitucin de $4+[$3 $4]t en


donde los tornillos $2 y $3 estn asociados al par lugar de $4 y de $5+[$3 $5]t en lugar de $5,
cilndrico. ambas en el subconjunto ordenado singular m-
El conjunto ordenado de tornillos S del manipu- nimo SOSM(1), conduce a:
lador viene dado por:
dim [$1 $2 $3 $4+[$3 $4]t $5+[$3 $5]t]=5.
S=$1,$2,$3,$4,$5,$6,$7
Estos resultados indican que cualquiera de los
El determinante del producto de la matriz tornillos actuadores $3 o $4, pueden restaurar la
Jacobiana J=[$1 $2 $3 $4 $5 $6 $7] por su dimensin del subconjunto ordenado singular
transpuesta es cero, por lo tanto el manipulador mnimo SOSM(1). Sin embargo,
se encuentra en una configuracin singular.
dim [$2 $3 $4 $5+[$4 $5]t $6 $7]=5,
Los tornillos extremos del manipulador son $1 y y
$7. Los elementos del grupo $5, $6, $7 son dim[$2 $3 $4+ [$3 $4]t $5 +[$3 $5]t $6]=6.
88 INGENIERA

Por consiguiente, el manipulador puede aban-


donar la configuracin singular en que se De esta manera, el conjunto ordenado de tornil-
encuentra si el conjunto ordenado de tornillos los viene dado por:
original S se sustituye por:
S=$1, $2, $3, $4, $5, $6, $7, $8, $9
$1,$2,$3,$4+[$3 $4]t,$5 +[$3 $5]t,$6,$
El determinante del producto de la matriz
de esta manera, a fin de que el manipulador recu- Jacobiana, J=[$1 $2 $3 $4 $5 $6 $7 $8 $9], por
pere su completa movilidad es necesario actuar su transpuesta es cero, por lo tanto, el manipu-
la revoluta 3, $3. lador se encuentra en una configuracin singular.

Los tornillos extremos del manipulador son $1 y


4.2 EJEMPLO 2, MANIPULADOR DE $9, y puesto que no son los causantes de provo-
9 GRADOS DE LIBERTAD car la singularidad pueden ser descartados de
inmediato.
Considere el manipulador serial redundante que
se muestra en la figura 2. Por inspeccin, un subconjunto ordenado singu-
lar mnimo viene dado por:

SOSM(1) = =$2, $3, $4,

y su correspondiente subconjunto singular mni-


mo es el mismo subconjunto SOSM(1).

Por consiguiente, es necesario considerar los


siguientes productos de Lie:

[$2 $3], [$2 $4] y [$3 $4],

que no pertenecen al subespacio generado por el


subconjunto ordenado singular mnimo.

La sustitucin de $4+[$3 $4]t1 en lugar de $4


Figura 2: Manipulador RRRRRRRR en el subconjunto ordenado singular mnimo
SOSM(1), conduce a:
En coordenadas de Plucker, los tornillos infini- dim [$2 $3 $4 $5+[$3 $4]t1]=3,
tesimales asociados a los pares cinemticos que y con ello el subconjunto SOSM(1) deja de ser
conforman al manipulador vienen dados por: singular.

$1=(0,7071; 0; 0,7071; 0; 0; 0), Otro subconjunto ordenado singular mnimo


$2=(0,1,0;0,0,0), viene dado por:
$3=(0,1,0;0,0,2),
$4=(0,1,0;0,0,4), SOSM(2) =$2, $3, $4+[$3 $4]t1, $5, $6,
$5=(1,0,0;0,-1,0),
$6=(0,1,0;1,0,4), y su correspondiente subconjunto singular mni-
$7=(-0.7071,0,-0.7071;1.4142,-2.121,1.4142), mo viene dado por:
$8=(0,1,0;0,0,3),
$9=(-0,7071; 0; 0,7071;1,4142; -2,121; 1,4142). SSM(2) = =$2, $3, $4+[$3 $4]t1, $6.
GALLARDO y RICO: Recuperando la prdida de movilidad... 89

Los resultados obtenidos para el primer subcon- $5, $6+[$5 $6]t2, $7, $8, $9+[$8 $9]t3,
junto ordenado singular mnimo SOSM(1) indi-
can que slo es necesario considerar al producto por lo que es necesario actuar las revolutas 3, 5 y
de Lie [$5 $6] para el segundo subconjunto 8.
ordenado singular mnimo SOSM(2), el cual no
se encuentra en el subespacio generado por el 4.3 EJEMPLO 3, MANIPULADOR DE
subconjunto SOSM(2). SIETE GRADOS DE LIBERTAD

Tomando en cuenta que el producto de Lie es El manipulador serial redundante que se muestra
nilpotente y sustituyendo $6+[$5 $6]t2 en en la figura 3 es una adaptacin de una cadena
lugar de $6 en el subconjunto SOSM(2) se tiene cinemtica cerrada propuesta por Sugimoto et al.
que: (1982). El mecanismo original fue propuesto
para su caracterizacin y los resultados obtenidos
dim [$2 $3 $4+[$3 $4]t1 $5 $6+$6+[$5 demuestran que se trata de una estructura.
$6]t2] = 5. Con el objeto de ejemplificar la metodologa que
se aplica en el presente trabajo, el mecanismo
De esta manera, con dicha sustitucin el subcon- original se rompi para producir una cadena
juto SOSM(2) deja de ser singular. serial abierta y de esta manera, analizar las con-
figuraciones singulares.
Un tercer subconjunto ordenado singular mnimo
SOSM(3) viene dado por:

SOSM(3) = =$7, $8, $9,

y su correspondiente subconjunto singular mni-


mo SSM(3) viene dado por:

SSM(3) = =$7, $9.

As, slo es necesario considerar el producto de


Lie [$8 $9], el cual no se encuentra en el subes-
pacio generado por SOSM(3).
Figura 3: Manipulador RCRCR
La sustitucin de $9+[$8 $9]Dt3 en lugar de $9
conduce a: Los parmetros del mecanismo vienen dados por:

dim [$7 $8 $9+[$8 $9]t3] = 3, a12=0.577 u.l., a23=1 u.l., a34=2.828 u.l.,
y con ello el subconjunto SOSM(3) deja de ser
singular. a45=0 u.l., a51=1.154 u.l., S11=-2.804 u.l.,

La coleccin de estos resultados indica que a fin S33=2.828 u.l., S55=3 u.l.,
de recuperar la completa movilidad del manipu-
lador, el conjunto ordenado de tornillos original 12=150,23=135, 34=270, 45=90,
S debe sustituirse por: 51=330,

S=$1, $2, $3, $4, $4+[$3 $4]t1, donde los ngulos estn medidos en grados y
u.l. significa unidades de longitud.
90 INGENIERA

[$2 $4], [$2 $5], [$2 $6], [$3 $4], [$3 $5],
En coordenadas de Plucker, los tornillos infini-
tesimales asociados a los pares cinemticos que [$3 $6], [$4 $6] y [$5 $6].
conforman al manipulador vienen dados por:
De esta manera, suponiendo que el tornillo ac-
$1=(0,0,0;0,0,1), tuador es $3, tenemos que
$2=(0,0,1;0,0,0),
$3=(0,-0.7071,-0.7071;0,0.7071,-0.7071), dim
$4=(0,0,0;-1,0,0), [$1 $2 $3 $4+[$3 $4]t $5+[$3 $5]t $6] =6.
$5=(-1,0,0;0,0,-4),
$6=(0,0.866,-0.5;2,-0.866,-1.5), Adems:
$7=(0,1.5,-0.866;1.964,-0.5,-0.288).
dim
De esta manera, el conjunto ordenado de torni- [$2 $3 $4+[$3 $4]t $5+[$3 $5]t $6 $7] =6.
llos viene dado por:
De este modo, actuando la tercer revoluta $3, el
S=$1, $2, $3, $4, $5, $6, $7 manipulador puede abandonar la configuracin
singular en que se encuentra y con ello recupera su
completa movilidad..
El determinante del producto de la matriz
Jacobiana, J=[$1 $2 $3 $4 $5 $6 $7], por su
transpuesta es cero, por consiguiente, el manipu- 5. CONCLUSIONES
lador se encuentra en una configuracin singular.
Si un manipulador serial redundante o no redun-
Los tornillos extremos del manipulador son $1 y dante, se encuentra en una configuracin singular,
$7, y puesto que no son los causantes de provo- en este trabajo se muestra cmo el producto de Lie
car la singularidad pueden ser descartados de permite identificar los tornillos causantes de la
inmediato. singularidad. La metodologa seleccionada permite
eliminar singularidades en manipuladores que
Por inspeccin, existe un nico subconjunto pierden ms de un grado de libertad, tarea que se
ordenado singular mnimo, SOSM(1), el cual considera compleja y extremadamente laboriosa.
viene dado por: Finalmente, el mtodo seleccionado se prob exi-
tosamente en tres ejemplos.
SOSM(1) = $1, $2, $3, $4, $5, $6, $7
AGRADECIMIENTO

y su correspondiente subconjunto singular mni- El presente trabajo surgi como una sugerencia del
mo es el mismo subconjunto SOSM(1). Dr. Jos Alfonso Pmanes Garca, Profesor-
Por lo tanto, es necesario considerar los siguien- Investigador del Instituto Tecnolgico de la
tes productos de Lie, Laguna, Mxico.

[$2 $3], [$2 $4], [$2 $5], [$2 $6], [$3 $4],
BIBLIOGRAFA
[$3 $5], [$3 $6], [$4 $5], [$4 $6] y [$5 $6].
1. Baker, D.R., y Wampler II, C.W., ``On the
Los siguientes no pertenecen al subespacio Inverse of Redundant Manipulators". The
generado por el subconjunto ordenado singular International Journal of Robotics Research,
mnimo: Vol. 7, No. 2, pp. 3-21, 1 988.
GALLARDO y RICO: Recuperando la prdida de movilidad... 91

2. Ball, R.S., A Treatise on the Theory of Screws. Screws". ASME Journal of Mechanical
Cambridge University Press: Cambridge, 1 Design, Vol. 115, pp. 530-539, 1 993.
900.
11. Ramdane-Cherif, A., Perdereau, V., y Drouin,
3. Chevallier, D.P., Coordinate Free Criteria for M., ``Penalty Approach for a Constrained
Testing the Linear Dependence of the Sets of Optimization to Solve on-line the Inverse
Screws. En: Computational Kinematics '95, Kinematic Problem of Redundant
Merlet, J.-P., and Ravani, B., eds., Kluwer Manipulators". Proc. 1996 IEEE International
Academic Publishers, pp. 1 - 10, 1 995. Conference on Robotics and Automation, Vol.
1, pp. 133-138. Minneapolis, Minnesota, 1
4. Hausner, M., y Schwartz, J.T., Lie groups, Lie 996.
algebras. Gordon and Breach, New York, pp.
50, 1 968. 12. Rico, J.M., Gallardo, J., y Duffy, J., ``A
Determination of Singular Configurations,
5. Hunt, K.H., Kinematic Geometry of and Their Escapement from Singularities
Mechanisms. Oxford University Press: Using Lie Products". En: Computational
Oxford, 1978. Kinematics '95, Merlet, J.-P., y Ravani, B.,
editores. Dordrecht Kluwer Academic
6. Hunt, K.H., ``Special Configurations of Publishers, pp. 143-152, 1 995.
Robot-Arms Via Screw Theory". Robotica,
Vol. 4, pp. 171-179, 1 986. 13. Sugimoto, K., Duffy, J., y Hunt, K.H.,
7. Karger, A., ``Singularity Analysis of Serial- ``Special Configurations of Spatial
Robot Manipulators". ASME Journal of Mechanisms and Robot Arms". Mechanism
Mechanical Design, Vol. 118, No. 4, pp. 520- and Machine Theory, Vol. 17, No. 2, pp. 119-
525, 1 996. 132, 1 982.

8. Lipkin, H., y Duffy, J., ``The Elliptic Polarity 14. Waldron, K.J, Wang, S.L., y Bolin, S.J., ``A
of Screws". ASME Journal of Mechanisms, Study of the Jacobian Matrix of Serial
Transmissions, and Automation in Design, Manipulators". ASME Journal of
Vol. 107, pp. 377-387, 1 985. Mechaninsms, Transmissions, and
Automation in Design, Vol. 107, No. 2, pp.
9. Parikian, T.F., ``Gradient-Based Kinematic 230-238, 1 985.
Control of Non-Redundant Serial Robots in
Special Configurations". En: Recent Advances 15. Wampler II, C.W., ``Winding Number
in Robot Kinematics, Lenarcic, J., y Parenti- Analysis of Invertible Workspaces for
Castelli, V., editores, Dordretch Kluwer Redundant Manipulators". The International
Academic Publishers, pp. 77-86, 1 996. Journal of Robotics Research, Vol. 7, No. 5,
pp. 22-31, 1 983.
10. Podhorodeski, R.P., Goldenberg, A.A., y
Fenton, R.G., ``A Null-Space Solution of the 16. Yoshikawa, T., ``Dynamic Manipulabi-lity of
Inverse Kinematics of Redundant Robot Manipulators". Journal of Robotic
Manipulators Based on a Decomposition of Systems, Vol. 2, No. 1, 113-124, 1 985.

S-ar putea să vă placă și