Forward Dynamics, Elimination Methods, and Formulation Stiffness in Robot Simulation

The numerical simulation problem of tree-structured multi body systems, such as robot manipulators, is usually treated as two separate problems: 1) the forward dynamics problem for computing system accelerations, and 2) the numerical integra tion problem for advancing the state in time. The interaction of these two problems can be important, and has led to new conclusions about the overall efficiency of multibody simula tion algorithms (Cloutier, Pai, and Ascher 1995). In particular, the fastest forward dynamics methods are not necessarily the most numerically stable, and in ill-conditioned cases may slow down popular adaptive step-size integration methods. This phenomenon is called formulation stiffness. In this article, we first unify the derivation of both the com posite rigid-body method (Walker and Orin 1982) and the articulated-body method (Featherstone 1983, 1987) as two elimination methods for solving the same linear system, with the articulated-body method taking advantage of sparsity. Then the numerical instability phenomenon for the composite rigid- body method is explained as a cancellation error that can be avoided, or at least minimized, when using an appropriate version of the articulated-body method. Specifically, we show that a variant of the articulated-body method is better suited to deal with certain types of ill-conditioning than the composite rigid-body method. The unified derivation also clarifies the un derlying linear algebra of forward dynamics algorithms, and is therefore of interest in its own right.