Rigid Body Dynamic Simulation with Multiple Convex Contact Patches

We present a principled method for dynamic simulation of rigid bodies in intermittent contact with each other where the contact is assumed to be a non-convex contact patch that can be modeled as a union of convex patches. The prevalent assumption in simulating rigid bodies undergoing intermittent contact with each other is that the contact is a point contact. In recent work, we introduced an approach to simulate contacting rigid bodies with convex contact patches (line and surface contact). In this paper, for non-convex contact patches modeled as a union of convex patches, we formulate a discrete-time mixed complementarity problem where we solve the contact detection and integration of the equations of motion simultaneously. Thus, our method is a geometrically-implicit method and we prove that in our formulation, there is no artificial penetration between the contacting rigid bodies. We solve for the equivalent contact point (ECP) and contact impulse of each contact patch simultaneously along with the state, i.e., configuration and velocity of the objects. We provide empirical evidence to show that if the number of contact patches between two objects is less than or equal to three, the state evolution of the bodies is unique, although the contact impulses and ECP may not be unique. We also present simulation results showing that our method can seamlessly capture transition between different contact modes like non-convex patch to point (or line contact) and vice-versa during simulation.

[1]  Jeffrey C. Trinkle,et al.  A geometrically implicit time-stepping method for multibody systems with intermittent contact , 2014, Int. J. Robotics Res..

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

[3]  Per Lötstedt Mechanical Systems of Rigid Bodies Subject to Unilateral Constraints , 1982 .

[4]  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).

[5]  Jeffrey C. Trinkle,et al.  Complementarity formulations and existence of solutions of dynamic multi-rigid-body contact problems with coulomb friction , 1996, Math. Program..

[6]  M. Anitescu,et al.  Formulating Three-Dimensional Contact Dynamics Problems , 1996 .

[7]  Vijay Kumar,et al.  Design of part feeding and assembly processes with dynamics , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[8]  J. Trinkle,et al.  Dynamic multi-rigid-body systems with concurrent distributed contacts , 2001, Philosophical Transactions of the Royal Society of London. Series A: Mathematical, Physical and Engineering Sciences.

[9]  Alberto Rodriguez,et al.  Experimental Validation of Contact Dynamics for In-Hand Manipulation , 2016, ISER.

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

[11]  Jong-Shi Pang,et al.  A semi‐implicit time‐stepping model for frictional compliant contact problems , 2004 .

[12]  F. Facchinei,et al.  Finite-Dimensional Variational Inequalities and Complementarity Problems , 2003 .

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

[14]  Aaron M. Dollar,et al.  On dexterity and dexterous manipulation , 2011, 2011 15th International Conference on Advanced Robotics (ICAR).

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

[16]  Mark R. Cutkosky,et al.  Practical Force-Motion Models for Sliding Manipulation , 1996, Int. J. Robotics Res..

[17]  S. Dirkse,et al.  The path solver: a nommonotone stabilization scheme for mixed complementarity problems , 1995 .

[18]  Dylan A. Shell,et al.  Extensive analysis of Linear Complementarity Problem (LCP) solver performance on randomly generated rigid body contact problems , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[19]  Le Xuan Anh,et al.  Dynamics of Mechanical Systems with Coulomb Friction , 2003 .

[20]  Richard W. Cottle,et al.  Linear Complementarity Problem. , 1992 .

[21]  Emanuel Todorov,et al.  Convex and analytically-invertible dynamics with contacts and constraints: Theory and implementation in MuJoCo , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

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

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

[24]  Jiayin Xie,et al.  Rigid body dynamic simulation with line and surface contact , 2016, 2016 IEEE International Conference on Simulation, Modeling, and Programming for Autonomous Robots (SIMPAR).