Problems 3
Problems 3
[P3.1] Determine the expression for the area of the workspace of 2R manip-
ulator with l1 and l2 . Assume that l1 and l2 can be changed with
l1 + l2 = constant. Show that l1 = l2 for maximum workspace.
[P3.4] Obtain the D-H parameters for the RRR manipulator shown in fig-
ure ??. Derive expressions for the (x, y, z) coordinates of the point P
on the manipulator, with respect to {Base}, as a function of (θ1 , θ2 , θ3 ).
Derive the expressions for θ1 , θ2 , and θ3 for a given (x, y, z)T .
ẐBase R Joint
R Joint θ3
P
θ2
(x, y, z)
θ1
d1
R Joint
X̂Base
Origin of {Base}
[P3.5] Assign coordinate systems, obtain D-H parameters and derive expres-
sions for the (x, y, z) coordinates of the point P , on the manipulator,
1
shown in figure ??, as a function of (θ1 , θ2 , θ3 ). Derive the expressions
for θ1 , θ2 , and θ3 for a given (x, y, z)T .
θ2
θ1
θ3
R Joint
R Joint
R Joint
Point P (x, y, z)
[P3.6] Derive the direct and inverse kinematics for Stanford Arm shown in
Exercise Problems in Module 2.
[P3.7] Show that the expressions for θ1 , θ2 and θ3 for a PUMA 560 robot can
also be obtained in the form
√
θ1 = Atan2(O6y , O6x ) − Atan2(d3 , ± O6 2x + O6 2y − d23 )
√
θ3 = Atan2(a3 , d4 ) − Atan2(K, ± a23 + d24 − K 2 )
θ2 = Atan2[(−a3 − a2 c3 )O6z − (c1 O6x + s1 O6y )(d4 − a2 s3 ),
(a2 s3 − d4 )O6z + (c1 O6x + s1 O6y )(a3 + a2 c3 )] − θ3
where
2
[P3.9] Derive the inverse kinematics equations of a SCARA manipulator
shown Lecture 3 and sketch the workspace of the SCARA manipu-
lator.
[P3.10] Take a straight line path in the workspace and plot θi when joint ro-
tations are limited for the redundant planar 3R manipulator. Assume
−120◦ ≤ θi ≤ +120◦ , i = 1, 2, 3, and the link lengths are 5, 3, and 1
units, respectively.
[P3.11] Take a straight line path in the workspace and evaluate θi for a re-
dundant planar 4R manipulator. Assume −120◦ ≤ θi ≤ +120◦ , i =
1, 2, 3, 4, and the link lengths are 5, 2.5, 1, and 0.5 units, respectively.
Plot the θi ’s and compare with problem P3.10.
[P3.12] The equations of two circles with centre (ai , bi ), i = 1, 2 and radii
ri , i = 1, 2 are
(x − ai )2 + (y − bi )2 = ri2 , i = 1, 2
[P3.14] Determine the inverse kinematics equations for six degree of freedom
RRPRRR manipulator analogous to the 14 equations for a 6R manip-
ulator discussed in the text.