An efficient, error-bounded approximation algorithm for simulating quasi-statics of complex linkages

Design and analysis of articulated mechanical structures, commonly referred to as linkages, is an integral part of any CAD/CAM system. The most common approaches formulate the problem as purely geometric in nature, though dynamics or quasi-statics of linkages should also be considered. Existing optimal algorithms that compute forward dynamics or quasi-statics of linkages have a linear runtime dependence on the number of joints in the linkage. When forces are applied to a linkage, these techniques need to compute the accelerations of all the joints and can become impractical for rapid prototyping of highly complex linkages with a large number of joints.We introduce a novel algorithm that enables adaptive refinement of the forward quasi-statics simulation of complex linkages. This algorithm can cull away joints whose contribution to the overall linkage motion is below a given user-defined threshold, thus limiting the computation of the joint accelerations and forces to those that contribute most to the overall motion. It also allows a natural trade-off between the precision of the resulting simulation and the time required to compute it. We have implemented our algorithm and tested its performance on complex benchmarks consisting of up to 50,000 joints. We demonstrate that in some cases our algorithm is able to achieve up to two orders of magnitude of performance improvement, while providing a high-precision, error-bounded approximation of the quasi-statics of the simulated linkage.

[1]  E. Haug,et al.  A recursive formulation constrained mechanical system dynamics. I: Open loop systems , 1987 .

[2]  Roy Featherstone,et al.  A Divide-and-Conquer Articulated-Body Algorithm for Parallel O(log(n)) Calculation of Rigid-Body Dynamics. Part 2: Trees, Loops, and Accuracy , 1999, Int. J. Robotics Res..

[3]  Abderrahmane Kheddar,et al.  Fast Continuous Collision Detection between Rigid Bodies , 2002, Comput. Graph. Forum.

[4]  William W. Hooker,et al.  The Dynamical Attitude Equations for n-Body Satellite , 1965 .

[5]  Roy Featherstone,et al.  Robot Dynamics Algorithms , 1987 .

[6]  Edward J. Haug,et al.  A Recursive Formation for Constrained Mechanical Systems Dynamics: Part I, Open Loop Systems , 1987 .

[7]  Roy Featherstone,et al.  A Divide-and-Conquer Articulated-Body Algorithm for Parallel O(log(n)) Calculation of Rigid-Body Dynamics. Part 1: Basic Algorithm , 1999, Int. J. Robotics Res..

[8]  Scott McMillan,et al.  Efficient computation of articulated-body inertias using successive axial screws , 1995, IEEE Trans. Robotics Autom..

[9]  John M. Hollerbach,et al.  A Recursive Lagrangian Formulation of Maniputator Dynamics and a Comparative Study of Dynamics Formulation Complexity , 1980, IEEE Transactions on Systems, Man, and Cybernetics.

[10]  P. Maisser,et al.  A Lie-Group Formulation of Kinematics and Dynamics of Constrained MBS and Its Application to Analytical Mechanics , 2003 .

[11]  Martin Otter,et al.  A very efficient algorithm for the simulation of robots and similar multibody systems without invers , 1986 .

[12]  Jean-Claude Latombe,et al.  Efficient maintenance and self-collision testing for Kinematic Chains , 2002, SCG '02.

[13]  David E. Orin,et al.  Robot dynamics: equations and algorithms , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[14]  Dinesh Manocha,et al.  Fast continuous collision detection for articulated models , 2004, SM '04.

[15]  E. Haug,et al.  A Recursive Formulation for Constrained Mechanical System Dynamics: Part II. Closed Loop Systems , 1987 .

[16]  Abhinandan Jain,et al.  A Spatial Operator Algebra for Manipulator Modeling and Control , 1989, Proceedings, 1989 International Conference on Robotics and Automation.

[17]  Amir Fijany,et al.  Parallel O(log N) algorithms for computation of manipulator forward dynamics , 1994, IEEE Trans. Robotics Autom..