Completing the state transition equation

Assume that the body frame of $ {\cal A}$ aligns with the principle axes. The remaining six equations of motion can finally be given in a nice form. Using (13.99), the expression (13.98) reduces to [681]

\begin{displaymath}\begin{split}\begin{pmatrix}N_1(u) \\ N_2(u) \\ N_3(u) \end{p...
...ix}\omega_1 \\ \omega_2 \\ \omega_3 \end{pmatrix} . \end{split}\end{displaymath} (13.100)

Multiplying out (13.100) yields

\begin{displaymath}\begin{split}{N}_1(u) & = I_{11} {\dot \omega}_1 + (I_{33}-I_...
...dot \omega}_3 + (I_{22}-I_{11}) \omega_1 \omega_2 . \end{split}\end{displaymath} (13.101)

To prepare for the state transition equation form, solving for $ {\dot \omega}$ yields

\begin{displaymath}\begin{split}{\dot \omega}_1 & = \big({N}_1(u) + (I_{22}-I_{3...
...) + (I_{11}-I_{22}) \omega_1 \omega_2\big)/I_{33} . \end{split}\end{displaymath} (13.102)

One final complication is that $ \omega$ needs to be related to angles that are used to express an element of $ SO(3)$. The mapping between these depends on the particular parameterization of $ SO(3)$. Suppose that quaternions of the form $ (a,b,c,d)$ are used to express rotation. Recall that $ a$ can be recovered once $ b$, $ c$, and $ d$ are given using $ a^2 + b^2 + c^2 + d^2 = 1$. The relationship between $ \omega$ and the time derivatives of the quaternion components is obtained by using (13.84) (see [690], p. 433):

\begin{displaymath}\begin{split}{\dot b}& = \omega_3 c - \omega_2 d \\ {\dot c}&...
...ega_3 b \\ {\dot d}& = \omega_2 b - \omega_1 c . \\ \end{split}\end{displaymath} (13.103)

This finally completes the specification of $ {\dot x}=
f(x,u)$, in which

$\displaystyle x = (p_1,p_2,p_3,v_1,v_2,v_3,b,c,d,\omega_1,\omega_2,\omega_3)$ (13.104)

is a twelve-dimensional phase vector. For convenience, the full specification of the state transition equation is

$\displaystyle {\dot p}_1$ $\displaystyle = v_1$ $\displaystyle \qquad {\dot b}$ $\displaystyle = \omega_3 c - \omega_2 d$    
$\displaystyle {\dot p}_2$ $\displaystyle = v_2$ $\displaystyle \qquad {\dot c}$ $\displaystyle = \omega_1 d - \omega_3 b$    
$\displaystyle {\dot p}_3$ $\displaystyle = v_3$ $\displaystyle \qquad {\dot d}$ $\displaystyle = \omega_2 b - \omega_1 c$ (13.105)
$\displaystyle {\dot v}_1$ $\displaystyle = {F}_1(u)/{m}$ $\displaystyle \qquad {\dot \omega}_1$ $\displaystyle = \big(N_1(u) + (I_{22}-I_{33}) \omega_2 \omega_3\big)/I_{11}$    
$\displaystyle {\dot v}_2$ $\displaystyle = {F}_2(u)/{m}$ $\displaystyle \qquad {\dot \omega}_2$ $\displaystyle = \big(N_2(u) + (I_{33}-I_{11}) \omega_3 \omega_1\big)/I_{22}$    
$\displaystyle {\dot v}_3$ $\displaystyle = {F}_3(u)/{m}$ $\displaystyle \qquad {\dot \omega}_3$ $\displaystyle = \big(N_3(u) + (I_{11}-I_{22}) \omega_1 \omega_2\big)/I_{33} .$    

The relationship between inertia matrices and ellipsoids is actually much deeper than presented here. The kinetic energy due to rotation only is elegantly expressed as

$\displaystyle T = \begin{matrix}\frac{1}{2} \end{matrix} \omega^T I \omega .$ (13.106)

A fascinating interpretation of rotational motion in the absence of external forces was given by Poinsot [39,681]. As the body rotates, its motion is equivalent to that of the inertia ellipsoid, given by (13.106), rolling (without sliding) down a plane with normal vector $ I \omega$ in $ {\mathbb{R}}^3$.

Steven M LaValle 2020-08-14