CINEMÁTICA DIRECTA CONTENIDO • Introducción • Representación de un punto • Representación de la orientación • Ejercicios 1 en Matlab® • Matriz de transformación homogénea • Relación entre marcos • Matrices de transformación de un robot • Ejercicios 2 en Matlab® • Cinemática Directa de un Robot • Ejemplo numérico de la Cinemática Directa Por: Dr. Juan Antonio Rojas Estrada
Introducción a la cinemáica directa de robots manipuladores
Welcome message from author
This document is posted to help you gain knowledge. Please leave a comment to let me know what you think about it! Share it to your friends and learn new things together.
Transcript
CINEMÁTICA DIRECTA C O N T E N I D O
• Introducción • Representación de un punto • Representación de la orientación • Ejercicios 1 en Matlab® • Matriz de transformación homogénea • Relación entre marcos • Matrices de transformación de un robot • Ejercicios 2 en Matlab® • Cinemática Directa de un Robot • Ejemplo numérico de la Cinemática Directa
Por: Dr. Juan Antonio Rojas Estrada
INTRODUCCIÓN PROBLEMA DE CINEMÁTICA
DIRECTA
PROBLEMA DE CONTROL DE
FUERZA
PROBLEMA DE CINEMÁTICA
INVERSA
CONTROL DE POSICIÓN
GENERACIÓN DE TRAYECTORIAS
SIMULACIÓN
PROGRAMACIÓN DE ROBOTS
DINÁMICA
INTRODUCCIÓN ARTICULACIÓN, VARIABLE DE
UNIÓN
ACTUADOR
HERRAMIENTA O ELEMENTO TERMINAL
UNIÓN DE LA BASE
ESLABÓN
UNIÓN REVOLUTA
ESLABÓN
ACTUADOR
INTRODUCCIÓN
Uniones prismáticas, variable, distancia
Uniones revolutas, variable, ángulo
TIPOS DE UNIÓN
INTRODUCCIÓN
• Cinemática. Rama de la física que estudia el movimiento sin tomar en cuenta qué lo produce
• Dinámica. Rama de la física que estudia el movimiento tomando en cuenta qué lo produce
• Control de fuerza. Además de controlar la posición del elemento terminal, se busca controlar la fuerza que sujeta o se ejerce sobre la herramienta o cuerpo rígido
• Control de posición. Tarea esencial de un robot, llevar al elemento final a una posición en el espacio
• Problema de Cinemática Directa. Dados los valores de las variables de unión, determina la posición en el espacio del elemento terminal
• Problema de Cinemática Inversa. Establecido un punto a alcanzar en el espacio, determinar los posibles conjunto de valore de las variables de unión
• Grados de Libertad (g.d.l.) El número de variables necesarias para posicionar un robot
REPRESENTACIÓN DE UN PUNTO
�
Punto en el espacio
P(x, y, z)
Sistema de ejes coordenados, Marco de referencia {A}
{A}
AP =xyz
⎡
⎣
⎢⎢⎢
⎤
⎦
⎥⎥⎥
Vector de posición
Representación matemática del punto en el espacio
AP
CUERPOS RÍGIDOS
Sistema de ejes coordenados, Marco de referencia {A}
{A}
Sistemas de ejes coordenados asignados a los cuerpos rígidos Marcos {B}, {C}, {D} y {E}
{B}
{C}
{D}
{E}
POSICIÓN DE CUERPOS RÍGIDOS
Sistema de ejes coordenados, Marco de referencia
{A}
Vectores de posición
Sistemas de ejes coordenados asignados a los cuerpos rígidos
{B}
{C}
{D}
{E} {E}
DEFINICIÓN DE PRODUCTO PUNTO
A i B = A B cosθ {A}
Proyección de v sobre u
Significado: La proyección indica “que cantidad” de v apunta en la dirección de u
Si las magnitudes de A y B son la unidad, entonces el producto punto es simplemente
A i B = cosθ
A = a1 a2 a3⎡⎣
⎤⎦T
A = a12 + a2
2 + a32
A =a1A
a2A
a3A
⎡
⎣⎢⎢
⎤
⎦⎥⎥
T
 indica vector unitario, esto es, la magnitud es 1. El superíndice T, Indica traspuesta
REPRESENTACIÓN DE LA ORIENTACIÓN
{C}
AP
{A} ZA
YA
XA
ZC
YC
XC
El sistema de ejes coordenados o marco de la herramienta {C}, esta descrito en referencia al marco {A}. Se observa que {C} no tiene la misma orientación que {A}
REPRESENTACIÓN DE LA ORIENTACIÓN
CAR =
r11 r12 r13r21 r22 r23r31 r32 r33
⎡
⎣
⎢⎢⎢
⎤
⎦
⎥⎥⎥=
XC i XA YC i XA ZC i XA
XC i YA YC i YA ZC i YAXC i ZA YC i ZA ZC i ZA
⎡
⎣
⎢⎢⎢⎢
⎤
⎦
⎥⎥⎥⎥
(1)
En palabras: La orientación del objeto cuyo sistema de ejes coordenados o marco es {C},respecto al marco de referencia {A}, se expresa mediante una matriz de rotación expresada por: que indica la orientación de {C} respecto a {A}, cada elemento de la matriz representa un producto punto de los ejes de {C}, con los de {A}
CAR
INFORMACIÓN COMPLETA EN ROBÓTICA
Representación de un punto
Representación de la orientación de un cuerpo rígido
Vector
Matriz
C{ } = CAR, APCORG{ }
En palabras: El objeto, cuyo marco es {C}, esta descrito por (orientación) y el vector de posición. El vector localiza el origen de {C} con respecto a {A}
CAR APCORG
APCORG
EJERCICIOS 1 EN MATLAB 1. Introduzca en Matlab los vectores:
2. Obtenga los vectores unitarios
3. Introduzca en Matlab la matriz
4. Evalúe la matriz para un valor de θ=30°
5. Compruebe la matriz de rotación entre los macos {A} y {B} para θ=60°
6. Obtenga el determinante y traspuesta de la matriz rotación anterior
v1 = 1 −1 2⎡⎣ ⎤⎦T
v2 = −1 1 0⎡⎣ ⎤⎦T
v3 = 1 −2 1⎡⎣ ⎤⎦T
v1, v2, v3
BAR =
cosθ −sinθ 0sinθ cosθ 00 0 1
⎛
⎝
⎜⎜
⎞
⎠
⎟⎟
{A}
YA
XB
ZB
YB
ZA
XA
{B}
θ
BAR =
1/ 2 − 3 / 2 03 / 2 1 / 2 00 0 1
⎛
⎝
⎜⎜⎜
⎞
⎠
⎟⎟⎟
MATRICES DE TRANSFORMACIÓN HOMOGÉNEA
BAR APBORG
10 0 0BAT =
La matriz de transformación homogénea, contiene la información de la posición y orientación de un marco referido a otro marco
(2)
MATRICES DE TRANSFORMACIÓN HOMOGÉNEA
cosθ −sinθ 0sinθ cosθ 00 0 1
APBORG
10 0 0BAT =
La matriz de transformación homogénea, matriz de 4X4 que da la posición y orientación del marco {B} referido al marco {A}
MATRICES DE TRANSFORMACIÓN HOMOGÉNEA
L1
L2
Robot de uniones revolutas de 4 g.d.l.
MATRICES DE TRANSFORMACIÓN HOMOGÉNEA
{A}
YA
XB
ZB
YBZA
XA
{B}
θ
Indica que los vectores son paralelos
APBORG
Marco {A} asignado al primer eslabón móvil L1 Marco {B} asignado al segundo eslabón L2
RELACIÓN ENTRE MARCOS DE REFERENCIA
{A}
YA
XB
ZB
YBZA
XA
{B}
θ
APBORG
APBORG =L100
⎛
⎝
⎜⎜⎜
⎞
⎠
⎟⎟⎟
• El marco {B} esta desplazado respecto al marco {A} sobre el eje por el vector una distancia del valor de L1
• El marco {B} esta rotado sobre el eje un valor de θ grados.
• El marco {A} es el de referencia
XAAPBORG
ZA
OBSERVACIONES:
Coordenadas del vector de posición
Usando (1) para obtener la Matriz de rotación
BAR
RELACIÓN ENTRE MARCOS DE REFERENCIA
BAR =
XB i XA YB i XA ZB i XA
XB i YA YB i YA ZB i YAXB i ZA YB i ZA ZB i ZA
⎛
⎝
⎜⎜⎜⎜
⎞
⎠
⎟⎟⎟⎟
BAR =
cosθ cos(θ + 90) cos90
cos(90 −θ ) cosθ cos90
cos90 cos90 cos0
⎛
⎝
⎜⎜⎜
⎞
⎠
⎟⎟⎟
BAR =
cosθ −senθ 0senθ cosθ 00 0 1
⎛
⎝
⎜⎜
⎞
⎠
⎟⎟
{A}
YA
XB
ZB
XA
θ
{B} ZA
Usando las identidades:cos(A + B) = cosAcosB − senA senB y sen(A + B) = senAcosB + cosA senBcon: cos90 = 0 y sen90 = 1cos(90 −θ ) = cos90 cosθ + sen90senθcos(90 −θ ) = senθ ; cos(90 +θ ) = −senθ ;
NOTA: Dado que lo que interesa aquí es la orientación, se elimina el vector de posición y los marcos se empalman para mejor visualización de los ángulos
YBθ
RELACIÓN ENTRE MARCOS DE REFERENCIA
Usando (2), la matriz de transformación del marco {B} al marco {A} queda:
BAT =
BAR APBORG⎡⎣ ⎤⎦
0 0 0⎡⎣ ⎤⎦ 1[ ]
⎛
⎝
⎜⎜
⎞
⎠
⎟⎟ =
cosθ −senθ 0 L1senθ cosθ 0 00 0 1 00 0 0 1
⎛
⎝
⎜⎜⎜⎜
⎞
⎠
⎟⎟⎟⎟
MATRICES DE TRANSFORMACIÓN DE UN ROBOT
{2}
Y2
X3
Z3
Y3Z2
X2
{3}
θ3
Indica que los vectores son paralelos
{0},
X0,1
Z0,1Y0,1
{1}
{4}
Y4
X4
Z4
θ4
θ1
θiθ1θ2θ3θ4
θ2
di0
ai−1 ai−1i
1234
0
−90
0
0
00L1L2
000
Tabla DH del robot
DH = Denavit-Hartenberg
MATRICES DE TRANSFORMACIÓN DE UN ROBOT
Eje i-1
Eje i
Eje i+1
Zi−1Yi−1
Xi−1
Xi
YiZi
θi
ai
di
α i−1
ai−1
Eslabón i-1
Eslabón i
Indican vectores paralelos y
PARÁMETROS = Torsión de eslabón = Longitud de eslabón = Corrimiento de eslabón = Ángulo de unión
α i−1
ai−1diθi
DEFINICIÓN DE PARÁMETROS = Ángulo de a alrededor de
= Distancia a a lo largo de
= Distancia a a lo largo de
= Ángulo de a alrededor de
α i−1
ai−1diθi
Zi−1 Zi Xi−1
Zi−1 Zi Xi−1
Xi−1 Xi Zi
Xi−1 Xi Zi
MATRICES DE TRANSFORMACIÓN DE UN ROBOT
Matriz de transformación de la unión i-1 a la unión i
Las matrices de transformación, del caso del robot, de acuerdo a la tabla DH
10T =
cθ1 −sθ1 0 0sθ1 cθ1 0 00 0 1 00 0 0 1
⎛
⎝
⎜⎜⎜⎜
⎞
⎠
⎟⎟⎟⎟
21T =
cθ2 −sθ2 0 00 0 1 0
−sθ2 −cθ2 0 00 0 0 1
⎛
⎝
⎜⎜⎜⎜
⎞
⎠
⎟⎟⎟⎟
32T =
cθ3 −sθ3 0 L1sθ3 cθ3 0 00 0 1 00 0 0 1
⎛
⎝
⎜⎜⎜⎜
⎞
⎠
⎟⎟⎟⎟
43T =
cθ4 −sθ4 0 L2sθ4 cθ4 0 00 0 1 00 0 0 1
⎛
⎝
⎜⎜⎜⎜
⎞
⎠
⎟⎟⎟⎟
EJERCICIOS 2 EN MATLAB
1. Obtenga la matriz de transformación :
2. Dada la descripción DH de un robot
Obtenga las matrices de transformación de
Cada eslabón. Use Matlab
BAR =
cosθ −sinθ 0sinθ cosθ 00 0 1
⎛
⎝
⎜⎜
⎞
⎠
⎟⎟
{A}
YA
XB
ZB
YB
ZA
XA
{B}
θ
BAT
APBORG
θiθ10θ3
di0
ai−1 ai−1i
123
0
90
0
000
d2L2
Tabla DH del robot
θ = 30
CINEMÁTICA DIRECTA DE UN ROBOT
La transformación total desde el último eslabón hasta el eslabón inmóvil Se obtiene multiplicando las todas las matrices de transformación, esto es, N0T = 1
A partir de la matriz de transformación general, se obtiene cualquier posición y orientación de una herramienta referida al marco de referencia, marco {0}, la posición del punto entre la tenaza descrita por el vector se describe referido al marco de referencia por el vector como