Introduccin.

La cinemtica del robot estudia el movimiento del mismo con respecto a un sistema de referencia. As, la cinemtica se interesa por la descripcin analtica del movimiento espacial del robot como una funcin del tiempo, y en particular por las relaciones entre la posicin y la orientacin del extremo final del robot con los valores que toman sus coordenadas articulares. Existen dos problemas fundamentales para resolver la cinemtica del robot, el primero de ellos se conoce como el problema cinematico directo, y consiste en determinar cual es la posicin y orientacin del extremo final del robot, con respecto a un sistema de coordenadas que se toma como referencia, conocidos los valores de las articulaciones y los parmetros geomtricos de los elementos del robot, el segundo denominado problema cinematico inverso resuelve la configuracin que debe adoptar el robot para una posicin y orientacin del extremo conocidas.

Denavit y Hartenberg propusieron un mtodo sistemtico para descubrir y representar la geometra espacial de los elementos de una cadena cinemtica, y en particular de un robot, con respecto a un sistema de referencia fijo. Este mtodo utiliza una matriz de transformacin homognea para descubrir la relacin espacial entre dos elementos rgidos adyacentes, reducindose el problema cinematico directo a encontrar una matriz de transformacin homognea 4 X 4 que relacione la localizacin espacial del robot con respecto al sistema de coordenadas de su base. Por otra parte, la cinemtica del robot trata tambin de encontrar las relaciones entre las velocidades del movimiento de las articulaciones y las del extremo. Esta relacin viene dada por el modelo diferencial expresado mediante la matriz Jacobiana.

Diagrama entre cinematica directa e inversa.

Cinemtica directa ->-> Valor de las coordenadas Articulares (q0, q1, ... qn) <-<- Cinemtica inversa posicin y orientacin del extremo del robot (x, y, z, , , )

El movimiento relativo en las articulaciones resulta en el movimiento de los elementos que posicionan la mano en una orientacin deseada. En la mayora de las aplicaciones de robtica, se esta interesado en la descripcin espacial del efector final del manipulador con respecto a un sistema de coordenadas de referencia fija. La cinemtica del brazo del robot trata con el estudio analtico de la geometra del movimiento de un robot con respecto a un sistema de coordenadas de referencia fijo como una funcin del tiempo sin considerar las fuerzas-momentos que originan dicho movimiento. As pues, trata con la descripcin analtica del desplazamiento espacial del robot como funcin del tiempo, en particular las relaciones entre variables espaciales de tipo de articulacin y la posicin y orientacin del efector final del robot.

Aumentando la destreza de robots repetitivos.

Se usan las coordenadas redundantes para definir tareas adicionales.

El mando de configuracin est surgiendo como una manera eficaz de controlar los movimientos de un robot que tiene ms grados de libertad y en el cual es necesario definir la trayectoria del efector del extremo y / o el objeto para ser manipulado. Pueden usarse los grados extras o redundantes de libertad para dar destreza de robot y versatilidad. En mando de configuracin, la configuracin del robot se representa matemticamente por un juego de variables de configuracin que son un vector de coordenadas generalizado y que es ms pertinente a la tarea global que es el vector de coordenadas de la juntura que aparecen en los acercamientos convencionales a controlar. El vector de la coordenada generalizado consiste en las coordenadas del efector del extremo en el espacio de la tarea, ms varias funciones de cinemtica que involucran grados redundantes de libertad. La tarea bsica del sistema de mando es hacer las coordenadas del efector del extremo seguir la trayectoria deseada. Las funciones de la cinemtica pueden seleccionarse para definir una tarea adicional por ejemplo, la anulacin de obstculos u optimizacin de la cinemtica para reforzar la manipulabilidad. En efecto, la tarea adicional define la trayectoria en los grados redundantes de libertad. Las variables de configuracin pueden usarse en un esquema de mando adaptable que no exige manipular el conocimiento del modelo matemtico complicado de la dinmica del robot o los parmetros del objeto.

B. Cinemtica Directa.

El problema cinematico directo.

Se utiliza fundamentalmente el lgebra vectorial y matricial para representar y describir la localizacin de un objeto en el espacio tridimensional con respecto aun sistema de referencia fijo. Dado que un robot puede considerar como una cadena cinemtica formada por objetos rgidos o eslabones unidos entre s mediante articulaciones, se puede establecer un sistema de referencia fijo situado en la base del robot y describir la localizacin de cada uno de los eslabones con respecto a dicho sistema de referencia. De esta forma, el problema cinematico 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 funcin de las coordenadas articulares.

El mando adaptable de un manipulador remoto.

Un sistema de mando de robot causa a un manipulador remoto, seguir una trayectoria de referencia estrechamente en un marco de referencia Cartesiano en el espacio de trabajo, sin el recurso a un modelo matemtico intensivo de dinmica del robot y sin el conocimiento del robot y parmetros de carga. El sistema, derivado de la teora lineal multivariable, utiliza a los manipuladores delanteros relativamente simples y controladores de retroalimentacion con modelo y adaptable de referencia del mando. El sistema requiere dimensiones de posicin y velocidad del extremo manipulador del efector. stos pueden obtenerse directamente de los sensores pticos o por clculo que utiliza las relaciones de la cinemtica conocidas entre el manipulador modelado y el extremo de la juntura de la posicin del efector. Derivando las ecuaciones de control, las ecuaciones diferenciales no lineales acopladas a la dinmica del robot, expresan primero la forma general de la cinematica, entonces la linealizacion por clculo de perturbaciones sobre una especifica operacion del punto en las coordenadas Cartesianas del extremo del efector. El modelo matemtico resultante es un sistema multivariable lineal de orden de 2n (donde n = es el nmero de coordenadas espaciales independientes del manipulador) esto expresa la relacin entre los incrementos del actuador de n voltajes de control (las entradas) y los incrementos de las coordenadas de n, la trayectoria de extremo del efector (los rendimientos). La trayectoria del efector incrementa la referencia, la trayectoria se incrementa: esto requiere la retroalimentacion independiente y controladores de manipulacin. Para este propsito, le basta aplicar posicin y retroalimentacion de velocidad a travs de la matrtiz de n x n posicin y velocidad, la matriz de ganancia de retroalimentacion.

a. Resolucin del problema cinematico directo mediante matrices de transformacin homognea.

La resolucin del problema cinematico 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.

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 cinematico directo vendr dada por las relaciones: x= y= z= = = = Fx Fy Fz F F F ( q1,q2,q3,q4,q5,q6 ) ( q1,q2,q3,q4,q5,q6 ) ( q1,q2,q3,q4,q5,q6 ) ( q1,q2,q3,q4,q5,q6 ) ( q1,q2,q3,q4,q5,q6 ) ( 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 mas 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 esta formado por n eslabones unidos por n articulaciones, de forma que cada par articulacin-eslabn constituye un grado de libertad. A cada eslabn se le puede asociar un sistema de referencia solidario a el y, utilizando las transformaciones homogneas, es posible representar las rotaciones y traslaciones relativas entre los distintos eslabones que componen el robot.

Normalmente, la matriz de transformacin homognea que representa la posicin y orientacin relativa entre los sistemas asociados a dos eslabones consecutivos del robot se le suele denominar ( i-1)1/Ai. As pues, 0Ai describe la posicin y orientacin del sistema de referencia solidario al primer eslabn con respecto al sistema de referencia solidario a la base, 1A2 describe la posicin y orientacin del segundo eslabn 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. As, por ejemplo, la posicin y orientacin del sistema solidario con el segundo eslabn 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 del tercer eslabn: 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 eslabn final vendr dada por la matriz T: T = 0A6 = 0A1 ( 1A2 )( 2A3 )( 3A4 )( 4A5 )( 5A6 ) Aunque para descubrir la relacin que existe entre dos elementos contiguos se puede hacer uso de cualquier sistema de referencia ligado a cada elemento, la forma habitual que se suele utilizar en robtica es la representacin de Denavit-Hartenberg. Denavit-Hartenberg propusieron en 1955 un mtodo matricial que permite establecer de manera sistemtica un sistema de coordenadas (Si) ligado a cada eslabn i de una cadena articulada, pudindose determinar a continuacin las ecuaciones cinemticas de la cadena completa. Segn la representacin D-H, escogiendo adecuadamente los sistemas de coordenadas asociados para cada eslabn, ser posible pasar de uno al siguiente mediante 4 transformaciones bsicas que dependen exclusivamente de las caractersticas

geomtricas del eslabn. 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: 1. 2. 3. 4. Rotacin alrededor del eje Zi-1 un ngulo . Traslacin a lo largo de Zi-1 una distancia di; vector di ( 0,0,di ). Traslacin a lo largo de Xi una distancia ai; vector ai ( 0,0,ai ). Rotacin alrededor del eje Xi, un ngulo i.

Dado que el producto de matrices no es conmutativo, las transformaciones se han de realizar en el orden indicado. De este modo se tiene que: i-1A i = T( z,i ) T( 0,0,di ) T ( ai,0,0 ) T( x,i ) Y realizando el producto de matrices:

donde i, ai, di, i, son los parmetros D-H del eslabn i. 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 eslabones 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 cinematico directo.

b. Algoritmo de Denavit- Hartenberg para la obtencin del modelo.

DH1.Numerar los eslabones comenzando con 1 (primer eslabn mvil dela cadena) y acabando con n (ultimo 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 esta 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 situaran d 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 ai 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 = 0Ai, 1A2... n-1An. DH16.La matriz T define la orientacin (submatriz de rotacin) y posicin (submatriz de traslacin) del extremo referido ala base en funcin de las n coordenadas articulares.

Parametros DH para un eslabon giratorio.

Los cuatro parmetros de DH (i, di, ai, i) dependen nicamente de las caractersticas geomtricas de cada eslabn 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 (i1)- esimo hasta la interseccin del eje Zi-1 con el eje Xi. Se trata de un parmetro variable en articulaciones prismticas. ai Es a la distancia a lo largo del eje Xi que va desde la interseccin del eje Zi-1 con el eje Xi hasta el origen del sistema i-esimo, en el caso de articulaciones giratorias. En el caso de articulaciones prismticas, se calcula como la distancia mas corta entre los ejes Zi-1 y Zi. i Es el ngulo de separacin del eje Zi-1 y el eje Zi, medido en un plano perpendicular al eje Xi, utilizando la regla de la mano derecha. Una vez obtenidos los parmetros DH, el calculo de las relaciones entre los eslabones consecutivos del robot es inmediato, ya que vienen dadas por las matrices A, que se calcula segn la expresin general. Las relaciones entre eslabones no consecutivos vienen dadas por las matrices T que se obtienen como producto de un conjunto de matrices A. Obtenida la matriz T, esta expresara 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 cinematico directo.

Parmetros DH para el robot. Articulacin 1 2 3 4 q1 90 0 q4 d I1 d2 D3 I4 a 0 0 0 0 0 90 0 0

Una vez calculados los parmetros de cada eslabn, se calculan las matrices A: 0A1 C1 -S1 0 0 S1 C1 0 0 0 0 1 I1 0001 1A2 0010 1000 0 1 0 D2 0001 2A3 1000 0100 0 0 1 D3 0001 3A4 C4 -S4 0 0 S4 C4 0 0 0 0 1 I4 0001

As pues, se puede calcular la matriz T que indica la localizacin del sistema final con respecto al sistema de referencia de la base del robot. T = 0A1 (1A2)(2A3)(3A4) = -S1C4 S1S4 C1 C1(D3+I4) C1C4 -C1S4 S1 S1(D3+I4) S4 C4 0 (D2+I1) 0 0 0 1

C. Resolucin del problema cinematico directo mediante uso de cuaternios.

Puesto que las matrices de transformacin homognea y los cuaternios son los mtodos alternativos para representar transformaciones de rotacin y desplazamiento, ser posible utilizar estos ltimos de manera equivalente a las matrices para la resolucin del problema cinematico directo de un robot. Para aclarar el uso de los cuaternios con ese fin, se van a utilizar a continuacin para resolver el problema cinematico directo de un robot tipo SCARA cuya estructura se representa en la figura. El procedimiento a seguir ser el de obtener la expresin que permite conocer las coordenadas de posicin y orientacin del sistema de referencia asociado al extremo del

robot (S4) con respecto al sistema de referencia asociado a la base (S0). Esta relacin ser funcin de las magnitudes I1, I2, y I3, de los elementos del robot as como de las coordenadas articulares q1, q2, q3 y q4. Para obtener la relacin entre (S0) y (S4) se ira convirtiendo sucesivamente (S0) en (S1), (S2), (S3) y (S4) segn la siguiente serie de transformaciones: 1. Desplazamiento de (S0) una distancia I1 a lo largo del eje Z0 y giro un ngulo q1 alrededor del eje Z0, llegndose a (S1). 2. Desplazamiento de (S1) una distancia I2 a lo largo del eje X1 y giro un ngulo q2 alrededor del nuevo eje Z, para llegar al sistema (S2). 3. Desplazamiento alo largo del eje X2 una distancia I3 para llegar al sistema (S3). 4. Desplazamiento de (S3) una distancia q3 a lo largo del eje Z3 y un giro en torno a Z4 de un ngulo q4, llegndose finalmente a (S4). De manera abreviada las sucesivas transformaciones quedan representadas por: S0 ---> S1: T( z,I1 ) Rot( z,q1 ) S1 ---> S2: T( x,I2 ) Rot( z,q2 ) S2 ---> S3: T( x,I3 ) Rot ( z,0 ) S3 ---> S4: T( z,-q3 ) Rot( z,q4 )

Donde los desplazamientos quedan definidos por los vectores: p1 = ( 0,0,1 ) p2 = ( I2,0,0 ) p3 = ( I3,0,0 ) p4 = ( 0,0,-q3 )

Y los giros de los cuaternios: Q1 = ( ^C1, 0, 0, ^S1 ) Q2 = ( ^C2, 0, 0, ^S2 ) Q3 = ( 1, 0, 0, 0 ) Q4 = ( ^C4, 0, 0, ^S4 ) Donde: ^C1 = cos ( q1/2 ) ^S1 = sen ( q1/2 ) Lo que indica que el extremo del robot referido al sistema de su base (S0), esta posicionado en: x = a0x = I3 cos( q1 + q2 ) + I2 cosq1 y = a0y = I3 sen( q1 + q2 ) + I2 senq1 z = a0z = I1 -q3 Y esta girando respecto al sistema de la base con un ngulo q1 + q2 +q4 segn a la rotacin entorno al eje z: Rot( z, q1+q2+q4 ) Las expresiones anteriores permiten conocer la localizacin del extremo del robot referidas al sistema de la base en funcin de las coordenadas articulares (q1, q2, q3, q4), correspondiendo por tanto a la solucin del problema cinematico directo.