13.4.1.4 Procedure for deriving the state transition equation

The following general procedure can be followed to derive the differential model using Lagrangian mechanics on a coordinate neighborhood of a smooth $ n$-dimensional manifold:

  1. Determine the degrees of freedom of the system and define the appropriate $ n$-dimensional smooth manifold $ {\cal C}$.
  2. Express the kinetic energy as a quadratic form in the configuration velocity components:

    $\displaystyle K(q,{\dot q}) = \frac{1}{2} {\dot q}^T M(q) {\dot q}= \frac{1}{2} \sum_{i=1}^n \sum_{j=1}^n m_{ij}(q) {\dot q}_i {\dot q}_j .$ (13.137)

  3. Express the potential energy $ V(q)$.
  4. Let $ L(q,{\dot q}) = K(q,{\dot q}) - V(q)$ be the Lagrangian function, and use the Euler-Lagrange equation (13.130) to determine the differential constraints.
  5. Convert to phase space form by letting $ x = (q,{\dot q})$. If possible, solve for $ {\dot x}$ to obtain $ {\dot x}=
f(x,u)$.

Example 13..12 (2D Rigid Body Revisited)  

The equations in (13.109) can be alternatively derived using the Euler-Lagrange equation. Let $ {\cal C}= {\mathbb{R}}^2 \times {\mathbb{S}}^1$, and let $ (q_1,q_2,q_3) = (x,y,\theta)$ to conform to the notation used to express the Lagrangian.

The kinetic energy is the sum of kinetic energies due to linear and angular velocities, respectively. This yields

$\displaystyle K(q,{\dot q}) = \begin{matrix}\frac{1}{2} \end{matrix} m {\dot q}\cdot {\dot q}+ \begin{matrix}\frac{1}{2} \end{matrix} I {\dot q}_3^2 ,$ (13.138)

in which $ m$ and $ I$ are the mass and moment of inertia, respectively. Assume there is no gravity; hence, $ V(q) = 0$ and $ L(q,{\dot q}) =
K(q,{\dot q})$.

Suppose that generalized forces $ u_1$, $ u_2$, and $ u_3$ can be applied to the configuration variables. Applying the Euler-Lagrange equation to $ L(q,{\dot q})$ yields

\begin{displaymath}\begin{split}\frac{d}{dt} \frac{\partial L}{\partial {\dot q}...
...rac{d}{dt} (I {\dot q}_3) = I {\ddot q}_3 = u_3.  \end{split}\end{displaymath} (13.139)

These expressions are equivalent to those given in (13.109). One difference is that conversion to the phase space is needed. The second difference is that the action variables in (13.139) do not refer directly to forces and moments. They are instead interpreted as generalized forces that act on the configuration variables. A conversion should be performed if the original actions in (13.109) are required. $ \blacksquare$

Steven M LaValle 2012-04-20