Cinemática del Brazo articulado PUMA

Transcripción

1 Cnemátca del Brazo artculado PUMA José Cortés Parejo. Enero 8. Estructura del brazo robótco El robot PUMA de la sere es un brazo artculado con artculacones rotatoras que le proporconan grados de lbertad y le permten posconar y orentar su herramenta fnal. De manera más específca, las prmeras artculacones (sstema Hombro-Codo-Muñeca) posconan en el espaco el grupo formado por las últmas, que son las que orentan el efector. La estructura de artculacones-elementos, queda esbozada en las sguentes fguras, en las que se muestra una magen smétrca del robot y en la de la derecha las dmensones no están a escala para facltar su comprensón: La cnemátca del brazo artculado la formularemos sguendo la representacón de Denavt-Hartenberg, cuya descrpcón comprende apartados: asgnacón de Sstemas de Referenca y relacón de parámetros asocados a elementos y artculacones.. Representacón Denavt-Hartenberg La cnemátca de una cadena artculada se basa en asocar a cada par artculacón brazo un Sstema de Referenca Local con orgen en un punto, Y, Z, comenzando con un prmer y ejes ortonormales { } sstema de referenca fjo e nmóvl representado por los ejes {,, } la Base sobre la que está montada toda la estructura de la cadena. Y Z, anclado a un punto fjo de Este Sstema de Referenca no tene por qué ser el Unversal con orgen en (,,) y ejes {, Y, Z } asocados a la Base canónca. U U U

2 Las artculacones se numeran desde hasta n ( n = en nuestro caso). A la artculacón -ésma se le asoca su propo eje de rotacón como Eje Z, de forma que el eje de gro de la ª artculacón es Z y el de la ª artculacón, Z. Para la artculacón -ésma (que es la que gra alrededor de Z ), la eleccón del orgen de coordenadas y del Eje sgue reglas muy precsas en funcón de la geometría de los brazos artculados. el Eje Y por su parte, se escoge para que el, Y, Z sea dextrógro. sstema { } La especfcacón de cada Eje depende de la relacón espacal entre Z y Z, dstnguéndose casos: - Z y Z no son paralelos Entonces exste una únca recta perpendcular a ambos, cuya nterseccón con los ejes proporcona su mínma dstanca (que puede ser nula). Esta dstanca, representada por a y medda desde el eje Z haca el eje Z (con su sgno), es uno de los parámetros asocados a la artculacón -ésma. Por otra parte, la dstanca d desde a la nterseccón de la perpendcular común entre Z y Z con Z es el º de los parámetros asocados a la artculacón -ésma. En este caso, el Eje El orgen de coordenadas - Z y Z son paralelos es esta recta, sendo el sentdo postvo el que va desde el Eje es la nterseccón de dcha recta con el Eje Z. Z al Z s a >. En esta stuacón el Eje se toma en el plano contenendo a Z y Z y perpendcular a.ambos. El orgen es cualquer punto convenente del eje Z. El parámetro a es, como antes, la dstanca perpendcular entre los ejes Z y Z, y d es la dstanca desde.

3 A la artculacón -ésma se le asoca un er parámetro fjo α que es el ángulo que forman los ejes Z y Z en relacón al eje. Nótese que cuando el brazo -ésmo (que une rígdamente las artculacones e + ) gra en torno al eje Z (que es el de rotacón de la artculacón ), los parámetros a, d y α permanecen constantes, pues dependen exclusvamente de las poscones/orentacones relatvas entre los ejes Z y Z, que son nvarables. Por tanto, a, d y α pueden calcularse a partr de cualquer confguracón de la estructura artculada, en partcular a partr de una confguracón ncal estándar o de reposo. Precsamente el ángulo θ de gro que forman los ejes y con respecto al eje Z es el º parámetro asocado a la artculacón y el únco de ellos que varía cuando el brazo gra. Es mportante observar que el conjunto de los parámetros a, d, α y θ determna totalmente el Sstema de Referenca de la artculacón + en funcón del S.R de la artculacón.. Sstemas de Referenca en el PUMA En la sguente Fgura aparecen representadas las artculacones del robot junto con sus brazos asocados, que han sdo rotados lgeramente para vsualzar mejor los ejes de cada Sstema de Referenca. Veamos cómo se realza la asgnacón de ejes: - La ª artculacón, dbujada en Rojo junto con el brazo que accona al rotar, tene asocado el S.R. de la Base {, Y, Z } junto con su orgen, todos ellos anclados y fjos a la Base. Los ejes Z y Z son coplanaros e ntersectan en el punto. Por tanto, el eje tene la dreccón de Z Z. Por conveno se le ha puesto de sentdo contraro, para que se alnee de forma paralela con el Brazo (en Azul) cuando éste está horzontal. El orgen del S.R. es la nterseccón de la recta perpendcular común a Z y Z que da su mínma dstanca (que es nula) con el eje Z. Por tanto, concde con. Los parámetros constantes de la ª artculacón son: a = d = α = 9º. El ángulo α (gro de Z sobre Z alrededor de ) es negatvo al haber elegdo con sentdo opuesto al de Z Z. Fnalmente, θ es el ángulo de gro entre y.

4 - La ª artculacón, dbujada en Azul con el brazo que accona al rotar, tene asocado el recén defndo Sstema de Referenca {, Y, Z }, alrededor de cuyo eje Z rota. Ahora los ejes Z y Z son paralelos, por lo que el eje es perpendcular a ambos y coplanaro con Z y Z. El orgen se elge en estos casos como cualquer punto sobre el eje Z, habéndolo stuado en el extremo del º brazo. Como ya se desrbó en general, a es la dstanca perpendcular entre Z y Z mentras que d es la dstanca, medda sobre el eje Z, desde hasta la perpendcular común que contene al eje. En el caso del Robot PUMA estas magntudes son: a =.8 mm d = 9.9 mm y por otra parte, el parámetro α = º (ángulo entre Z y Z ). - La ª artculacón, dbujada en Verde, tene asocado el S.R. {, Y, Z }, θ defnmos prevamente el º S.R. { } Para determnar sus parámetros a, d, α, y y gra alrededor de Z., Y, Z,. Los ejes Z y Z se cruzan en el espaco (no son coplanaros), por lo que el eje es la recta perpendcular a ambos que da la mínma dstanca a, medda desde Z a Z en el sentdo de +, con lo cual a < (para el PUMA es a =. mm ). El orgen de coordenadas es, la nterseccón entre y Z. Por su parte, d es la dstanca desde a la nterseccón entre Z y y por tanto d =, mentras que el ángulo desde Z a Z alrededor de es α = + 9º.

5 - La ª artculacón, dbujada en Amarllo, gra alrededor de Z. Los ejes Z y Z se cortan, sendo este punto de corte el orgen. El eje es entonces perpendcular a Z y Z y naturalmente a =. El parámetro d es la dstanca a lo largo de Z desde a la nterseccón de Z y Z. En el caso del PUMA es d =.7 mm y fnalmente, el ángulo que forman Z y Z respecto a es α = 9º. Nótese que la longtud del brazo (representado por un pequeño bloque amarllo) no es un parámetro. - La ª artculacón, dbujada en Grs, gra alrededor de Z. Los ejes Z y Z se cortan, sendo este punto de corte el orgen, que concde con. El eje es perpendcular a Z y Z y a =. El parámetro d es la dstanca a lo largo de Z desde a la nterseccón de Z y Z, con lo cual se tene d =. El ángulo que forman Z y Z respecto a es α = 9º. - La ª artculacón, dbujada en Cyan, gra alrededor de Z y es la últma del brazo artculado. Dado que no exsten más artculacones, y por tanto más ejes de gro, se defne un Sstema de Referenca, lgado al últmo brazo en el que el eje Z concde con Z mentras que es cualquer vector

6 perpendcular. El orgen se stúa en poscón arbtrara, generalmente en el extremo del brazo, que es donde se ancla la herramenta del manpulador. En este caso se tene a = y d es la dstanca desde a, que para el robot PUMA es d =. mm. Fnalmente, α =.. ransformacón de coordenadas Ya se ha comentado que los parámetros a, tene por orgen el punto d, y Base {, Y, Z } α y θ asocados a la -ésma artculacón, cuyo S.R. determnan unívocamente la transformacón en el S.R asocado a la ( + ) -ésma artculacón, que tene orgen en, Y, Z. De estos parámetros, los prmeros son constantes y dependen exclusvamente de la relacón geométrca entre las artculacones e +, mentras que el º parámetro θ es la únca varable de la artculacón, sendo el ángulo de gro del eje alrededor del eje Z para llevarlo hasta. y Base { } Sabemos que dados Sstemas de Referenca R = {, [ u, u, u ] } y R {, [ v, v, v ] } = con Bases ortonormales asocadas, el cambo de coordenadas del segundo S.R. al prmero vene dado por: α β λ α = R β + λ α β λ β β β son las coordenadas de un punto en el S.R R, R es la matrz del Cambo de Base tal λ λ λ son las coordenadas del orgen del segundo S.R., α, α, α del punto en donde,, que v v v = u u u R y,, respecto al prmero. La expresón permte entonces obtener las coordenadas cuestón con respecto al prmero de los S.R. En nuestro caso, para pasar de la ( + ) -ésma artculacón a la -ésma, los Sstemas de Referenca son { Y Z } y R = {,, Y, Z } R =,,,. Estudaremos por separado la matrz del Cambo de Base y la expresón de en en el prmer S.R.

7 . Matrz del Cambo de Base Habendo asgnado los ejes a cada artculacón medante la representacón Denavt-Hartenberg, tenemos que: - El eje se obtene rotando el eje alrededor del eje Z un ángulo θ. - El eje Z se obtene rotando el eje Z alrededor del eje un ángulo α. Por su parte, el eje Y vene ya determnado por y La prmera transformacón es una rotacón alrededor del er vector de la ª Base, cuyas ecuacones genércas son: Z. () () () u u u = u u u R( θ ) La segunda transformacón es una rotacón alrededor del er vector de la Base ya transformada, y tene por expresón: () () () () () () u u u = u u u R ( α ) Por tanto, concatenándolas: () () () u u u = u u u R( θ ) R ( α ) Y Z = Y Z R ( ) R ( α ) Fnalmente, cambamos la notacón para tener: θ Con lo cual, la matrz del Cambo de Base es: R = R( θ ) R ( α ) = cosθ cosα senα senα cosα cos α senα R = cosθ cosα cosθ senα senα cosα. Coordenadas de en el prmer S.R. Según la representacón de Denavt-Hartenberg, el orgen del º Sstema de Referenca se obtene medante: - raslacón de a lo largo del eje Z por la magntud d. - raslacón a lo largo del eje por la magntud a. La prmera transformacón es: = + d Z La segunda transformacón es: = + a () ()

8 enendo ahora en cuenta que: cosα senα Y Z = Y Z cosθ cos α cosθ senα senα cos α Se tene, para el er vector: = Y Z = cosθ + Y () ( ) de donde: = + a = + d Z + a cosθ + Y = + ( a cosθ ) + ( a ) Y + d Z y por tanto, las coordenadas de en el er Sstema de Referenca son: λ a cosθ λ = a λ d Fnalmente, la transformacón de coordenadas del S.R.,[,Y,Z ] al S.R., [, Y, Z ] α cos α senα a cosθ α = cosθ cosα cosθ senα β + a α senα cosα β d Cambando la notacón para las coordenadas: x cosα senα x a cosθ y = cosθ cosα cosθ senα y + a z senα cos α z d β es: Donde el subíndce denota el Sstema de Referenca respecto al cual están expresadas las coordenadas. En coordenadas homogéneas: x cosα senα a cosθ x y cosθ cosα cosθ senα a y = z senα cosα d z

9 . Matrces de transformacón para el PUMA- En la seccón se explcó la estructura artculada del PUMA-, la asgnacón de Sstemas de Referenca a cada artculacón y el valor de los parámetros constantes a, d, α asocados. A modo de resumen, tenemos la sguente abla: Artculacón a d α A partr de la cual podemos obtener las matrces de transformacón: - cosθ = a cosθ cosθ a = d a cosθ cosθ a = - cosθ = d cosθ = cosθ = d Y la transformacón de coordenadas desde el S.R.,[,Y,Z ] al,[,y,z ] es: p = p () ( ) En partcular, para la últma artculacón: p = p () ( )