Robotic Homework - 1 - Sol
Robotic Homework - 1 - Sol
Homework #2
(Spatial descriptions and transformations)
Problem 1. A frame {B} is located initially coincident with a frame {A}. We rotate {B} about ZB-
axis by
30 degrees, and then we rotate the resulting frame about XB-axis by 45 degrees. Do the
followings:
a. Give the rotation matrix that will change the description of vectors from 𝑃B to 𝑃A.
b. Determine a unique rotation about an equivalent axis for the rotations?
Problem 2.
From the figure above, give the the value of ABT , CAT , CBT , and CAT
Name: Student code
Problem 3.
Figure depicts the robot grasping an object. Relative position and orientation of the base frame
{B}, the working table frame {S}, object frame {O}, the end effector frame {E}, and the camera
frame {C} are as shown in the figure. Determine the homogenous transformation matrix
B S C C
ET , OT , OT , ST
and CET . From these result, calculate OBT , EST , and OET .
Problem 4. An orientation is constructed from the following sub-rotations. Firstly, rotate about
the z-axis by 900. Then follow by the rotation about the y-axis of the current frame by -1800.
Finally, rotate about the current x-axis by -900.
a) Describe this orientation with the ZYX Euler angles
b) Describe this orientation with the XYZ Euler angles
c) Find the equivalent axis and angle
Name: Student code
Solutions
Solution to Problem 1:
a. Give the rotation matrix !"𝐑
écos(300 ) - sin(300 ) 0 ù
ê ú
R ZB (300 ) = ê sin(300 ) cos(300 ) 0 ú
ê 0 0 1 úû
ë
é1 0 0 ù
ê
R XB (30 ) = ê0 cos(45 ) - sin(45 ) ú
0 0 0 ú
é r32 - r23 ù
1 ê
ˆ =
K ê r13 - r31 úú
2sin q
êë r21 - r12 úû
⎡ 0.8192 ⎤
⎢ ⎥
K̂ = ⎢ 0.2195 ⎥
⎢ 0.5299 ⎥
⎣ ⎦
Solution to Problem 2
é -1 0 0 3ù
ê 0 -1 0 0 úú
A
T = ê
B
ê0 0 1 0ú
ê ú
ë0 0 0 1û
é 0 -0.5 0.866 3 ù
ê 0 0.866 0.5 0 ú
ê ú
CT =
A
ê -1 0 0 2ú
ê ú
ë0 0 0 1û
Name: Student code
é0 0.5 -0.866 0ù
ê 0 -0.866 -0.5 0 úú
ê
CT =
B
ê -1 0 0 2ú
ê ú
ë0 0 0 1û
é 0 0 -1 2 ù
ê -0.5 0.866 0 1.5 úú
ê
AT =
C
Solution to Problem 3
𝐾#! may be determined by the first observing that {𝐵} is oriented to {𝑆} with the rotation of -30o
about {s}z-axis. That is
𝑐(−30* ) −𝑠(−30* ) 0
)
!𝑅 = 𝑅$,&'(! = *𝑠(−30* ) 𝑐(−30* ) 03
0 0 1
Similarly, {𝐸 } is oriented relative to {𝑆} with the first rotation of -20o about {s}z-axis, and then
the rotation of 40o about moving y-axis. The resulting transformation would be:
Relative orientation may be determined by representing the unit vectors of the x-y-z axes of
{𝑂} in {𝐶 }. As a result
0.5 0.8660 0
4
*𝑅 = F0.8660 −0.5 0G
0 0 −1
Therefore
0.5 0.8660 0 0.2
4 0.8660 −0.5 0 0.2
*𝑇 = @ B
0 0 −1 1
0 0 0 1
Similarly, 4)𝑇 may be observed directly from the figure as
0 −1 0 0.7
4 −1 0 0 0.7
)𝑇 = @ B
0 0 −1 1.25
0 0 0 1
Position of the origin {𝐸 } with the respect to {𝐶 } is the figure:
𝒄𝑶3𝑬 = [−0.3 1.5 0.8]0
écos(90) - sin(90) 0ù
RZ ,90o = êê sin(90) cos(90) 0úú
êë 0 0 1 úû
é cos(-180) 0 sin(-180) ù
RY , -180o = êê 0 1 0 ú
ú
êë - sin(-180) 0 cos(-180) úû
é1 0 0 ù
RX , -90o = ê0 cos(-90) - sin(-90) úú
ê
êë0 sin(-90) cos(-90) úû
é 0 0 -1ù
RZYX = RZ RY RX = êê -1 0 0 úú = RX ,0o RY , -90o RX , -90o
êë 0 1 0 úû
Since the function arctan has 2 roots, another answer could be accepted.
c. The equivalent axis and angle:
Name: Student code
æ r 11 + r 22 + r 33 -1 ö
q = arg cos ç ÷
è 2 ø
é r32 - r23 ù
ˆ = 1 êr - r ú
K
2sin q ê
13 31 ú
êë r21 - r12 úû
é 0.5774 ù
K = êê -0.5774 úú
ˆ
êë -0.5774 úû