Rigid body dynamics with a scalable body, quaternions and perfect constraints

摘要

In this paper, we present a formulation of the quaternion constraint for rigid body rotations in the form of a standard perfect bilateral mechanical constraint, for which the associated Lagrangian multiplier has the meaning of a constraint force. First, the equations of motion of a scalable body are derived. A scalable body has three translational, three rotational, and one uniform scaling degree of freedom. As generalized coordinates, an unconstrained quaternion and a displacement vector are used. To the scalable body, a perfect bilateral constraint is added, restricting the quaternion to unit length and making the body rigid. This way a quaternion based differential algebraic equation (DAE) formulation for the dynamics of a rigid body is obtained, where the 7×7 mass matrix is regular and the unit length restriction of the quaternion is enforced by a mechanical constraint. Finally, the equations of motion in the form of a DAE are linked to the Newton–Euler equations of motion of a rigid body. The rigid body DAE formulation is useful for the construction of (energy) consistent integrators.