An effective paradigm for simulating the dynamics of robots that locomote and manipulate is multi-rigid body simulation with rigid contact. This paradigm provides reasonable tradeoffs between accuracy, running time, and simplicity of parameter selection and identification. The Stewart-Trinkle Anitescu-Potra time stepping approach is the basis of many existing implementations. It successfully treats inconsistent (Painleve-type) contact configurations, efficiently handles many contact events occurring in short time intervals, and provably converges to the solution of the continuous time differential algebraic equations (DAEs) as the integration step size tends to zero. However, there is currently no means to determine when the solution has largely converged, i.e., when smaller integration steps would result in only small increases in accuracy. The present work describes an approach that computes the event times (when the set of active equations in a DAE changes) of all contact impact events for a multi-body simulation, toward using integration techniques with error control to compute a solution with desired accuracy. We also describe a first-order, variable integration approach that ensures that rigid bodies with convex polytopic geometries never interpenetrate. This approach permits taking large steps when possible and takes small steps when contact is complex.
We note that piecewise DAEs with unilateral constraints are generally modeled as differential variational inequalities (DVI) @cite_15 , which---for rigid body contact problems, at least---we find more challenging to pose, though existing solution approaches can work reasonably well. These approaches will be discussed in .
@cite_15
2075921599 2331982411 2109783572 2040973163
The present work extends the non-smooth contact class of algorithms introduced by to the case of friction. The formulation specifically addresses contact geometries, e.g. involving multiple collisions between tightly packed non-smooth bodies, for which neither normals nor gap functions can be properly defined. A key aspect of the approach is that the incremental displacements follow from a minimum principle. The objective function comprises terms which account for inertia, strain energy, contact, friction and external forcing. The Euler–Lagrange equations corresponding to this extended variational principle are shown to be consistent with the equations of motion of solids in frictional contact. In addition to its value as a basis for formulating numerical algorithms, the variational framework offers theoretical advantages as regards the selection of trajectories in cases of non-uniqueness. We present numerical and analytical examples which demonstrate the good momentum and energy conservation characteristics of the numerical algorithms, as well as the ability of the approach to account for stick and slip conditions. In this letter, we propose a two-stage strategy for optimal control problems of robotic mechanical systems that proves to be more robust, and yet more efficient, than straightforward solution strategies. Specifically, we focus on a simplified humanoid model, represented as a two-dimensional articulated serial chain of rigid bodies, in the tasks of getting up (sitting down) from (to) the supine and prone postures. Interactions with the environment are integral parts of these motions, and a priori unscheduled contact sequences are discovered by the solver itself, opportunistically making or breaking contacts with the ground through feet, knees, hips, elbows, and hands. The present investigation analyzes the effects on the computational performance of: 1) the explicit introduction of contact forces among the optimization variables, 2) the substitution of undesired contact forces with geometric constraints that prevent interpenetrations, and 3) the splitting of the planning problem into two consecutive phases of increasing complexity. To the best of our knowledge, these tests represent the only quantitative analysis of the performances achievable with different solution strategies for optimization-based, whole-body dynamic motion planning in the presence of contacts. This paper introduces and studies the class of differential variational inequalities (DVIs) in a finite-dimensional Euclidean space. The DVI provides a powerful modeling paradigm for many applied problems in which dynamics, inequalities, and discontinuities are present; examples of such problems include constrained time-dependent physical systems with unilateral constraints, differential Nash games, and hybrid engineering systems with variable structures. The DVI unifies several mathematical problem classes that include ordinary differential equations (ODEs) with smooth and discontinuous right-hand sides, differential algebraic equations (DAEs), dynamic complementarity systems, and evolutionary variational inequalities. Conditions are presented under which the DVI can be converted, either locally or globally, to an equivalent ODE with a Lipschitz continuous right-hand function. For DVIs that cannot be so converted, we consider their numerical resolution via an Euler time-stepping procedure, which involves the solution of a sequence of finite-dimensional variational inequalities. Borrowing results from differential inclusions (DIs) with upper semicontinuous, closed and convex valued multifunctions, we establish the convergence of such a procedure for solving initial-value DVIs. We also present a class of DVIs for which the theory of DIs is not directly applicable, and yet similar convergence can be established. Finally, we extend the method to a boundary-value DVI and provide conditions for the convergence of the method. The results in this paper pertain exclusively to systems with “index” not exceeding two and which have absolutely continuous solutions. The use of Coulomb's friction law with the principles of classical rigid-body dynamics introduces mathematical inconsistencies. Specifically, the forward dynamics problem can have no solutions or multiple solutions. In these situations, compliant contact models, while increasing the dimensionality of the state vector, can resolve these problems. The simplicity and efficiency of rigid-body models, however, provide strong motivation for their use during those portions of a simulation when the rigid-body solution is unique and stable. In this paper, we use singular perturbation analysis in conjunction with linear complementarity theory to establish conditions under which the solution predicted by the rigid-body dynamic model is stable. We employ a general model of contact compliance to derive stability criteria for planar mechanical systems. In particular, we show that for cases with one sliding contact, there is always at most one stable solution. Our approach is not directly applicable to transitions between rolling and sliding where the Coulomb friction law is discontinuous. To overcome this difficulty, we introduce a smooth nonlinear friction law, which approximates Coulomb friction. Such a friction model can also increase the efficiency of both rigid-body and compliant contact simulation. Numerical simulations for the different models and comparison with experimental results are also presented.