Professional Documents
Culture Documents
Resumen: este trabajo informa sobre una nueva topología de un robot manipulador capaz de
realizar posiciones arbitrarias de su plataforma móvil según lo observado. Desde la plataforma
fija. Además, para aliviar las orientaciones parásitas, se implementa una libertad de giro a la
plataforma móvil, produciendo un novedoso manipulador paralelo de cuatro grados de libertad.
Las ventajas de este robot se pueden encontrar en su cinemática más simple. De hecho, la
arquitectura propuesta es tan simple que las soluciones de forma semicerrada para resolver el
análisis de desplazamiento se obtienen fácilmente gracias a los movimientos desacoplados del
robot. Por otro lado, las ecuaciones de entrada-salida de velocidad y aceleración se obtienen
sistemáticamente recurriendo a la teoría de los tornillos. En ese sentido, el análisis de
aceleración no requiere el cálculo de las aceleraciones pasivas de velocidad conjunta del robot.
Se proporciona un ejemplo numérico, cuyos resultados se verifican por medio de otro enfoque
como ADAMS ™ para mostrar la aplicación del método. Para el mejor conocimiento de los
autores, la combinación de una inversión de un mecanismo de torsión cero con la arquitectura
de la cadena cinemática central aquí propuesta no se ha considerado en trabajos anteriores, lo
que mejora la originalidad de la contribución.
I. INTRODUCCIÓN
El resto del artículo está organizado como sigue: en la sección II se describe la topología del
manipulador paralelo propuesto, mientras que el análisis directo de posición del robot se
presenta en la sección III. Para la solución de dicho problema se formulan ecuaciones que toman
en cuenta el arreglo tangencial de los pares de revolución montados en la plataforma móvil y en
la rotación desacoplada provista por la cadena central al efector final. Por otro lado, los análisis
de velocidad y aceleración, presentados en las secciones IV y V respectivamente, son resueltos
mediante el uso de la teoría de tornillos y la aplicación del concepto de tornillo recíproco a través
de la forma de Klein, lo que simplifica considerablemente dichos análisis. Más aún, con la
finalidad de mostrar la aplicación del método de análisis cinemático, en la sección VI se presenta
un ejemplo. Finalmente, se discuten las conclusiones al final del trabajo.
Por otro lado, la plataforma móvil está conectada al efector final por medio de un par de
revoluta. El papel de las cadenas exteriores es controlar la posición del centro de la plataforma
móvil mientras que la cadena central es proporcionar un giro cuyo eje es normal a la plataforma
móvil del robot. Con esta combinación, un punto cualquiera del efector final es capaz de alcanzar
orientaciones arbitrarias respecto a la plataforma fija perteneciente al mecanismo 3-SPR
mientras que el mismo efector final es capaz de alcanzar orientaciones, desacopladas, normales
al plano de la plataforma móvil. Con el objetivo de describir la geometría del robot, sea XYZ el
marco de referencia fijo con origen en el punto O, localizado en el centro de la plataforma fija.
Sea además xyz un sistema de referencia cuyo origen es el punto C, localizado por el vector C, el
cual es el centro de la plataforma móvil.
Los centros de las juntas esféricas, puntos 𝐵𝑖 , localizados por los vectores 𝐵𝑖 , forman un
triángulo equilátero ∆𝐵1 𝐵2 𝐵3 sobre la plataforma fija 0. Por otro lado, las posiciones de los pares
de revoluta fijos a la base, puntos 𝐴𝑖 , están dadas por los vectores 𝐴𝑖 , forman un triángulo
equilátero ∆𝐴1 𝐴2 𝐴3 de lado d. A menos que se indique, en el resto de la contribución
consideraremos i=1,2,3. Las coordenadas generalizadas, asociadas a tres actuadores lineales y a
uno rotacional, son representadas como 𝑞𝑗 (j=1,2,3,4). La topología de la cadena cinemática
central es tal que sus pares cinemáticos intermedios, tres de revoluta (𝑃1 , 𝑃2 , 𝐵4 ) y una
prismática (𝑃3 ), se localizan en un plano donde el vector unitario 𝑣̅ es normal a dicho plano. Por
otro lado, el punto G, localizado por el vector G, denota el centro del efector final de forma tal
que ℎ3 es la distancia entre G y C. De manera similar, ℎ1 es la distancia entre los O y 𝐵4 donde
ℎ2 denota la distancia entre 𝑃3 y C.
Cabe señalar que con la inversión del manipulador paralelo 3-RPS se obtiene un mecanismo más
versátil. Por ejemplo, de la Fig. 2, note que mientras en una cadena de tipo SPR el punto A puede
alcanzar cualquier posición dentro de una esfera de radio q, en una cadena de tipo RPS el mismo
punto A está restringido a un plano circular de radio q. Por supuesto, en ambos casos no se
consideran interferencias mecánicas.
Las ventajas del robot propuesto se manifiestan cuando se le compara con su predecesor, el
manipulador paralelo 3- RPS. En un manipulador paralelo 3-RPS los grados de libertad de la
plataforma móvil son tales que el centro de ésta solo puede desplazarse en direcciones normales
al plano de la plataforma móvil y a su vez la orientación de la plataforma móvil está restringida
a su plano, en otras palabras, la plataforma móvil no puede girar a lo a largo del eje normal al
plano de la plataforma móvil. Las limitantes de un robot con estas características dificultan sus
aplicaciones y por lo tanto es necesario combinarlo con otros mecanismos, por ejemplo los
llamados manipuladores serie-paralelo. Por su parte, en el manipulador paralelo 3-SPR los
grados de libertad son tales que el centro de su plataforma móvil puede adoptar posiciones
arbitrarias, lo cual clarifica sus aplicaciones por ejemplo en apuntadores y operaciones pick-and-
place. Sin embargo esto no elimina las rotaciones parásitas. Esto se logra con la introducción de
la cadena cinemática central, incrementando la movilidad del mecanismo y con ello sus posibles
aplicaciones. Es interesante destacar que en el manipulador propuesto los actuadores se ubican
cerca de la plataforma fija preservando las propiedades de rigidez y precisión que caracterizan
a los manipuladores paralelos.
El análisis directo de posición suele ser una tarea difícil para la mayoría de los robots paralelos
debido a la presencia de los lazos cerrados que conforman sus cadenas cinemáticas. Este
problema consiste en calcular la pose, la orientación y posición, de la plataforma móvil respecto
a la fija, dadas las coordenadas generalizadas del robot. Para ello, es necesario resolver primero
el análisis de posición del manipulador 3- SPR.
Con la finalidad de formular las ecuaciones de clausura del robot, se considera que debido al
arreglo tangencial de los pares de revolución fijas en la plataforma móvil es posible escribir:
(𝐴3 − 𝐴2 ) ∗ (𝐴1 − 𝐵1 ) = (𝐴1 − 𝐴3 ) ∗ (𝐴2 − 𝐵2 )
(𝐴2 − 𝐴1 ) ∗ (𝐴3 − 𝐵3 ) = 0
1
Donde el punto (∙) denota el producto interno del álgebra vectorial. Además es posible escribir
tres ecuaciones de clausura como sigue:
Una vez que las coordenadas de los puntos 𝐴𝑖 han sido calculados, las coordenadas del punto C
son obtenidas como C= (𝐴1 + 𝐴2 + 𝐴3 )/3 ). Posteriormente, las coordenadas del punto 𝑃3 P3
son determinadas de acuerdo a la siguiente ecuación de clausura:
𝑃3 = 𝑐 + ℎ2 𝑢̅
donde el vector unitario 𝑢̅ esta dado por
1
𝑢̅ = (𝐴 − 𝐴1 ) ∗ (𝐴3 − 𝐴1 ) 5
‖(𝐴2 − 𝐴1 ) ∗ (𝐴3 − 𝐴1 )‖ 2
Con la finalidad de calcular las coordenadas del punto 𝑃2 considere que la topología de la cadena
central es tal que es posible escribir tres ecuaciones de clausura como sigue
(𝑃2 − 𝑃3 ) ∗ 𝑢̅ = 0,
(𝑃2 − 𝑃1 ) ∗ 𝑣̅ = 0,
Después de pocos cálculos, es posible obtener una ecuación cuadrática en una de las
coordenadas, incógnita, del punto 𝑃2 de las Ecs. (6). Finalmente, las coordenadas de cualquier
punto P perteneciente al efector final e pueden ser obtenidas mediante la bien conocida matriz
de transformación homogénea de coordenadas, 𝑒 𝑜 𝑇 ܂, como sigue:
P=𝑇 𝑜 𝑒
𝑝 8
Donde
𝑅𝑜 𝑒
𝑃3
𝑇𝑜 𝑒
𝑝=⟦ ⟧
0 1
Más aún, la matriz de rotación 𝑅 𝑜 𝑒
puede ser calculada acorde al método desarrollado por
Gallardo-Alvarado [34] como
1 1
𝑅𝑜 𝑒
=[ (𝑃3 − 𝑃2 ), 𝑢̅, (𝑃 − 𝑃2 ) ∗ 𝑢̅ ]
‖(𝑃3 − 𝑃2 )‖ ‖(𝑃3 − 𝑃2 )‖ 3
Por otro lado, p denota las coordenadas del punto P expresadas en el sistema de referencia xyz.
Sea 𝑉𝑐𝑜 𝑒 = (𝑤 𝑜 𝑒 , 𝑣𝑐 ) el estado de velocidad del efector final e respecto a la plataforma fija 0,
donde 𝑤 𝑜 𝑒 = 𝑃(𝑉𝑐𝑜 𝑒 ), llamada la parte primaria del estado de velocidad, es la velocidad
angular del cuerpo e como es observada desde la base fija, mientras que 𝑣𝑐 = ( 𝑉𝑐𝑜 𝑒 ), la parte
dual del estado de velocidad, es la velocidad del punto C como se observa desde la plataforma
fija. Para calcular 𝑉𝑐𝑜 𝑒 , como un paso intermedio, es necesario resolver primero el análisis de
velocidad del manipulador paralelo 3-SPR.
Donde 𝑤𝑘𝑖 𝑘+1 denota la razón de velocidad del eslabón k+1 con respecto al eslabón adyacente
k ambos pertenecientes a la i-ésima cadena del manipulador. Además, $𝑘𝑖 𝑘+1 representa al
tornillo infinitesimal asociado a su correspondiente razón de velocidad del par. Más aún, el
último término de la Ec. (9) representa un par cinemático ficticio, agregado con el propósito de
satisfacer un requisito algebraico, la naturaleza seis-dimensional del estado de velocidad 𝑉𝑐𝑜 𝑚,
tal que 𝑤𝑚 𝑖
= 0. Además note que el tornillo $1𝑖 2 es recíproco al resto de los tornillos
pertenecientes a la misma cadena exceptuando al $3𝑖 4. De aquí que aplicando la forma de
Klein, {*;*}, entre el tornillo $1𝑖 2 y ambos lados de la Ec. (9) tenemos que
{𝑉𝑐𝑜 𝑚
; $1𝑖 2 } = 𝑞𝑖̇ 10
De forma similar, debido a que $0𝑖 1 es recíproco a todos los tornillos de su respectiva cadena
cinemática, excepto a $5𝑖 𝑚 , se tiene que
{𝑉𝑐𝑜 𝑚
; $0𝑖 1 } = 0 11
Agrupando de forma matricial las Ecs. (10) y (11), las ecuaciones de entrada/salida de velocidad
del manipulador paralelo 3-SPR resulta en
𝐽𝑇 ∆𝑉𝑐𝑜 𝑚
= 𝑄 𝑇̇ 12
Donde 𝐽 = [ $11 2 $12 2 $13 2 $10 1 $02 1 $03 1 ] es la matriz jacobiana del robot,
∆ es un aperador de polaridad y 𝑄̇ = [𝑞1̇ 𝑞2̇ 𝑞3̇ 0 0 0]
𝑉𝑐𝑜 𝑚
= 𝑞4̇ $04 1
+ 𝑤14 12 $14 2 + 𝑤24 2 3
3 $4 + 𝑤34 3 4
4 $4 + 𝑤44 45 $44 5
+ 𝑤5𝑖 5𝑒 $5𝑖 𝑒 + 𝑤𝑒𝑒 𝑚$
𝑒 𝑚
13
De esta manera, tomando en cuenta que de la Ec. (12) 𝑉𝑐𝑜 𝑚
= (𝐽𝑇 ∆)−1 𝑄𝑇 , la ecuación de
velocidad del manipulador puede ser expresada
Donde 𝑆 = [$14 2 $24 3 $34 4 $44 5 $54 𝑒 $𝑒4 𝑚 ] es el jacobiano de la cadena cinemática
central mientras Ω[𝑤14 2 𝑤24 3 𝑤34 4 𝑤44 5 𝑤54 𝑒 𝑤𝑒 𝑚 ] es una matriz cuyos
elementos son las razones de velocidad articulares de la cadena central. Una vez que ષ es
conocida, 𝑣𝑐0 𝑒 es calculado como
4
𝑣𝑔 = 𝑣𝑐 + 𝑤 0 𝑒
∗ 𝑟𝐺/𝑐
16
donde 𝑟𝐺/𝐶 es un vector dirigido del punto C al G.
V. ANÁLISIS DE ACELERACIÓN
D(𝐴𝑜𝑐 𝑒 ) = 𝑎𝑐 − 𝑤 0 𝑒
∗ 𝑣𝑐 .
Con la finalidad de calcular 𝐴𝑜𝑐 𝑒 , como paso intermedio, es necesario resolver antes el análisis
de aceleración del mecanismo 3-SPR.
[𝑤0𝑖 1 $0𝑖 1
𝑤1𝑖 1 1 2
2 $𝑖 + 𝑤2𝑖 3 $2𝑖 3
+ 𝑞𝑖̇ $0𝑖 1
+ 𝑤4𝑖 5 $4𝑖 5
+ 𝑤5𝑖 5 𝑚
𝑚 $𝑖 ]+
[𝑤1𝑖 2 $1𝑖 2
𝑤2𝑖 3 $2𝑖 3
+ ⋯ . . +𝑤5𝑖 5 𝑚
𝑚 $𝑖 ]+
[𝑤2𝑖 3 $2𝑖 3
𝑞𝑖̇ $0𝑖 1
+ 𝑤4𝑖 5 $4𝑖 5
+ 𝑤5𝑖 5 𝑚
𝑚 $𝑖 ]+
[𝑞𝑖̇ $0𝑖 1
𝑤4𝑖 5 $4𝑖 5
+ 𝑤5𝑖 5 𝑚
𝑚 $𝑖 ] + [ 𝑤4𝑖 5 $4𝑖 5
𝑤5𝑖 5 𝑚
𝑚 $𝑖 ] = 𝐿𝑖 18
donde los corchetes, [* *], denotan el producto de Lie del álgebra de Lie se(3) del grupo euclideo
SE(3). Siguiendo un procedimiento similar al empleado en el análisis de velocidad, y recurriendo
a la teoría de tornillos recíprocos la ecuación de entrada/salida de aceleración resulta en
𝐽𝑇 ∆𝐴𝑚 𝑇 ̈ 𝑇
𝑐 =𝑄 +𝐻 19
Donde 𝑄̈ = [𝑞1̈ 𝑞2̈ 𝑞3̈ 0 0 0 ] mientras que
𝐻 = [{𝐿1 ; $11 2 } {𝐿2 ; $12 2 } {𝐿3 ; $13 2 } {𝐿1 ; $10 1 } {𝐿2 ; $02 1 } {𝐿3 ; $03 1 }]
Por otro, el estado de aceleración reducido 𝐴𝑜𝑐 𝑚 de la plataforma móvil m como es observada
desde la plataforma fija 0 puede ser expresada a través de la cadena cinemática central como
sigue:
𝐿4 = [𝑞4 $̇ 11 2
]
donde 𝐿4𝑠 es
Una vez obtenido 𝐴𝑜𝑐 𝑒 , mediante la Ec. (23), la aceleración angular del cuerpo e respecto del 0
es obtenida de la parte primaria del estado de aceleración, .
Mientras que la aceleración lineal del punto C puede ser obtenida de la parte dual de 𝐴𝑜𝑐 𝑒
como
Lo cual permite, finalmente, calcular la aceleración de G como
Con la finalidad de ejemplificar la aplicación del método de análisis seleccionado, en esta sección
se presenta un ejemplo numérico. Para ello, usando unidades del SI, los parámetros del robot
son elegidos de forma que r=100mm, ℎ1 , ℎ2 , ℎ3 = 60𝑚𝑚, d=242,487mm, 𝐵1 = (200,0,0), 𝐵2 =
(−100,0, −173.205), 𝐵3 = (−100,0,173.205) y 𝐵4 = (0, −60,0). Además considere que las
coordenadas generalizadas están dadas por las siguientes funciones periódicas
Note que de acuerdo a las Figs. 5 y 6, los resultados numéricos obtenidos usando la teoría de
tornillos coinciden razonablemente con aquellos generados con el software de simulación
dinámica ADAMS™.
VII. CONCLUSIONES
En este trabajo se introduce una nueva propuesta de manipulador paralelo cuya topología se
conforma por el arreglo de un manipulador paralelo 3-SPR y una cadena cinemática central
RRRPRP conectada a la plataforma móvil por medio de un par de revoluta pasivo. La arquitectura
propuesta es tal que el centro de la plataforma móvil puede adoptar posiciones arbitrarias
mientras que la función de la cadena central es la de proporcionar un grado de libertad rotatorio,
denominado “yaw”, al robot con lo cual se disminuyen las desventajas de los grados de libertad
rotatorios restringidos propios de los llamados manipuladores paralelos cero-torsión. Más aún,
los pares cinemáticos activos se ubican cerca de la plataforma fija lo cual permite preservar
ventajas de los manipuladores paralelos como lo son su rigidez y precisión.
A fin de sustentar la arquitectura propuesta, se incluye su análisis cinemático. El análisis directo
de posición se resuelve de manera simple y compacta aprovechando el arreglo tangencial de los
pares de revoluta montados sobre la plataforma móvil y de la rotación desacoplada provista por
la cadena central. Esta estrategia no requiere del cálculo de la matriz de rotación.
Posteriormente los análisis de velocidad y de aceleración se resuelven por medio de la teoría de
tornillos infinitesimales. En dichos análisis la forma de Klein jugó un papel central. Cabe
mencionar que el análisis directo de aceleración no requiere del cálculo de las aceleraciones
pasivas del robot. El análisis cinemático se complementa con la inclusión de un caso de estudio
el cual pone a prueba las fórmulas obtenidas para el análisis directo de posición y las ecuaciones
entrada-salida derivadas para los análisis de velocidad y de aceleración por medio de la teoría
de tornillos recíprocos. Más aún, los resultados numéricos de velocidad y de aceleración se
validan por medio de un método alternativo como lo es el uso del paquete ADAMS™. En ese
sentido los resultados generados por ambos métodos concuerdan satisfactoriamente en todos
los casos considerados. Finalmente, con el propósito de revalorizar el potencial de la teoría de
tornillos, la contribución cierra con el siguiente comentario de Minguzzi [35]:
“Desafortunadamente, la teoría de tornillos se explica siguiendo definiciones descriptivas en
lugar de axiomas. Como resultado, las contribuciones disponibles son algo insatisfactorias tanto
en la física como en las matemáticas modernas. Quizás por esta razón, algunos autores, entre
los pocos que son conscientes de la existencia de la teoría de tornillos, consideran que es
demasiado complicada para merecer ser enseñada”.