FORWARD KINEMATICS: THE DENAVIT-HARTENBERG ...
FORWARD KINEMATICS: THE DENAVIT-HARTENBERG ...
FORWARD KINEMATICS: THE DENAVIT-HARTENBERG ...
Create successful ePaper yourself
Turn your PDF publications into a flip-book with our unique Google optimized e-Paper software.
84CHAPTER 3. <strong>FORWARD</strong> <strong>KINEMATICS</strong>: <strong>THE</strong> <strong>DENAVIT</strong>-<strong>HARTENBERG</strong> CONVENTION<br />
Table 3.1: Link parameters for 2-link planar manipulator.<br />
determined from (3.10) as<br />
The T-matrices are thus given by<br />
Link ai αi di θi<br />
1 a1 0 0 θ ∗ 1<br />
2 a2 0 0 θ ∗ 2<br />
∗ variable<br />
A1 =<br />
⎡<br />
c1<br />
⎢ s1<br />
⎢<br />
⎣ 0<br />
−s1<br />
c1<br />
0<br />
⎤<br />
0 a1c1<br />
0<br />
⎥<br />
a1s1 ⎥<br />
⎥.<br />
1 0 ⎦<br />
(3.22)<br />
A2 =<br />
0<br />
⎡<br />
c2<br />
⎢ s2<br />
⎢<br />
⎣ 0<br />
0<br />
−s2<br />
c2<br />
0<br />
0 1<br />
⎤<br />
0 a2c2<br />
0<br />
⎥<br />
a2s2 ⎥<br />
1 0 ⎦<br />
(3.23)<br />
0 0 0 1<br />
T 0<br />
1 = A1. (3.24)<br />
⎡<br />
⎤<br />
T 0<br />
2<br />
c12<br />
⎢ s12<br />
= A1A2 = ⎢<br />
⎣ 0<br />
−s12<br />
c12<br />
0<br />
0 a1c1 + a2c12<br />
0 a1s1 + a2s12<br />
1 0<br />
0 0 0 1<br />
⎥<br />
⎥.<br />
(3.25)<br />
⎦<br />
Notice that the first two entries of the last column of T 0<br />
2 are the x and y<br />
components of the origin O 2 in the base frame; that is,<br />
x = a1c1 + a2c12<br />
y = a1s1 + a2s12<br />
(3.26)<br />
are the coordinates of the end-effector in the base frame. The rotational part<br />
of T 0<br />
2 gives the orientation of the frame o2x2y2z2 relative to the base frame.<br />
⋄<br />
Example 3.2 Three-Link Cylindrical Robot<br />
Consider now the three-link cylindrical robot represented symbolically by<br />
Figure 3.7. We establish O 0 as shown at joint 1. Note that the placement of