Rigid body dynamic simulation with line and surface contact

In this paper, we develop a principled method to model line and surface contact with point contacts that is consistent with physics-based models of surface (line) contact. We solve the contact detection and dynamic simulation step simultaneously by formulating the problem as a mixed nonlinear complementarity problem. This allows us to simultaneously compute the centre of pressure as well as the forces at the centre of pressure (consistent with the friction model) along with the configuration and velocities of the rigid objects. We present a geometrically implicit time-stepping scheme for dynamic simulation for contacts between two bodies with convex contact area, which includes 2D line contact, 3D surface contact, and 3D line contact. We prove that for surface and line contact, for any value of the velocity of center of mass of the object, there is a unique solution for contact point and contact wrench that satisfies the discrete-time equations of motion. For pure translation and pure rotation, we show that there is a closed form solution for each discrete time-step if the contact mode does not change. Simulation examples are shown to demonstrate the validity of our approach and show that with our approach we can seamlessly transition between point, line, and surface contacts.

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

[2]  Olivier Bruls,et al.  On the Constraints Formulation in the Nonsmooth Generalized-$$\alpha $$ Method , 2018 .

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

[4]  Imin Kao,et al.  Quasistatic Manipulation with Compliance and Sliding , 1992 .

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

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

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

[8]  Jong-Shi Pang,et al.  Differential variational inequalities , 2008, Math. Program..

[9]  Michael A. Erdmann,et al.  On a Representation of Friction in Configuration Space , 1994, Int. J. Robotics Res..

[10]  Matthew T. Mason,et al.  Mechanics of Robotic Manipulation , 2001 .

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

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

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

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

[15]  T. Laursen Computational Contact and Impact Mechanics: Fundamentals of Modeling Interfacial Phenomena in Nonlinear Finite Element Analysis , 2002 .

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

[17]  M. Jean,et al.  Dynamics in the Presence of Unilateral Contacts and Dry Friction: A Numerical Approach , 1987 .

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

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

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

[21]  A. Ruina,et al.  Planar sliding with dry friction Part 1. Limit surface and moment function , 1991 .

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

[23]  H. Nijmeijer,et al.  Dynamics and Bifurcations ofNon - Smooth Mechanical Systems , 2006 .

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

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

[26]  Vincent Acary,et al.  Half-explicit timestepping schemes on velocity level based on time-discontinuous Galerkin methods , 2015 .

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

[28]  S. Shankar Sastry,et al.  A mathematical introduction to robotics manipulation , 1994 .

[29]  Thomas J. R. Hughes,et al.  Encyclopedia of computational mechanics , 2004 .

[30]  G. Capobianco,et al.  Time finite element based Moreau‐type integrators , 2018 .

[31]  Laetitia Paoli,et al.  A numerical scheme for impact problems , 1999 .

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

[33]  Peter Wriggers,et al.  Computational Contact Mechanics , 2002 .

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

[35]  Wolfram Burgard,et al.  An Implicit Time-Stepping Method for Multibody Systems with Intermittent Contact , 2008 .

[36]  Arthur C. Sanderson,et al.  The motion of a pushed, sliding workpiece , 1988, IEEE J. Robotics Autom..

[37]  Kevin M. Lynch,et al.  Stable Pushing: Mechanics, Controllability, and Planning , 1995, Int. J. Robotics Res..

[38]  Christian Studer,et al.  Numerics of Unilateral Contacts and Friction , 2009 .

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

[40]  Arthur C. Sanderson,et al.  Planning robotic manipulation strategies for workpieces that slide , 1988, IEEE J. Robotics Autom..

[41]  Alberto Rodriguez,et al.  Prehensile pushing: In-hand manipulation with push-primitives , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

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

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

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

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