Computationally efficient algorithm for the dynamics of multi-link mechanisms

A computationally efficient algorithm for the dynamics of multi-rigid-link mechanisms is presented which is applicable to on-board processing for robotic manipulator control systems. A formulation of the equations of motion for such systems is presented which results in a solution algorithm of the order the number of system degrees of freedom. The formulation is presented for tree topology systems, where the chain topology of typical manipulators is a subset. Comparison of this algorithm is made with existing multibody simulation programs to illustrate the increased computational efficiency.