Beruflich Dokumente
Kultur Dokumente
LAZARO CARDENAS
PRACTICA 4
ndice
Introduccin ....................................................................................................................................... 1
Objetivo general ................................................................................................................................ 1
Objetivos especficos ....................................................................................................................... 1
Desarrollo........................................................................................................................................... 2
Conclusin ....................................................................................................................................... 10
Fuentes consultadas ...................................................................................................................... 10
Introduccin
Objetivo general
Realizar el anlisis de un sistema de cadena cinemtica abierta de 4 grados de
libertad con el criterio de DENAVIT-HARTENBERG.
Objetivos especficos
Realizar modelado mecnico del manipulador
Realizar las tramas de referencia
Elaborar la tabla de parmetros segn criterio
Obtener las matrices de cada trama
Realizar programa en Matlab
Comparar grficamente
Desarrollo
Y1
Y2
Z1
X1
Y3
X2
Z2
X4
Z0
X3
Z3
Y0
Y4
Z4
X0
Figura 2. Tramas de referencia
Fuente: solidworks
.
i
q1
q2
q3
90
q4
i
90
0
0
90
0
di
L1
0
0
0
0
ai
0
L2
L3
0
0
De esta manera se hace uso de la tabla de parmetros para obtener las matrices
del sistema para cada elemento de la cadena cinemtica e introducir las matrices
obtenidas para obtener la matriz total del manipulador, es decir, del punto final del
manipulador. Como se muestra en las matrices (1), (2), (3), (4), (5).
cq1
sq
1
A0 1
0
0
0
L1
(1)
0 L2 cq2
0 L2 sq2
1
0
0
1
(2)
0 sq1
0 cq1
1
0
cq2
sq
2
A1 2
0
sq2
cq
cq3
sq
3
A2 3
0
sq3
cq3
0
0
0
0
0 L3cq3
0 L3 sq3
1
0
0
1
0
0
(3)
0
1
4
A3
0
0
cq4
sq
5
A4 4
0
0 1 0
0 0 0
1 0 0
0 0 1
sq4
cq4
0
0
0 0
0 0
1 0
0 1
(4)
(5)
Las matrices (1), (2), (3), (4), (5), mostradas anteriormente se introducen una a
una a Matlab para realizar la multiplicacin de las mismas y de esta manera
encontrar el vector final que se desea obtener; es decir, la matriz total del sistema
como se muestra en la figura 3.
Los puntos px, py, pz son utiles para realizar el programa de la interfaz grfica que
se utiliza para demostrar grficamente el manipulador de 4 grados de libertad. En
la figura 4, se muestra el programa que se ejecuta con la interfaz grfica. Donde
de manera inicial, con el uso de matlab se multiplicaron las matrices para
determinar los puntos de cada vector que se grfica.
35
Se introdujeron a la interfaz los mismos valores que se asignaron para los angulos
de giro y rotacin en solidwoks; esto con el objetivo de comparar los resultados de
un software con los del otro en la figura 8, se muestra el resultado al ejecutar el
programa en Matlab.
Dnde:
Px = 243.616 mm
Py = 740.924 mm
Pz = 170.582 mm
Conclusin
Fuentes consultadas
Mark W. Spong
Introduccin a la robtica 3Era edicin
10