Fast Dynamic Simulation of Highly Articulated Robots with Contact via Θ(n2) Time Dense Generalized Inertia Matrix Inversion

  • Evan Drumwright
Part of the Lecture Notes in Computer Science book series (LNCS, volume 7628)


The generalized inertia matrix and its inverse are used extensively in robotics applications. While construction of the inertia matrix requires Θ(n 2) time, inverting it traditionally employs algorithms running in time O(n 3). We describe an algorithm that reduces the asymptotic time complexity of this operation to the theoretical minimum: Θ(n 2). We also present simple modifications that reduce the number of arithmetic operations (and thereby the running time). We compare our approach against fast Cholesky factorization both theoretically (using number of arithmetic operations) and empirically (using running times). We demonstrate our method to dynamically simulate a highly articulated robot undergoing contact, yielding an order of magnitude decrease in running time over existing methods.


Arithmetic Operation Inertia Matrix Cholesky Factorization Robot Dynamic Global Frame 
These keywords were added by machine and not by the authors. This process is experimental and the keywords may be updated as the learning algorithm improves.


Unable to display preview. Download preview PDF.

Unable to display preview. Download preview PDF.


  1. 1.
    Khatib, O.: A unified approach to motion and force control of robot manipulators: The operational space formulation. IEEE Journal on Robotics and Automation 3(1), 43–53 (1987)CrossRefGoogle Scholar
  2. 2.
    Walker, M.W., Orin, D.E.: Efficient dynamic computer simulation of robotic mechanisms. ASME J. Dynamic Systems, Measurement, and Control 104, 205–211 (1982)zbMATHCrossRefGoogle Scholar
  3. 3.
    Featherstone, R.: Robot Dynamics Algorithms. Kluwer (1987)Google Scholar
  4. 4.
    Hollerbach, J.M.: A recursive lagrangian formulation of manipulator dynamics and a comparative study of dynamics formulation complexity. IEEE Trans. Systems, Man, and Cybernetics SMC-10(11), 730–736 (1980)MathSciNetCrossRefGoogle Scholar
  5. 5.
    Featherstone, R.: The calculation of robot dynamics using articulated body inertias. Intl. J. Robotics Research 2(1), 13–30 (1983)CrossRefGoogle Scholar
  6. 6.
    Featherstone, R.: Rigid Body Dynamics Algorithms. Springer (2008)Google Scholar
  7. 7.
    Featherstone, R., Orin, D.: Robot dynamics: Equations and algorithms. In: Proc. of IEEE Intl. Conf. on Robotics and Automation, San Francisco, CA (April 2000)Google Scholar
  8. 8.
    Featherstone, R.: Efficient factorization of the joint space inertia matrix for branched kinematic trees. Intl. J. Robotics Research 24(6), 487–500 (2005)CrossRefGoogle Scholar
  9. 9.
    Baraff, D.: Linear-time dynamics using lagrange multipliers. In: Proc. of Computer Graphics, New Orleans, LA (August 1996)Google Scholar
  10. 10.
    Drumwright, E., Shell, D.A.: Modeling contact friction and joint friction in dynamic robotic simulation using the principle of maximum dissipation. In: Proc. of Workshop on the Algorithmic Foundations of Robotics, WAFR (2010)Google Scholar

Copyright information

© Springer-Verlag Berlin Heidelberg 2012

Authors and Affiliations

  • Evan Drumwright
    • 1
  1. 1.The George Washington UniversityWashington, D.C.USA

Personalised recommendations