INTRODUCCION

un brazo robtico tambin llamado manipulador es un sistema formado principalmente por una serie de mecanismos que le permiten realizar movimientos, dichos movimientos estn en funcin de los grados de libertad de dicho sistema; as bien entre mas grados de libertad tenga mas movimientos puede realizar, tambin si tiene muchos grados su complejidad para anlisis y construccin es mayor. De los aspectos ms importantes que se deben conocer de un brazo robtico es su posicin y orientacin, para ello se hace uso de anlisis de cinemtica directa.

DESARROLLO
CINEMATICA Emplea el lgebra vectorial y matricial para representar y describir la localizacin de un objeto en el espacio tridimensional con respecto a un sistema de referencia fijo. Puesto que un robot se puede considerar como una cadena cinemtica formada por eslabones unidos entre s mediante articulaciones, se puede establecer un sistema de referencia fijo situado en la base de dicho robot y describir la localizacin de cada uno de los eslabones con respecto del sistema de referencia fijado. As, el problema cinemtico directo se reduce a encontrar una matriz homognea de transformacin T que relacione la posicin y orientacin del extremo del robot respecto del sistema de referencia fijo situado en la base del mismo. Esta matriz T ser en funcin de las coordenadas articulares.

Una articulacin es una conexin de dos cuerpos rgidos caracterizados por el movimiento de un slido sobre otro. En la figura 1 se observan las articulaciones y eslabones de un manipulador.

Figura 1.- articulaciones y eslabones.

Un enlace es un cuerpo rgido que une dos ejes articulares adyacentes del manipulador o tambin llamado brazo robtico, posee caractersticas como peso, material, inercia, etc. Una cadena cinemtica es un Conjunto de elementos rgidos unidos por articulaciones. En la figura 2 se observa una cadena cinematica.

Figura 2.- cadena cinematica.

La numeracin de enlaces y articulaciones de establece de la siguiente forma: Enlaces. Desde 0 hasta n, empezando en la base (elemento 0). Articulaciones. Desde 1 hasta n.

En la figura 3 se puede observar una forma de numeracin.

Figura 3.- forma de numeracin.

Los parmetros cinemticos se dividen en: Articulacin (k,dk): posicin/orientacin relativa adyacentes. Elemento (k,ak): estructura mecnica del elemento. de los elementos

Los parmetros de elemento son: ak: longitud del elemento. k: torsin del elemento.

En la figura 4 se muestran estos parmetros.

Figura 4.- parmetros de elemento.

Los parmetros de enlace son: Eje articular: es la lnea en el espacio alrededor de la cual el enlace i rota referido al enlace i-1. Longitud del enlace (ai-1): es la distancia entre los ejes articulares i e i-1. Nmero de lneas que definen la longitud: Ejes paralelos: Ejes no paralelos: 1 Signo: positivo Angulo del enlace (ai-1): es el ngulo medido entre los ejes articulares i e i-1. Proyeccin sobre plano. Signo: Regla de la mano derecha

Los parmetros de articulacin son:

Figura 5.- parmetros.

k: ngulo de articulacin dk: distancia de articulacin

Las variables articulares son las siguientes: desplazamiento del enlace (di): Distancia medida a lo largo del eje de la articulacin i desde el punto donde ai-1 intersecta el eje hasta el punto donde ai intersecta el eje. di es variable si la articulacin es prismtica di posee signo

ngulo de la articulacin (i): ngulo entre las perpendiculares comunes ai-1 y ai medido sobre el eje del enlace i. i es variable si la articulacin es de rotacin i posee signo definido por la regla de la mano derecha

La resolucin del problema cinemtico directo consiste en encontrar las relaciones que permiten conocer la localizacin espacial del extremo del robot a partir de los valores de sus coordenadas articulares. til en transformaciones matriciales que incluyan: Rotacin, traslacin, escalado y transformacin de perspectiva. Vectores expresados en coordenadas homogneas: p = (wpx, wpy, wpz, w) T. En robtica w = 1. En la figura 6 se observa la matriz de transformacin homognea.

Figura 6.- matriz de transformacin homognea.

As, si se han escogido coordenadas cartesianas y ngulos de Euler para representar la posicin y orientacin del extremo de un robot de seis grados de libertad, la solucin al problema cinemtico directo vendr dada por las relaciones: x = Fx (q1, q2, q3, q4, q5, q6) y = Fy (q1, q2, q3, q4, q5, q6) z = Fz (q1, q2, q3, q4, q5, q6)

 = F (q1, q2, q3, q4, q5, q6) = F (q1, q2, q3, q4, q5, q6) = F (q1, q2, q3, q4, q5, q6) La obtencin de estas relaciones no es en general complicada, siendo incluso en ciertos casos (robots de pocos grados de libertad) fcil de encontrar mediante simples consideraciones geomtricas. Por ejemplo, para el caso de un robot con 2 grados de libertad es fcil comprobar que: x = I1 cosq1 + I2 cos (q1 + q2) y = I1 cosq1 + I2 cos (q1 + q2) Para robots de ms grados de libertad puede plantearse un mtodo sistemtico basado en la utilizacin de las matrices de transformacin homognea. En general, un robot de n grados de libertad est formado por n enlaces unidos por n articulaciones, de forma que cada par articulacin-enlace constituye un grado de libertad. A cada enlace se le puede asociar un sistema de referencia solidario a l y, utilizando las transformaciones homogneas, es posible representar las rotaciones y traslaciones relativas entre los distintos enlaces que componen el robot. Normalmente, la matriz de transformacin homognea que representa la posicin y orientacin relativa entre los sistemas asociados a dos enlaces consecutivos del robot se le suele denominar (i-1) Ai. As pues, 0Ai describe la posicin y orientacin del sistema de referencia al primer enlace con respecto al sistema de referencia a la base, 1A2 describe la posicin y orientacin del segundo enlace respecto del primero, etc. Del mismo modo, denominando 0Ak a las matrices resultantes del producto de las matrices (i-1) Ai con i desde 1 hasta k, se puede representar de forma total o parcial la cadena cinemtica que forma el robot. La posicin y orientacin del sistema con el segundo enlace del robot con respecto al sistema de coordenadas de la base se puede expresar mediante la matriz 0A2: 0A2 = 0A1 (1A2) De manera anloga, la matriz 0A3 representa la localizacin del sistema de referencia del tercer enlace:

0A3 = 0A1 (1A2) (2A3) Cuando se consideran todos los grados de libertad, a la matriz 0An se le suele denominar T. As, dado un robot de seis grados de libertad, se tiene que la posicin y orientacin del enlace final vendr dada por la matriz T: T = 0A6 = 0A1 (1A2) (2A3) (3A4) (4A5) (5A6) Denavit-Hartenberg propusieron en 1955 un mtodo matricial que permite establecer de manera sistemtica un sistema de coordenadas (Si) ligado a cada enlace i de una cadena articulada, determinando las ecuaciones cinemticas de la cadena completa. Segn la representacin D-H, escogiendo adecuadamente los sistemas de coordenadas asociados para cada enlace, ser posible pasar de uno al siguiente mediante 4 transformaciones bsicas que dependen exclusivamente de las caractersticas geomtricas del enlace. Estas transformaciones bsicas consisten en una sucesin de rotaciones y traslaciones que permitan relacionar el sistema de referencia del elemento i con el sistema del elemento i-1. Las transformaciones en cuestin son las siguientes: Rotacin alrededor del eje Zi-1, con un ngulo i. Traslacin a lo largo de Zi-1 a una distancia di; vector di (0,0,di). Traslacin a lo largo de Xi a una distancia ai; vector ai (ai,0,0). Rotacin alrededor del eje Xi, con un ngulo i. De este modo se tiene que: i-1Ai = T (z,i) T (0,0,di) T (ai-1,0,0) T (x,i-1)

En la figura 7 se realiza el producto de matrices:

Figura 7.- producto de matrices.

Donde i, ai, di, i, son los parmetros D-H del enlace i, asociados con el enlace i y la articulacin i.

Los cuatro parmetros i, ai, di, i de la figura 7 son torsin del enlace, longitud del enlace, distancia de articulacin y ngulo de articulacin, respectivamente. Estos nombres se derivan de aspectos especficos de la relacin geomtrica entre dos marcos de coordenadas. Dado que la matriz Ai es una funcin de una sola variable, resulta que tres de los cuatro parmetros son constantes para un enlace dado, mientras que el cuarto parmetro, i es variable para una articulacin de revolucin y di e variable para una articulacin prismtica. De este modo, basta con identificar los parmetros i, ai, di, i, para obtener matrices A y relacionar as todos y cada uno de los enlaces del robot. Como se ha indicado, para que la matriz i-1Ai, relacione los sistemas (Si) y (Si-1), es necesario que los sistemas se hayan escogido de acuerdo a unas determinadas normas. Estas, junto con la definicin de los 4 parmetros de Denavit-Hartenberg, conforman el siguiente algoritmo para la resolucin del problema cinemtico directo. ASIGNACION DE SISTEMAS DE REFERENCIA Definir SR asociado a cada enlace, realizar la transformacin entre dos consecutivos con solo 2 giros y 2 traslaciones. Existen 2 formas de asignacin SR: Paul: SRi en el eje que le enlaza con el siguiente eslabn (al final del eslabn) Craig: SRi en el eje que le enlaza con el eslabn precedente (al inicio del eslabn) Las matrices de transformacin intermedias varan, pero el resultado final es el mismo. ENLACES PRIMERO Y LTIMO Sistema de referencia {0}. Sistema que se adjunta a la base del robot. No se mueve. Sistema de referencia {1}. Coincide con la base.

En la figura 8 se aprecia el sistema.

Figura 8.- sistema de referencia.

ENLACES INTERMEDIOS Origen del sistema de referencia {i}. Se ubica en el punto creado por la perpendicular de ai y el eje articular i. Eje Z. El eje Zi del sistema de referencia {i} se har coincidir con el eje articular i. Eje X. El eje Xi se hace coincidir con la distancia ai desde la articulacin i hacia i+1. Eje Y. El eje Yi se define a partir del eje Xi, tomando como referencia la regla de la mano derecha. Identificar los ejes articulares. De los pasos 2 a 5 utilice dos ejes consecutivos i e i-1. Identifique la perpendicular comn. Identifique la lnea que se interseca, perpendicularmente, al eje articular i. Defina el sistema de referencia sobre el punto de interseccin. Asigne el eje Zi al eje articular i. Asigne el eje Xi a la perpendicular comn que defini el origen del sistema de referencia i.

Termine de asignar el sistema de referencia, definiendo el eje Yi segn la ley de la mano derecha. Haga coincidir los SR {0} y {1} cuando la primera variable articular sea cero.

ALGORITMO DE PARMETROS

DENAVIT-HARTENBERG

SIGNIFICADO

DE

LOS

Los parmetros de DH tienen el siguiente significado: El parmetro ai es la distancia entre Zi y Zi-1 medida a lo largo de Xi. El parmetro i es el ngulo entre Zi y Zi-1 referido a Xi. El parmetro di es la distancia entre Xi-1 y Xi medida a lo largo de Zi. El parmetro i es el ngulo entre Xi-1 y Xi referido a Zi.

*Nota: ai es la nica magnitud positiva, las dems tienen signo.

ALGORITMO DE DENAVIT-HARTENBERG DH1. Numerar los eslabones comenzando con 1 (primer eslabn mvil de la cadena) y acabando con n (ltimo eslabn mvil). Se numerara como eslabn 0 a la base fija del robot. DH2. Numerar cada articulacin comenzando por 1 (la correspondiente al primer grado de libertad y acabando en n). DH3. Localizar el eje de cada articulacin. Si es rotativa, el eje ser su propio eje de giro. Si es prismtica, ser el eje a lo largo del cual se produce el desplazamiento. DH4. Para i de 0 a n-1, situar el eje Zi, sobre el eje de la articulacin i+1. DH5. Situar el origen del sistema de la base (S0) en cualquier punto del eje Z0. Los ejes X0 e Y0 se situarn de modo que formen un sistema dextrgiro con Z0. DH6. Para i de 1 a n-1, situar el sistema (Si) (solidario al eslabn i) en la interseccin del eje Zi con la lnea normal comn a Zi -1 y Zi. Si ambos ejes se cortasen se situara (Si) en el punto de corte. Si fuesen paralelos (Si) se situara en la articulacin i+1. DH7. Situar Xi en la lnea normal comn a Zi-1 y Zi. DH8. Situar Yi de modo que forme un sistema dextrgiro con Xi y Zi.

DH9. Situar el sistema (Sn) en el extremo del robot de modo que Zn coincida con la direccin de Zn-1 y Xn sea normal a Zn-1 y Zn. DH10. Obtener i como el ngulo que hay que girar en torno a Zi -1 para que Xi-1 y Xi queden paralelos. DH11. Obtener di como la distancia, medida a lo largo de Zi-1, que habra que desplazar (Si-1) para que Xi y Xi-1 quedasen alineados. DH12. Obtener ai como la distancia medida a lo largo de Xi (que ahora coincidira con Xi-1) que habra que desplazar el nuevo (Si-1) para que su origen coincidiese con (Si). DH13. Obtener i como el ngulo que habra que girar entorno a Xi (que ahora coincidira con Xi-1), para que el nuevo (Si-1) coincidiese totalmente con (Si). DH14. Obtener las matrices de transformacin i-1Ai. DH15. Obtener la matriz de transformacin que relaciona el sistema de la base con el del extremo del robot T = 0A1, 1A2, ..., n-1An. DH16. La matriz T define la orientacin (submatriz de rotacin) y posicin (submatriz de traslacin) del extremo referido a la base en funcin de la n coordenada articulares.

Los cuatro parmetros de DH (i, di, ai, i) dependen nicamente de las caractersticas geomtricas de cada enlace y de las articulaciones que le unen con el anterior y siguiente. i es el ngulo que forman los ejes Xi-1 y Xi medido en un plano perpendicular al eje Zi-1, utilizando la regla de la mano derecha. Se trata de un parmetro variable en articulaciones giratorias. di es la distancia a lo largo del eje Zi-1 desde el origen del sistema de coordenadas (i-1) simo hasta la interseccin del eje Zi-1 con el eje Xi. Se trata de un parmetro variable en articulaciones prismticas.

Una vez obtenidos los parmetros DH, el clculo de las relaciones entre los enlaces consecutivos del robot es inmediato, ya que vienen dadas por las matrices A, que se calcula segn la expresin general. Las relaciones entre enlaces no consecutivos vienen dadas por las matrices T que se obtienen como producto de un conjunto de matrices A. Obtenida la matriz T, esta expresar la orientacin (submatriz (3x3) de rotacin) y posicin (submatriz (3x1) de traslacin) del extremo del robot en funcin de sus coordenadas articulares, con lo que quedara resuelto el problema cinemtico directo.