Documentos de Académico
Documentos de Profesional
Documentos de Cultura
Cinemática Directa
Cinemática Directa
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 (qi )=
i-1 i i
n
0 1
R 0
o0
Tn (q)=
0 n n
0 1
R i
j oi
j
Tj (q)= Ai+1 (qi+1 )Ai+2 (qi+2 )...A j (q j )=
i i i+1 j-1
0 1
➢ La matriz de rotación del sistema { j } respecto al sistema {i} esta dada por:
Rij =Ri+1
i
Ri+2
i+1
...R j-1
j
o =o +R o
i
j
i
j-1
i
j-1
j-1
j
Estas ecuaciones serán muy útiles
cuando se derive el Jacobiano
Msc. Iván A. Calle Flores
3. CONVENCION DENAVIT-
HARTENBERG
• Es un procedimiento sistemático
para hallar la cinemática de un
robot.
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 c12 0 a1s1 +a2s12
T2 = A1 A2 =
0 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 c12 0 a1s1 +a2s12
T2 =
0 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 -c1 0
A1 (q1 )= 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 -c1 0
T10 = 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
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
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 -c1 0
A1 (q1 )= 1
0 1 0 d1
0 0 0 1
c2 -s2 0 a2c2
s c2 0 a2s2
A2 (q2 )= 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 -c1 0
T10 = 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 -c1 0
A1 (q1 )= 1
0 1 0 d1
c2 -s2 0 a2c2
0 0 0 1 s c2 0 a2s2
A3 (q3 )= 2
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 c1 0 0
A1 = 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 c 0
T20 = 1 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 q2+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 s c 0
T20 = 1 2 1 1 2
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 c 0
A1 = 1 1
0 -1 0 d1
0 0 0 1
q1 = θ1
c 2 0 s 2 0
s 0 -c 0 q2 = θ2
A2 = 2 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
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