Question 5 of 7: Orientations unattainable by a 3R mechanism with non-orthogonal twists (20 marks)
Nivaar worked solution (AI-drafted; not reviewed by a licensed engineer)
Notes on this paper
Paper format. National Exams, December 2018 — 16-Mec-B12 Robotics. Closed book, three hours, one 8.5″×11″ two-sided formula sheet and an approved Casio or Sharp calculator permitted. Seven questions, each of equal value (20 marks); the rubric states that five questions constitute a complete paper and that only the first five in the answer book are marked. As a study resource all seven are solved here. Marks shown in parentheses are the printed sub-part values.
Notation. The paper's own nomenclature is used throughout: $\hat{X}_A,\hat{Y}_A,\hat{Z}_A$ are the unit vectors of frame $\{A\}$; a leading superscript as in ${}^{A}V$ names the frame the vector is referenced to; and ${}^{B}_{A}T$ is the transform of frame $\{A\}$ expressed relative to $\{B\}$. This is Craig's convention, so Craig's modified (distal) Denavit–Hartenberg parameters are used for the link tables.
Reference texts.
Craig, J. J., Introduction to Robotics: Mechanics and Control, 4th ed., Pearson, 2018 — the notation, the Z–Y–Z Euler convention and the two-segment cubic spline of Question 7 all follow this text (Ch. 2, 3, 5 and 7).
Spong, M. W., Hutchinson, S. and Vidyasagar, M., Robot Modeling and Control, 2nd ed., Wiley, 2020 — alternative treatment of DH assignment and Jacobian singularities (Ch. 3, 4).
Niku, S. B., Introduction to Robotics: Analysis, Control, Applications, 3rd ed., Wiley, 2020 — worked frame-graph and trajectory examples.
Siciliano, B., Sciavicco, L., Villani, L. and Oriolo, G., Robotics: Modelling, Planning and Control, Springer, 2009 — differential kinematics and statics duality (Ch. 3).
Question 5: Orientations unattainable by a 3R mechanism with non-orthogonal twists (20 marks)
Given. A 3R wrist whose three axes meet at a fixed point, with link twists $\alpha_1 = \phi$ and $\alpha_2 = 180^\circ-\phi$, $\phi \neq 90^\circ$; all three joints turn freely through $360^\circ$ and self-collision is ignored.
Find. A geometric description of the orientations of link 3 that the mechanism cannot reach.
Figure 5.1 — the reachable directions of the link-3 axis. With $90^\circ$ twists (left) the axis sweeps the whole sphere; with twists of $\phi$ and $180^\circ-\phi$ (right, drawn for $\phi = 60^\circ$) a polar cone of half-angle $|180^\circ-2\phi|$ about $\hat{Z}_0$ is unreachable.
Approach. Separate the orientation into the direction of the link-3 axis and the spin about it; show that joints 1 and 3 supply the spin and azimuth freely, so the whole restriction falls on the polar angle that joint 2 controls, and bound that angle with the spherical law of cosines.
Decompose the orientation. Any orientation of link 3 can be described by the direction of its own axis $\hat{Z}_3$ (two parameters, a point on the unit sphere) plus a roll about that axis (one parameter). Joint 3 rotates link 3 about $\hat{Z}_3$, so the roll is always free; joint 1 rotates the whole chain about the fixed axis $\hat{Z}_1 = \hat{Z}_0$, so the azimuth of $\hat{Z}_3$ about $\hat{Z}_0$ is always free. Whatever cannot be reached must therefore be a restriction on the single remaining number: the polar angle $e$ between $\hat{Z}_0$ and $\hat{Z}_3$, which only joint 2 can change.
Set up the spherical triangle. Project the three joint axes onto a unit sphere centred on the common intersection point. The twists are the fixed arc lengths between neighbouring axes: $\hat{Z}_1$ to $\hat{Z}_2$ subtends $\alpha_1 = \phi$, and $\hat{Z}_2$ to $\hat{Z}_3$ subtends $\alpha_2 = 180^\circ - \phi$. Turning joint 2 by $\theta_2$ swings $\hat{Z}_3$ around $\hat{Z}_2$ on a cone, changing only the angle at the vertex $\hat{Z}_2$ of that triangle.
Apply the spherical law of cosines. For the triangle with sides $\alpha_1$ and $\alpha_2$ and included angle $\theta_2$,
$$ \cos e = \cos\alpha_1\cos\alpha_2 + \sin\alpha_1\sin\alpha_2\cos\theta_2 = -\cos^{2}\phi + \sin^{2}\phi\,\cos\theta_2, $$
using $\cos(180^\circ-\phi) = -\cos\phi$ and $\sin(180^\circ-\phi) = \sin\phi$. Here $\theta_2$ is measured from the configuration in which the two twist planes coincide.
Bound the polar angle. As $\theta_2$ runs through a full turn, $\cos\theta_2$ covers $[-1,1]$, so
$$ \cos e \in \left[-\cos^{2}\phi-\sin^{2}\phi,\ -\cos^{2}\phi+\sin^{2}\phi\right] = \left[-1,\ -\cos 2\phi\right], $$
and therefore
$$ \boxed{\,|180^\circ-2\phi| \le e \le 180^\circ\,}. $$
The upper limit is always reached (the two twists then add to a straight angle and $\hat{Z}_3$ points opposite $\hat{Z}_0$); the lower limit is the obstruction.
State the unattainable set. The mechanism can never place the link-3 axis closer than $|180^\circ-2\phi|$ to the fixed axis $\hat{Z}_0$. Writing an orientation as a rotation matrix ${}^{0}_{3}R$ whose third column is $\hat{Z}_3$ expressed in $\{0\}$, the unattainable set is
$$ \Big\{\,{}^{0}_{3}R \ :\ \angle\big(\hat{Z}_0,\ {}^{0}_{3}R\,\hat{Z}\big) \ \lt\ |180^\circ-2\phi| \,\Big\}, $$
that is, every orientation in which link 3 points into the polar cone of half-angle $|180^\circ-2\phi|$ around the base axis — including the case where link 3 is parallel to link 0's axis. Outside that cone every orientation is reachable, because joints 1 and 3 then supply the remaining two degrees of freedom.
Check the limiting cases and quantify the loss. Setting $\phi = 90^\circ$ gives a forbidden half-angle of $0^\circ$: the cone collapses, which is precisely the Z–Y–Z Euler mechanism of Figure 2(a) that reaches everything. For $\phi = 60^\circ$ the cone has half-angle $60^\circ$ and, since a spherical cap of half-angle $\gamma$ occupies a fraction $(1-\cos\gamma)/2$ of all directions, $\boxed{25\%}$ of axis directions are lost; at $\phi = 45^\circ$ the half-angle is $90^\circ$ and a full hemisphere — half of all directions — is unreachable. The further $\phi$ strays from $90^\circ$, the worse the wrist becomes.
Question 5 — results
Item
Result
Polar angle reachable
$|180^\circ-2\phi| \le e \le 180^\circ$
Unattainable orientations
all those with $\hat{Z}_3$ inside the polar cone of half-angle $|180^\circ-2\phi|$ about $\hat{Z}_0$
$\phi = 90^\circ$ (Figure 2a)
cone half-angle $0^\circ$ — nothing lost
$\phi = 60^\circ$
cone half-angle $60^\circ$; 25 % of axis directions lost
$\phi = 45^\circ$
cone half-angle $90^\circ$; 50 % lost (a hemisphere)