NivaarExam PrepOfficial exam papers ↗

22-Mec-B12 Robotics · December 2018

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.

Question 5: Orientations unattainable by a 3R mechanism with non-orthogonal twists (20 marks)

Question text not reproduced: the examination questions are © Engineers and Geoscientists BC. Open the official past paper (linked at the top of this page) to read the question, then follow the worked solution below.

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.

z of {0}(a) twists of 90°: nothing is lostz of {0}60°no z of {3}in this conereachable only outside the cone(b) twists of 60° and 120°
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.

  1. 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.
  2. 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.
  3. 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.
  4. 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.
  5. 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.
  6. 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
ItemResult
Polar angle reachable$|180^\circ-2\phi| \le e \le 180^\circ$
Unattainable orientationsall 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)