2
Dalam sistem koordinat homogen (homogeneous coordinate system),
perhitungan transformasi geometri menjadi lebih sederhana.
Vektor dalam Representasi Homogen
x x
x y x y
y or y
z z
z z
1
Transformasi Matrik Homogen
R3 x 3 t3 x1
A=
p1x 3 s1x1
Rotation Matrix Translation Vector
A=
Perpective Transformation Scaling Factor
3
Transformasi Matrik Homogen 3D
1 0 0 qx 1 0 0 0
0 1 0 q y 0 c − s 0
A
TB (q) = A
RB ( x, ) =
0 0 1 qz 0 s c 0
0 0 0 1 0 0 0 1
c − s 0 0 c 0 s 0
s c 0 0 0 1 0 0
A
RB ( z , ) = A
RB ( y, ) =
0 0 1 0 − s 0 c 0
0 0 0 1 0 0 0 1
4
Standar Sistem Koordinat
❑ Arah sumbu z tegak lurus dengan arah rotasi untuk tipe joint rotasional, dan
searah dengan arah translasi untuk tipe joint translasional.
❑ Sumbu zi terletak pada joint yang ke (i+1).
5
Parameter DH
c i − c i s i s i s i ai c i
s c i c i − s i c i ai s i
i −1
Ai = i
0 s i c i di
0 0 0 1
6
Joint i i ai di i
1 0 a1 0 1
2 0 a2 0 2
3 0 a3 0 3
7
c1 − s1 0 a1 c1 c 2 − s 2 0 a2 c 2 c 3 − s 3 0 a3 c 3
s s 0 a3 s 3
s c1 0 a1 s1 c 2 0 a2 s 2 c 3
0
A1 = 1 1
A2 = 2
2
A3 = 3
0 0 1 0 0 0 1 0 0 0 1 0
0 0 0 1 0 0 0 1 0 0 0 1
0
A3 = 0A1 1A2 2A3
8
0
Qˆ = 0A3 3Qˆ where
3
Qˆ = 0 0 0 1 T
9
y2
a2
x2 a3
y1 z2
3
z1 x1 y3
2
End-effector
z3
1 Q x3
d1
z0
y0
Reference x0
10
Joint, i i ai di i
1 /2 0 d1 1
2 0 a2 0 2
3 0 a3 0 3
11
Posisi end-effector robot Q terhadap referensi dalam bentuk homogen
0
Qˆ = 0A1 1 A2 2 A3 3Qˆ
3
Qˆ = 0 0 0 1 T
c1 (a2 c 2 + a3 c 23 )
s (a c + a c )
Q= 1 2 2
0 ˆ 3 23
d1 + a2 s 2 + a3 s 23
1
12
Joint i i ai di i
1 0 a1 d1 1+ /2
2 a2 0 2
3 0 0 d3 0
4 0 0 d4 4
13
Joint i i ai di i
1 /2 a1 0 1
2 0 a2 0 / 2 + 2
3 / 2 a3 0 3
4 − / 2 0 d4 4
5 /2 0 0 5
6 0 0 d6 6
14
15