4-Tool Roll
1
Number the joints 1 to n starting with the base and ending with
the tool yaw, pitch and roll in that order.
Note: There is no tool pitch or yaw in this case
k=0
z0
y0
x0
k=1
Common
Normal
z1
z0
y0
x0
k=1
x1
y1
z1
z0
y0
x0
k=2
Vertical Extension
Common Normal
x1
y1
z1
z0
z2
y0
x0
k=2
x2
x1
y1
z1
z0
y2
z2
y0
x0
k=3
x2
x1
y1
z1
y2
z2
z3
z0
y0
x0
k=3
x2
x1
y1
y2
z1
x3
y3
z0
z2
z3
y0
x0
k=4
x2
x1
y1
y2
z1
z2
x3
y3
z3
z0
y4
y0
x4
z4
x0
x2
x1
y1
y2
z1
z2
x3
y3
z3
y4
z0
y0
x4
z4
x0
k=4
x2
x1
y1
y2
z1
z2
x3
y3
y4
z0
y0
x4
z3
b4
z4
x0
k=4
x2
x1
y1
y2
z1
z2
y3
x3
z3
y4
z0
y0
x4
z4
x0
k=1
x2
x1
y1
y2
z1
z2
y3
y4
z0
y0
x4
x3
z3
d4
b4
z4
x0
Compute dk as the distance from the origin of frame Lk-1to point bk along zk-1
Compute ak as the distance from point bk to the origin of frame Lk along xk
In this case these are the same point therefore a4=0
k=4
x2
x1
y1
y2
z1
z2
y3
y4
z0
y0
x4
x3
z3
d4
b4
z4
x0
k=3
x2
x1
y1
y2
z1
z2
y3
b3
z3
x3
d4
y4
z0
y0
x4
z4
x0
k=3
x2
x1
y1
y2
z1
z2
y3
b3
z3
x3
d4
y4
z0
y0
x4
z4
x0
k=3
x2
x1
y1
y2
z1
z2
y3
b3
z3
d3
x3
d4
y4
z0
y0
x4
z4
x0
Compute dk as the distance from the origin of frame Lk-1to point bk along zk-1
Since joint 3 is prismatic d3 is the joint variable
Compute ak as the distance from point bk to the origin of frame Lk along xk
In this case these are the same point, therefore ak=0
k=3
x2
x1
y1
y2
z1
z2
y3
b3
z3
d3
x3
d4
y4
z0
y0
x4
z4
x0
k=2
b2
x2
x1
y1
y2
z1
z2
y3
d3
x3
z3
d4
y4
z0
y0
x4
z4
x0
Once again locate point bk at the intersection of the xk and zk-1 axes
If they did not intersect we would use the intersection of xk with a
common normal between xk and zk-1
k=2
b2
x2
x1
y1
y2
z1
z2
y3
d3
x3
z3
d4
y4
z0
y0
x4
z4
x0
k=2
a2
b2
x2
x1
y1
y2
z1
z2
y3
d3
x3
z3
d4
y4
z0
y0
x4
z4
x0
Compute dk as the distance from the origin of frame Lk-1to point bk along zk-1
In this case these are the same point therefore d2=0
Compute ak as the distance from point bk to the origin of frame Lk along xk
k=2
a2
b2
x2
x1
y1
y2
z1
z2
y3
d3
x3
z3
d4
y4
z0
y0
x4
z4
x0
k=1
a2
b1
x2
x1
y1
y2
z1
z2
y3
d3
x3
z3
d4
y4
z0
y0
x4
z4
x0
For the final time locate point bk at the intersection of the xk and zk-1
axes
k=1
a2
bk
x2
x1
y1
y2
z1
z2
y3
d3
x3
z3
d4
y4
z0
y0
x4
z4
x0
k=1
a1
b1
a2
2
x2
x1
y1
y2
z1
z2
d1
y3
d3
x3
z3
d4
y4
z0
y0
x4
z4
x0
Compute dk as the distance from the origin of frame Lk-1to point bk along zk-1
Compute ak as the distance from point bk to the origin of frame Lk along xk
k=1
a1
b1
a2
2
x2
x1
y1
y2
z1
z2
d1
y3
d3
x3
z3
d4
y4
z0
y0
x4
z4
x0
a1
a2
2
x2
x1
y1
y2
z1
z2
d1
y3
d3
x3
z3
y4
z0
y0
x4
z4
x0
d4
a1
a2
2
x2
x1
y1
y2
z1
z2
d1
y3
x3
z3
y4
z0
y0
x4
x0
Joint
d1
180
a1
a2
dmax
d3
d4
90
Home
q
0
d3
z4
d4
Joint
1
2
3
4
Home
q