A1=[cos(teta1) -sin(teta1)*cos(alfa1) sin(teta1)*sin(alfa1)

sin(teta1) cos(teta1)*cos(alfa1) -cos(teta1)*sin(alfa1)

0 sin(alfa1) cos(alfa1) d1;
0 0 0 1];
A2=[cos(teta2) -sin(teta2)*cos(alfa2) sin(teta2)*sin(alfa2)
sin(teta2) cos(teta2)*cos(alfa2) -cos(teta2)*sin(alfa2)
0 sin(alfa2) cos(alfa2) d2;
0 0 0 1];
A3=[cos(teta3) -sin(teta3)*cos(alfa3) sin(teta3)*sin(alfa3)
sin(teta3) cos(teta3)*cos(alfa3) -cos(teta3)*sin(alfa3)
0 sin(alfa3) cos(alfa3) d3;
0 0 0 1];
A4=[cos(teta4) -sin(teta4)*cos(alfa4) sin(teta4)*sin(alfa4)
sin(teta4) cos(teta4)*cos(alfa4) -cos(teta4)*sin(alfa4)
0 sin(alfa4) cos(alfa4) d4;
0 0 0 1];
A5=[cos(teta5) -sin(teta5)*cos(alfa5) sin(teta5)*sin(alfa5)
sin(teta5) cos(teta5)*cos(alfa5) -cos(teta5)*sin(alfa5)
0 sin(alfa5) cos(alfa5) d5;
0 0 0 1];
A6=[cos(teta6) -sin(teta6)*cos(alfa6) sin(teta6)*sin(alfa6)
sin(teta6) cos(teta6)*cos(alfa6) -cos(teta6)*sin(alfa6)
0 sin(alfa6) cos(alfa6) d6;
0 0 0 1];
R1=A1*A2;
R2=R1*A3;
R3=R2*A4;
R4=R3*A5;
R5=R4*A6;
Matriz_Final = R5

a1*cos(teta1);
a1*sin(teta1);
a2*cos(teta2);
a2*sin(teta2);
a3*cos(teta3);
a3*sin(teta3);
a4*cos(teta4);
a4*sin(teta4);
a5*cos(teta5);
a5*sin(teta5);
a6*cos(teta6);
a6*sin(teta6);