Interactive Dynamic Simulator for Multibody Systems

We propose an interactive dynamic simulator for humanoid robots using constraint-based methods for computing interaction forces with friction. This simulator is a part of a general framework for prototyping called AMELIF and is a successful integration of physical models. We focus on optimizing the computation of the dynamics to obtain real-time simulations allowing multimodal interactivity. Our simulator has been validated in two ways: first by comparing real sensors' measures and simulated values, then through different scenarios of complex manipulation tasks on the HRP-2 humanoid robot, bringing new insights to interactive robotics.

[1]  Shuuji Kajita,et al.  Constraint-based dynamics simulator for humanoid robots with shock absorbing mechanisms , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[2]  Kazuhito Yokoi,et al.  Dynamic lifting by whole body motion of humanoid robots , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[3]  Elmar Schömer,et al.  A constraint-based approach to rigid body dynamics for virtual reality applications , 1998, VRST '98.

[4]  Christian Duriez,et al.  Realistic haptic rendering of interacting deformable objects in virtual environments , 2008, IEEE Transactions on Visualization and Computer Graphics.

[5]  Katsu Yamane,et al.  Stable penalty-based model of frictional contacts , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[6]  M. Anitescu,et al.  Formulating Dynamic Multi-Rigid-Body Contact Problems with Friction as Solvable Linear Complementarity Problems , 1997 .

[7]  D. Stewart,et al.  AN IMPLICIT TIME-STEPPING SCHEME FOR RIGID BODY DYNAMICS WITH INELASTIC COLLISIONS AND COULOMB FRICTION , 1996 .

[8]  J. Moreau,et al.  Unilateral Contact and Dry Friction in Finite Freedom Dynamics , 1988 .

[9]  David C. Brogan,et al.  Animating human athletics , 1995, SIGGRAPH.

[10]  John Kenneth Salisbury,et al.  A constraint-based god-object method for haptic display , 1995, Proceedings 1995 IEEE/RSJ International Conference on Intelligent Robots and Systems. Human Robot Interaction and Cooperative Robots.

[11]  Masahiro Fujita,et al.  Motion control of a virtual humanoid that can perform real physical interactions with a human , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[12]  Dinesh K. Pai,et al.  Fast frictional dynamics for rigid bodies , 2005, ACM Trans. Graph..

[13]  Oussama Khatib,et al.  Efficient algorithm for extended operational space inertia matrix , 1999, Proceedings 1999 IEEE/RSJ International Conference on Intelligent Robots and Systems. Human and Environment Friendly Robots with High Intelligence and Emotional Quotients (Cat. No.99CH36289).

[14]  David E. Orin,et al.  Efficient Dynamic Computer Simulation of Robotic Mechanisms , 1982 .

[15]  Oussama Khatib,et al.  A unified approach for motion and force control of robot manipulators: The operational space formulation , 1987, IEEE J. Robotics Autom..

[16]  Shuuji Kajita,et al.  OpenHRP: Open Architecture Humanoid Robotics Platform , 2004, Int. J. Robotics Res..

[17]  P. Alart,et al.  A mixed formulation for frictional contact problems prone to Newton like solution methods , 1991 .

[18]  Yasuo Kuniyoshi,et al.  Humanoid robot which can lift a 30kg box by whole body contact and tactile feedback , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[19]  B. Brogliato,et al.  Numerical simulation of finite dimensional multibody nonsmooth mechanical systems , 2001 .

[20]  B. Brogliato,et al.  Numerical Methods for Nonsmooth Dynamical Systems: Applications in Mechanics and Electronics , 2008 .

[21]  Henrik I. Christensen,et al.  Implementation of multi-rigid-body dynamics within a robotic grasping simulator , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[22]  Kurt S. Anderson,et al.  Highly Parallelizable Low-Order Dynamics Simulation Algorithm for Multi-Rigid-Body Systems , 2000 .

[23]  M. Anitescu,et al.  A Time-stepping Method for Stii Multibody Dynamics with Contact and Friction ‡ , 2022 .

[24]  Wolfram Burgard,et al.  Robotics: Science and Systems XV , 2010 .

[25]  Paolo Fiorini,et al.  Simulation of deformable environment with haptic feedback on GPU , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[27]  Stephane Cotin,et al.  EP4A: Software and Computer Based Simulator Research: Development and Outlook SOFA—An Open Source Framework for Medical Simulation , 2007, MMVR.

[28]  David Baraff,et al.  Fast contact force computation for nonpenetrating rigid bodies , 1994, SIGGRAPH.

[29]  K. G. Murty,et al.  LINEAR COMPLEMENTARITY � LINEAR AND NONLINEAR PROGRAMMING Internet Edition , 2006 .

[30]  Jérémie Allard,et al.  Image-based collision detection and response between arbitrary volume objects , 2008, SCA '08.

[31]  Kazuhito Yokoi,et al.  Dynamic Lifting Motion of Humanoid Robots , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[32]  Petros Faloutsos,et al.  A dynamic controller toolkit , 2007, Sandbox '07.

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

[34]  Carlos Canudas de Wit,et al.  Friction Models and Friction Compensation , 1998, Eur. J. Control.

[35]  Yoshihiko Nakamura,et al.  Efficient parallel dynamics computation of human figures , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[36]  J. Trinkle,et al.  On Dynamic Multi‐Rigid‐Body Contact Problems with Coulomb Friction , 1995 .

[37]  Kazuhito Yokoi,et al.  Dynamic simulator for humanoids using constraint-based method with static friction , 2006, 2006 IEEE International Conference on Robotics and Biomimetics.

[38]  Makoto Sato,et al.  Real‐time Rigid Body Simulation for Haptic Interactions Based on Contact Volume of Polygonal Objects , 2004, Comput. Graph. Forum.

[39]  F. Jourdan,et al.  A Gauss-Seidel like algorithm to solve frictional contact problems , 1998 .

[40]  Brian Mirtich,et al.  Impulse-based dynamic simulation of rigid body systems , 1996 .

[41]  Kazuhito Yokoi,et al.  Development of a software for motion optimization of robots - Application to the kick motion of the HRP-2 robot , 2006, 2006 IEEE International Conference on Robotics and Biomimetics.

[42]  Friedrich Pfeiffer,et al.  Multibody Dynamics with Unilateral Contacts , 1996 .

[43]  J. Hodgins,et al.  Animating Human Athletes , 1998 .

[44]  Nancy M. Amato,et al.  A generalized framework for interactive dynamic simulation for multirigid bodies , 2004, IEEE Transactions on Systems, Man, and Cybernetics, Part B (Cybernetics).

[45]  John E. Lloyd,et al.  Fast Implementation of Lemke's Algorithm for Rigid Body Contact Simulation , 2005, ICRA.

[46]  Tong Liu,et al.  Computation of three-dimensional rigid-body dynamics with multiple unilateral contacts using time-stepping and Gauss-Seidel methods , 2005, IEEE Transactions on Automation Science and Engineering.

[47]  A. Kheddar,et al.  Framework for haptic interaction with virtual avatars , 2008, RO-MAN 2008 - The 17th IEEE International Symposium on Robot and Human Interactive Communication.

[48]  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..

[49]  Mihai Anitescu,et al.  A linearly implicit trapezoidal method for integrating stiff multibody dynamics with contact, joints, and friction , 2006 .

[50]  Oussama Khatib,et al.  A framework for multi-contact multi-body dynamic simulation and haptic display , 2000, Proceedings. 2000 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2000) (Cat. No.00CH37113).

[51]  Christian Studer,et al.  Augmented Time-Stepping Integration of Non-Smooth Dynamical Systems , 2008 .

[52]  Gordon Cheng,et al.  Highly Precise Dynamic Simulation Environment for Humanoid Robots , 2008, Adv. Robotics.

[53]  F. Faure,et al.  Volume contact constraints at arbitrary resolution , 2010, ACM Trans. Graph..

[54]  Evangelos Kokkevis,et al.  Practical Physics for Articulated Characters , 2004 .

[55]  Roy Featherstone,et al.  Rigid Body Dynamics Algorithms , 2007 .

[56]  Atsushi Konno,et al.  An order n dynamic simulator for a humanoid robot with a virtual spring-damper contact model , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[57]  V. Acary,et al.  An introduction to Siconos , 2007 .

[58]  Oussama Khatib,et al.  Collision/Contact Models for Dynamic Simulation and Haptic Interaction , 2000 .

[59]  Kazuhito Yokoi,et al.  Whole-body motion of a humanoid robot for passing through a door - opening a door by impulsive force - , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[60]  Ronald Fedkiw,et al.  Dynamic simulation of articulated rigid bodies with contact and collision , 2006, IEEE Transactions on Visualization and Computer Graphics.

[61]  Vincent Acary,et al.  Numerical Methods for Nonsmooth Dynamical Systems: Applications in Mechanics and Electronics , 2008 .

[62]  Dinesh K. Pai,et al.  Staggered projections for frictional contact in multibody systems , 2008, SIGGRAPH 2008.

[63]  Gordon Wyeth,et al.  Semi-analytic method of contact modelling , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[64]  Katta G. Murty,et al.  Linear complementarity, linear and nonlinear programming , 1988 .

[65]  Vincent Acary,et al.  3D frictional contact and impact multibody dynamics. A comparison of algorithms suitable for real-time applications , 2005 .

[66]  Katsu Yamane,et al.  Automatic Scheduling for Parallel Forward Dynamics Computation of Open Kinematic Chains , 2007, Robotics: Science and Systems.

[67]  Jeffrey C. Trinkle,et al.  An implicit time-stepping scheme for rigid body dynamics with Coulomb friction , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).