Robot Movement in Space
Robot Movement in Space
1 0 0 d x nx ox ax p x nx ox ax px + d x
0 1 0 d y n y oy ay p y n y oy ay p y + d y
Fnew = =
0 0 1 d z nz oz az p z nz oz az pz + d z
0 0 0 1 0 0 0 1 0 0z 0 1
a a
Notice that the directional vectors d
o
remain the same after a pure translation p
n
o
n
but the new location of the frame is at
d+p. x y
1 0 0 0 1 0 0 2 1 0 0 2
𝑃𝑛𝑒𝑤 = 𝑅𝑜𝑡 𝑥, 90 𝑃𝑜𝑙𝑑 = 0 0 −1 0 0 1 0 3 = 0 0 −1 −4
0 1 0 0 0 0 1 4 0 1 0 3
0 0 0 1 0 0 0 1 0 0 0 1
pxyz = p3, xyz = Rot ( y, ) p2, xyz = Rot ( y, ) Trans(l1 , l2 , l3 ) Rot ( x, ) pnoa
nx ox ax px nx ny nz −p n
n oy ay p y o oy oz −p o
T = y and T −1 = x
nz oz az pz ax ay az −p a
0 0 0 1 0 0 0 1