Dynamics of Serial Multibody Systems Using the Decoupled Natural Orthogonal Complement Matrices

Constrained dynamic equations of motion of serial multibody systems consisting of rigid bodies in a serial kinematic chain are derived in this paper. First, the Newton-Euler equations of motion of the decoupled rigid bodies of the system at hand are written. Then, with the aid of the decoupled natural orthogonal complement (DeNOC) matrices associated with the velocity constraints of the connecting bodies, the Euler-Lagrange independent equations of motion are derived. The De NOC is essentially the decoupled form of the natural orthogonal complement (NOC) matrix, introduced elsewhere. Whereas the use of the latter provides recursive order n—n being the degrees-of-freedom of the system at hand—inverse dynamics and order n³ forward dynamics algorithms, respectively, the former leads to recursive order n algorithms for both the cases. The order n algorithms are desirable not only for their computational efficiency but also for their numerical stability, particularly, in forward dynamics and simulation, where the system’s accelerations are solved from the dynamic equations of motion and subsequently integrated numerically. The algorithms are illustrated with a three-link three-degrees-of-freedom planar manipulator and a six-degrees-of-freedom Stanford arm.