Question 2 of 7: Frame diagram and composition of transformations (20 marks)
Nivaar worked solution (AI-drafted; not reviewed by a licensed engineer)
Notes on this paper
Paper format. National Exams, May 2016 — 07-Mec-B12 Robot Mechanics, 3 hours. CLOSED BOOK, with one 8.5″×11″ formula sheet (both sides) and an approved non-programmable calculator permitted. FIVE questions constitute a complete paper and each question is of equal value (20 marks); the first five as they appear in the answer book are marked. All seven questions are worked here.
Reference texts. J. J. Craig, Introduction to Robotics: Mechanics and Control, 4th ed. (the exam's leading-super/subscript notation and the Z–Y–Z Euler convention follow this text directly); M. W. Spong, S. Hutchinson and M. Vidyasagar, Robot Modeling and Control, 2nd ed.; S. B. Niku, Introduction to Robotics: Analysis, Control, Applications, 3rd ed.; K. M. Lynch and F. C. Park, Modern Robotics, 1st ed.
Notation (from the exam's own nomenclature page). A leading superscript names the frame a quantity is referenced to, so $^{A}V$ is the vector $V$ expressed in frame $\{A\}$. A leading subscript together with a leading superscript names a transformation: $^{B}_{A}T$ describes frame $\{A\}$ relative to frame $\{B\}$, and therefore maps coordinates the other way, $^{B}P = {}^{B}_{A}T\,{}^{A}P$. Keeping that direction straight is the single most common source of lost marks on this paper, so every question below states explicitly which way the given transform points.
Check: sign convention for the revolute joint. Figure 1 shows the direction of positive motion with a curved arrow but does not label a sense on the base triad. Throughout Questions 3–6 the base frame is taken as $x_{0}$ along the horizontal arm, $z_{0}$ vertically up and $y_{0}$ completing the right-handed set, with positive $q_{2}$ following the right-hand rule about $+x_{0}$. Every result below is stated in that frame; a candidate who assigns the opposite sense obtains the same magnitudes with $q_{2}\rightarrow-q_{2}$.
Question 2: Frame diagram and composition of transformations (20 marks)
Given. Three of the six possible links between the four frames $\{U\}$, $\{A\}$, $\{B\}$ and $\{C\}$.
Given data
Transform
Describes
Rotation
Translation
$^{U}_{A}T$
$\{A\}$ in $\{U\}$
$R_{x}(-90^\circ)$
$(11,\,-1,\,8)$
$^{B}_{A}T$
$\{A\}$ in $\{B\}$
$R_{x}(+30^\circ)$
$(0,\,10,\,-20)$
$^{C}_{U}T$
$\{U\}$ in $\{C\}$
$R_{x}(+45^\circ)$
$(-3,\,-3,\,3)$
Find. (a) the frame diagram; (b) $^{B}_{C}T$, the description of $\{C\}$ relative to $\{B\}$.
Figure 2.1 — part (a). The frame diagram (frame graph) for the three given transformations, with the required link shown dashed. Each arrow runs from the reference frame to the frame being described.
Approach. Read a route from $\{B\}$ to $\{C\}$ off the frame diagram, invert the two links that are traversed against their arrows, and multiply in that order.
Draw the frame diagram (part a). Represent each of the four coordinate systems as a node and each given transformation as an arrow drawn from the reference frame to the frame it describes. The three given links are therefore $\{U\}\rightarrow\{A\}$, $\{B\}\rightarrow\{A\}$ and $\{C\}\rightarrow\{U\}$, as plotted in Figure 2.1. Drawing the graph before any algebra is not decoration: it shows at a glance that $\{A\}$ is a sink with two arrows entering it, which is precisely why the chain to $\{C\}$ cannot be written without inverting something.
Read the route and note which links run backwards. Travelling $\{B\}\rightarrow\{A\}\rightarrow\{U\}\rightarrow\{C\}$ uses $^{B}_{A}T$ forwards, then $^{U}_{A}T$ backwards, then $^{C}_{U}T$ backwards. Adjacent superscripts and subscripts must cancel:$$^{B}_{C}T = {}^{B}_{A}T\;\;{}^{A}_{U}T\;\;{}^{U}_{C}T= {}^{B}_{A}T\;\left({}^{U}_{A}T\right)^{-1}\left({}^{C}_{U}T\right)^{-1}.$$The inner indices pair off $A$ with $A$ and $U$ with $U$, leaving $B$ above and $C$ below, which is the required result. This index bookkeeping is the fastest available check that the product has been written in the correct order.
Invert the first backwards link. Using $T^{-1}=\begin{bmatrix}R^{T} & -R^{T}p\\ 0 & 1\end{bmatrix}$ with $R=R_{x}(-90^\circ)$ and $p=(11,-1,8)$:$$^{A}_{U}T=\left({}^{U}_{A}T\right)^{-1}=\begin{bmatrix}1&0&0&-11\\ 0&0&1&-8\\ 0&-1&0&-1\\ 0&0&0&1\end{bmatrix}.$$The all-integer result is a strong hint that the transcription is right, since the rotation here is an exact quarter turn.
Compose the first two links. Multiplying gives the description of $\{U\}$ relative to $\{B\}$:$$^{B}_{U}T={}^{B}_{A}T\;{}^{A}_{U}T=\begin{bmatrix}1&0&0&-11\\[2pt] 0&\tfrac{1}{2}&\tfrac{\sqrt{3}}{2}&\tfrac{21}{2}-4\sqrt{3}\\[2pt] 0&-\tfrac{\sqrt{3}}{2}&\tfrac{1}{2}&-24-\tfrac{\sqrt{3}}{2}\\[2pt] 0&0&0&1\end{bmatrix}=\begin{bmatrix}1&0&0&-11.000\\ 0&0.500&0.866&3.572\\ 0&-0.866&0.500&-24.866\\ 0&0&0&1\end{bmatrix}.$$Every rotation in this question is about the $x$ axis, so the composite rotation must also be a pure $x$ rotation — here $R_{x}(30^\circ-90^\circ)=R_{x}(-60^\circ)$, which the numbers confirm.
Invert the second backwards link and complete the product. With $R=R_{x}(45^\circ)$ and $p=(-3,-3,3)$,$$^{U}_{C}T=\left({}^{C}_{U}T\right)^{-1}=\begin{bmatrix}1&0&0&3\\[2pt] 0&\tfrac{\sqrt{2}}{2}&\tfrac{\sqrt{2}}{2}&0\\[2pt] 0&-\tfrac{\sqrt{2}}{2}&\tfrac{\sqrt{2}}{2}&-3\sqrt{2}\\[2pt] 0&0&0&1\end{bmatrix},$$and therefore $^{B}_{C}T={}^{B}_{U}T\;{}^{U}_{C}T$ evaluates to$$\boxed{^{B}_{C}T=\begin{bmatrix}1 & 0 & 0 & -8.000\\0 & -0.259 & 0.966 & -0.102\\0 & -0.966 & -0.259 & -26.987\\0 & 0 & 0 & 1\end{bmatrix}}$$
Verify the composite rotation against the sum of the individual turns. All three given rotations are about $x$, and rotations about a common axis simply add, so the answer must be $R_{x}(30^\circ-90^\circ-45^\circ)=R_{x}(-105^\circ)$. Indeed $\cos(-105^\circ)=\tfrac{\sqrt{2}-\sqrt{6}}{4}=-0.259$ and $\sin(-105^\circ)=-\tfrac{\sqrt{2}+\sqrt{6}}{4}=-0.966$, matching the boxed matrix exactly. The translation column checks out as the exact surds $\left(-8,\;\tfrac{21}{2}-4\sqrt{3}-\tfrac{3\sqrt{6}}{2},\;-24-\tfrac{3\sqrt{2}}{2}-\tfrac{\sqrt{3}}{2}\right)$. The $x$ translation is a whole number because no $x$ rotation can ever move the $x$ components out of alignment.
Question 2 — results
Part
Quantity
Result
(a)
frame diagram
Figure 2.1: $\{U\}\rightarrow\{A\}$, $\{B\}\rightarrow\{A\}$, $\{C\}\rightarrow\{U\}$; required link $\{B\}\rightarrow\{C\}$