A Singularity-Free Penalty Formulation for the Dynamics of Constrained Multibody Systems
Abstract In a singular position, the number of degrees of freedom of a mechanism instantaneously increases, which is detected by a sudden loss of rank in the jacobian matrix. This rank-deficiency causes the failure of the classical dynamic formulations. The enforcement of the constraints through a penalty method leads to an attractive and efficient dynamic formulation that, in addition, can be used at singularities. This formulation leads to a symmetric and positive definite matrix whose rank does not depend on the rank of the jacobian and thus is ideally suited for singular positions. A refinement of this approach is achieved through an augmented Lagrangian method. A simple example and two dynamic simulations show the effectiveness of the formulation.