Professional Documents
Culture Documents
I. OBJETIVO
Sistematizar la solución del problema cinemático directo mediante el
algoritmo de Denavit-Hartenberg.
Desarrollar programas en MATLAB que permitan determinar la cinemática
del manipulador con el método de Denavit- Hartenberg.
III. PROCEDIMIENTO
1. Sea el robot KUKA de la siguiente figura, donde aparecen todos los elementos
mecánicos que lo conforman.
2. Dibujar el esquema del robot KUKA KR6 (según la simbología del libro de
Barrientos)
2 𝑞2 0 680 0⁰
3 𝑞3 0 0 -90⁰
4 𝑞4 670 0 -90⁰
5 𝑞5 0 0 90⁰
6 𝑞6 158 0 0⁰
7. Con ayuda del docente y/o asistente del laboratorio, colocar al robot en su
“posición cero”, es decir, todos los parámetros articulares con un valor angular
que satisfagan esa posición.
Dar un primer valor diferente de cero a cada uno de los ejes del robot. Remplazar este valor en las
ecuaciones obtenidas por medio del algoritmo de D-H y obtener los valores numéricos para la
posición y orientación del efector final del robot. Dibujar esta localización espacial indicando la
posición y la orientación del EF. Dibujar el sistema solidario al EF.
Cuando:
𝑞1 = −90 , 𝑞2 = −90 , 𝑞3 = 45 , 𝑞4 = −40 , 𝑞5 = 90 , 𝑞6 = 0
Las matrices son:
0 0 1 0
0
1 𝐴1 = [ 1 0 0 260 ]
0 1 0 675
0 0 0 1
0 −1 0 0
1
1 𝐴2 = [ 1 0 0 680 ]
0 0 1 0
0 0 0 1
−0.7071 0 0.7071 0
2
1 𝐴3 = [ −0.7071 0 −0.7071 680 ]
0 −1 0 0
0 0 0 1
0.7660 0 0.6428 0
3
1 𝐴4 = [ −0.6428 0 0.7660 0 ]
0 −1 0 670
0 0 0 1
0 0 1 0
14 𝐴5 = [1 0 0 0]
0 1 0 0
0 0 0 1
1 0 0 0
1 𝐴6 = [ 0 1 0 0 ]
5
0 0 1 158
0 0 0 1