cos (Ө) − cos (α) SEN (Ө)
cos (Ө) − cos (α) SEN (Ө)
ARTICULACIO D A Q
N
1
2
3
cos ()
cos( )SEN ()
Acos()
ROBOT
g1 = 90
g2 = 0
g3 = -90
g4 = -90
g5 = 90
g6 = -90
d1 = 1
d2 = 3
d3 = 1
d4 = 1
d5 = 1
d6 = 1
a1 = 3
a2 = 0
a3 = 0
a4 = 0
a5 = 0
al1 =45
al2 = 200
al3 = 45
al4 = 230
al5 = 300
al6 = 45
a6 = 3
e1 =
0 0 0 1.0000
e2 =
1.0000 0 0 0
0 0.4872 0.8733 0
0 0 0 1.0000
e3 =
0 0 0 1.0000
e4 =
0 0 0 1.0000
e5 =
0 0 0 1.0000
e6 =
0 0 0 1.0000
pociondelefectorfinal =
0 0 0 1.0000