DH 2GDL OBJETIVO : OBTENER LA MATRIZ DH DE TRANSFORMACION DE LA CADENA CINEMATICA.

Presentación del tema: "DH 2GDL OBJETIVO : OBTENER LA MATRIZ DH DE TRANSFORMACION DE LA CADENA CINEMATICA."— Transcripción de la presentación:

1 DH 2GDL OBJETIVO : OBTENER LA MATRIZ DH DE TRANSFORMACION DE LA CADENA CINEMATICA

2 MATRIZ DH GENERALIZADA
DH 2GDL MATRIZ DH GENERALIZADA

3 DH 2GDL Eslabón 1 % MATRIZ DENAVIT-HARTENBERG GENERALIZADA % DHM(x,y)
Archivo DHM.m % MATRIZ DENAVIT-HARTENBERG GENERALIZADA % DHM(x,y) % TOMA 2 ARRELOS Y LOS SUMA ELEMENTO A ELEMENTO % COPYRIGHT (c) SIMULACION 1 de 10: :00 % ***************************************** %****************************************** function A = DHM(AngTeta,d,a,AngAlfa) teta=AngTeta*(2*pi)/360; alfa=AngAlfa*(2*pi)/360; A=[cos(teta) -sin(teta)*cos(alfa) sin(teta)*sin(alfa) a*cos(teta); sin(teta) cos(teta)*cos(alfa) -cos(teta)*sin(alfa) a*sin(teta); sin(alfa) cos(alfa) d; ];

4 DH 2GDL P0=[0;0;0;1] a1=0; d1=11; AngTeta=0; AngAlfa=0;
Eslabón 1 Archivo DHM.m RESULTADO P0 = 0 1 M1 = P1 = 11 P0=[0;0;0;1] a1=0; d1=11; AngTeta=0; AngAlfa=0; M1=DHM(AngTeta,d1,a1,AngAlfa) T=M1; P1=T*P0

5 DH 2GDL Eslabón 2 a2=22; d2=0; AngTeta=0; AngAlfa=-90;
Archivo DHM.m RESULTADO M2 = P2 = 22 11 1 a2=22; d2=0; AngTeta=0; AngAlfa=-90; M2=DHM(AngTeta,d2,a2,AngAlfa) T=M1*M2; P2=T*P0

6 DH 2GDL Eslabón 3 a3=33; d3=0; AngTeta=0; AngAlfa=0;
Archivo DHM.m RESULTADO M3 = P3 = 55 11 1 a3=33; d3=0; AngTeta=0; AngAlfa=0; M3=DHM(AngTeta,d3,a3,AngAlfa) T=M1*M2*M3; P3=T*P0

7 DH 2GDL T = M X M X M3 RESULTADO T =

8 DH 2GDL THE END