Documente Academic
Documente Profesional
Documente Cultură
CINEMATICA
DIRECTA
Ing. Iván A. Calle Flores
1
Contenido
1. Cinemática
2. Cinemática Directa
3. Convención de Denavit-Hartenberg
4. Asignación de sistemas coordenados
5. Ejercicios
El problema de la cinemática
consiste en la descripción del
movimiento del manipulador sin
considerar las fuerzas y torques
que causan el movimiento.
Ai-1
i
A12
A10
R i-1
oi-1 An-1
Ai-1
i (qi )=
i i
n
0 1
R 0
on0
Tn0 (q)= n
0 1
j-1
R i
j oi
j
Tj (q)= Ai+1 (qi+1 )Ai+2 (qi+2 )...A j (q j )=
i i i+1
0 1
➢ La matriz de rotación del sistema { j } respecto al sistema {i} esta dada por:
j-1
Rij =Rii+1Ri+1
i+2 ...R j
i −1 Rii −1
oi
i −1
➢ Tres ángulos (por ejemplo, ángulos de Ai (qi ) =
0 1
Euler) y un vector de posición.
1. DH1: x1 ⊥ z0
2. DH2: x1 z0
➢ Entonces existe una única
transformación A:
o = dz0 + ax1
0
1 ˆ 0
ˆ 0
0 c ac
o10 = d 0 + a s = as
1 0 d
• z0 es el eje de la junta 1, z1
es el eje de la junta 2, etc.
6. Computar la matriz de
transformación.
• A continuación se mostrara el
proceso de asignación de
coordenadas según DH para
diferentes tipos de robots.
b. Tabla de parámetros DH
link i di ai i
1 1 0 a1 0
2 2 0 a2 0
c. Matrices A
0 0 1 0
0 0 0 1
0 0 1 0
0 0 0 1
Msc. Iván A. Calle Flores
Ejemplo 1. Cinemática de un manipulador
planar de 2 GDL
d. Matrices T
0 0 1 0
0 0 0 1
c12 -s12 0 a1c1 +a2c12
s c 0 a s +a s
T20 = A1 A 2 = 12 12 1 1 2 12
0 0 1 0
0 0 0 1
Demo_01.m
Msc. Iván A. Calle Flores
Ejemplo 1. Cinemática de un manipulador
planar de 2 GDL
a1 = 0.8
a2 = 0.5
Demo_01_plot.m
Msc. Iván A. Calle Flores
Ejemplo 2. Cinemática de un manipulador
planar “con hombro” de 2 GDL
link i di ai i
1 1 d1 a1 0
c. Matrices A
0 0 1 d1
0 0 0 1
0 0 1 d2
0 0 0 1
Msc. Iván A. Calle Flores
Ejemplo 2. Cinemática de un manipulador
planar “con hombro” de 2 GDL
d. Matrices T
0 0 1 d1
0 0 0 1
c12 -s12 0 a1c1 +a2c12
s c 0 a s +a s
T20 = 12 12 1 1 2 12
0 0 1 d1 +d2
0 0 0 1
Demo_02.m
Msc. Iván A. Calle Flores
Ejemplo 2. Cinemática de un manipulador
planar “con hombro” de 2 GDL
a1 = 0.8
a2 = 0.5
Demo_02_plot.m
Msc. Iván A. Calle Flores
Ejemplo 3. Cinemática de un manipulador de
2 GDL en el espacio
Y1 Y2
X2
a2
Z1 b. Tabla de parámetros DH
Z2
X1
link i di ai i
d1
Z0 1 1 d1 0 pi/2
Y0 2 2 0 a2 0
X0
link i di ai i
1 1 d1 0 pi/2
2 2 0 a2 0
c. Matrices A
c1 0 s1 0
s 0 -c 0
A1 (q1 ) = 1 1
0 1 0 d1
0 0 0 1
0 0 1 0
0 0 0 1
Msc. Iván A. Calle Flores
Ejemplo 3. Cinemática de un manipulador de
2 GDL en el espacio
d. Matrices T Demo_03.m
c1 0 s1 0
s 0 -c 0
T10 = 1 1
0 1 0 d1
0 0 0 1
c1c2 - c1s2 s1 a2c1c2
s c -s1s2 - c1 a2s1c2
T20 =
1 2
s2 c2 0 d1 +a2s2
¿Como es el espacio de
0 0 0 1 trabajo de este robot?
Msc. Iván A. Calle Flores
Ejemplo 3. Cinemática de un manipulador de
2 GDL en el espacio
d1 =1.0
a2 = 0.8
Demo_03_plot.m
Msc. Iván A. Calle Flores
Ejemplo 3. Cinemática de un manipulador de
2 GDL en el espacio
z = d1 +a2s2
a2s2
a2c2
z
s2 c2 0 d1 +a2s2
0 0 0 1
Ejemplo 3. Cinemática de un manipulador de
2 GDL en el espacio
Verificando las y
coordenadas x, y
x
y =(a2c2 )s1
s2 c2 0 d1 +a2s2
0 0 0 1
Ejemplo 4. Cinemática de un manipulador de
2 GDL “con hombro” en el espacio
Ejemplo 4. Cinemática de un manipulador de
2 GDL “con hombro” en el espacio
b. Tabla de parámetros DH
link i di di i
1 1 d1 0 pi/2
2 2 d2 a2 0
Ejemplo 4. Cinemática de un manipulador de
2 GDL “con hombro” en el espacio
link i di ai i
1 1 d1 0 pi/2
2 2 d2 a2 0
Ejemplo 4. Cinemática de un manipulador de
2 GDL “con hombro” en el espacio
c. Matrices A
c1 0 s1 0
s 0 -c 0
A1 (q1 ) = 1 1
0 1 0 d1
0 0 0 1
c2 -s2 0 a2c2
s c 0 a s
A 2 (q2 ) = 2 2 2 2
0 0 1 d2
0 0 0 1
Ejemplo 4. Cinemática de un manipulador de
2 GDL “con hombro” en el espacio
d. Matrices T
c1 0 s1 0
s 0 -c 0
T10 = 1 1
0 1 0 d1
0 0 0 1
c1c2 - c1s2 s1 a2c1c2 +d2s1
s1c2 -s1s2 - c1 a2s1c2 - d2c1
T2 =
0
s2 c2 0 d1 +a2s2
0 0 0 1
Ejemplo 4. Cinemática de un manipulador de
2 GDL “con hombro” en el espacio
d1 =1.0
a2 = 0.8
Demo_04_plot.m
Ejemplo 5. Cinemática de un manipulador de
tipo RRR
Ejemplo 5. Cinemática de un manipulador de
tipo RRR
a. Asignación de sistemas coordenados Y3
O3
a3 X3
Y1 Y2
O2 Z3
O1 a2 X2
Z1 X1 Z2
d1
b. Tabla de parámetros DH
Z0
Link i di ai i
O0 Y0
X0 1 1 d1 0 /2
2 2 0 a2 0
3 3 0 a3 0
Msc. Iván A. Calle Flores
Ejemplo 5. Cinemática de un manipulador de
tipo RRR
c. Matrices A Ai-1
i (qi )
0 1 0 d1 0 0 1 0 i = 2,3.
0 0 0 1 0 0 0 1
0 1 0 d1
0 0 0 1
c1c2 - c1s2 s1 a2c1c2
s c -s1s2 - c1 a2s1c2
T20 (q) =
1 2
s2 c2 0 d1 +a2s2
0 0 0 1
c1c23 - c1s23 s1 c1 (a2c2 +a3c23 )
s c -s s - c s1 (a2c2 +a3c23 )
T30 (q)=
1 23 1 23 1
d1 =1.0
a2 = 0.7
a3 = 0.5
Demo_05_plot.m
Ejemplo 6. Cinemática de un manipulador de
tipo RRR
Y3
O3
a3 X3
Z0 Y1 Y2
O2 Z3
O0 O1 a2 X2
Z1 X1 Z2
X0
Link i di ai i
1 1 0 0 /2
2 2 0 a2 0
3 3 0 a3 0
Msc. Iván A. Calle Flores
Ejemplo 6. Cinemática de un manipulador de
tipo RRR
4. Hallando las matrices Ai-1
i (qi )
1 1 d1 0 90
2 2 d2 a2 0
3 3 -d3 a3 0
Ejemplo 7. Cinemática de un manipulador de
tipo RRR “con hombro”
c. Matrices A
c1 0 s1 0
s 0 -c 0
A1 (q1 ) = 1 1
0 1 0 d1
c2 -s2 0 a2c2
0 0 0 1 s c 0 a s
A3 (q3 ) = 2 2 2 2
0 0 1 d2
0 0 0 1
Ejemplo 7. Cinemática de un manipulador de
tipo RRR “con hombro”
c1 0 s1 0
s 0 - c1 0
T10 (q)=
1
0 1 0 d1
0 0 0 1
c1c2 - c1s2 s1 a2c1c2 +d2s1
s1c2 -s1s2 - c1 a2s1c2 - d2c1
T2 (q) =
0
s2 c2 0 d1 +a2s2
0 0 0 1
c1c23 - c1s23 s1 c1 (a2c2 +a3c23 )+(d2 - d3 )s1
s c -s1s23 - c1 s1 (a2c2 +a3c23 )-(d2 - d3 )c1
T30 (q)= 1 23
s23 c23 0 d1 +a2s2 +a3s23
0 0 0 1 Demo_07.m
Ejemplo 8. Cinemática de un manipulador
cilíndrico
b. Tabla de parámetros DH
link i di ai i
1 1 d1 0 0
2 0 d2 0 -90
3 0 d3 0 0
Ejemplo 8. Cinemática de un manipulador
cilíndrico
c. Matrices A
c1 -s1 0 0
s c 0 0
A1 = 1 1
0 0 1 d1
0 0 0 1
1 0 0 0
0 0 1 0
A2 =
0 -1 0 d2
0 0 0 1
1 0 0 0
0 1 0 0
A3 =
0 0 1 d3
0 0 0 1
Msc. Iván A. Calle Flores
Ejemplo 8. Cinemática de un manipulador
cilíndrico
d. Matrices T
c1 0 -s1 0
s 0 c1 0
T2 =
0 1
0 -1 0 d1 +d2
0 0 0 1
0 -1 0 d1 +d2
0 0 0 1
Demo_08.m
Msc. Iván A. Calle Flores
Ejemplo 9. Cinemática de un manipulador
esférico
Ejemplo 9. Cinemática de un manipulador
esférico
a. Asignación de sistemas coordenados
b. Tabla de parámetros DH
link i di ai i
1 1 d1 0 90
2 2 0 0 90
3 0 d3 0 0
Ejemplo 9. Cinemática de un manipulador
esférico
Ejemplo 9. Cinemática de un manipulador
esférico
link i di ai i
1 1 d1 0 90
2 2+90 0 0 90
3 0 L+q3 0 0
Ejemplo 9. Cinemática de un manipulador
esférico
c. Matrices A
c1 0 s1 0
s 0 -c1 0
A1 = 1
0 1 0 d1
0 0 0 1
-s2 0 c2 0
c 0 s2 0
A2 = 2
0 1 0 0
0 0 0 1
1 0 0 0
0 1 0 0
A3 =
0 0 1 L+q3
0 0 0 1
Ejemplo 9. Cinemática de un manipulador
esférico
d. Matrices T
-c1s2 s1 c1c2 0
-s s -c s1c2 0
T20 = 1 2 1
c2 0 s2 d1
0 0 0 1
c2 0 s2 d1 +(L+q3 )s2
0 0 0 1
Demo_09.m
Ejemplo 10. Cinemática de un manipulador
esférico “con hombro”
Ejemplo 10. Cinemática de un manipulador
esférico “con hombro”
Ejemplo 10. Cinemática de un manipulador
esférico “con hombro”
link i di ai i
1 1 d1 0 -90
2 2 d2 0 90
3 0 d3 0 0
Ejemplo 10. Cinemática de un manipulador
esférico “con hombro”
c. Matrices A
c1 0 -s1 0
s 0 c1 0
A1 = 1
0 -1 0 d1
0 0 0 1
q1 = θ1
c 2 0 s2 0
s 0 -c2 0 q2 = θ2
A2 = 2
0 1 0 d2 q3 = d3
0 0 0 1
1 0 0 0
0 1 0 0
A3 =
0 0 1 q3
0 0 0 1
Ejemplo 10. Cinemática de un manipulador
esférico “con hombro”
d. Matrices T
-s2 0 c2 d1
0 0 0 1
-s2 0 c2 d1 +c2d3
0 0 0 1
Ejemplo 10. Cinemática de un manipulador
esférico “con hombro”
Esta seria la
configuración si
elegimos el hombro
derecho
link i di ai i
1 1 d1 0 90
2 2 d2 0 90
3 0 d3 0 0
Ejemplo 11. Cinemática de la muñeca esférica
Muñeca esférica
Muñeca no esférica
link i di ai i
4 4 d4 0 -90
5 5 0 0 90
Demo_11.m 6 6 d6 0 0
link i di ai i
4 4 0 0 -90
5 5 0 0 90
6 6 d6 0 0
c 4 0 -s 4 0 c 5 0 s5 0 c6 -s6 0 0
s s 0 -c 0
0 c4 0 s c6 0 0
A4 = 4 A5 = 5 5 A6 = 6
0 -1 0 0 0 1 0 0 0 0 1 d6
0 0 0 1 0 0 0 1 0 0 0 1
link i di ai i
4 4 0 0 -90
5 5 0 0 90
6 6 d6 0 0
Ejemplo 11. Cinemática de la muñeca esférica
link i di ai i
4 4 0 0 -90
5 5 0 0 90
6 6 d6 0 0
Demo_12.m
Msc. Iván A. Calle Flores
Ejemplo 12. Cinemática de un manipulador
antropomórfico con muñeca esférica
link i di ai i
Otra posible solución
eliminando d1 1 1 0 0 90
2 2 0 a2 0
3 3 0 0 90
4 4 d4 0 -90
5 5 0 0 90
6 3 d6 0 0