Skip to Main content Skip to Navigation
Conference papers

Proximal and Sparse Resolution of Constrained Dynamic Equations

Justin Carpentier 1 Rohan Budhiraja 1 Nicolas Mansard 2 
1 WILLOW - Models of visual object recognition and scene understanding
DI-ENS - Département d'informatique - ENS Paris, Inria de Paris
2 LAAS-GEPETTO - Équipe Mouvement des Systèmes Anthropomorphes
LAAS - Laboratoire d'analyse et d'architecture des systèmes
Abstract : Control of robots with kinematic constraints like loop-closure constraints or interactions with the environment requires solving the underlying constrained dynamics equations of motion. Several approaches have been proposed so far in the literature to solve these constrained optimization problems, for instance by either taking advantage in part of the sparsity of the kinematic tree or by considering an explicit formulation of the constraints in the problem resolution. Yet, not all the constraints allow an explicit formulation and in general, approaches of the state of the art suffer from singularity issues, especially in the context of redundant or singular constraints. In this paper, we propose a unified approach to solve forward dynamics equations involving constraints in an efficient, generic and robust manner. To this aim, we first (i) propose a proximal formulation of the constrained dynamics which converges to an optimal solution in the least-square sense even in the presence of singularities. Based on this proximal formulation, we introduce (ii) a sparse Cholesky factorization of the underlying Karush-Kuhn-Tucker matrix related to the constrained dynamics, which exploits at best the sparsity of the kinematic structure of the robot. We also show (iii) that it is possible to extract from this factorization the Cholesky decomposition associated to the so-called Operational Space Inertia Matrix, inherent to task-based control frameworks or physic simulations. These new formulation and factorization, implemented within the Pinocchio library, are benchmark on various robotic platforms, ranging from classic robotic arms or quadrupeds to humanoid robots with closed kinematic chains, and show how they significantly outperform alternative solutions of the state of the art by a factor 2 or more.
Document type :
Conference papers
Complete list of metadata

https://hal.inria.fr/hal-03271811
Contributor : Justin Carpentier Connect in order to contact the contributor
Submitted on : Sunday, June 27, 2021 - 4:45:44 PM
Last modification on : Monday, July 4, 2022 - 9:58:49 AM
Long-term archiving on: : Tuesday, September 28, 2021 - 11:02:56 PM

File

rss-proximal-and-sparse.pdf
Files produced by the author(s)

Identifiers

  • HAL Id : hal-03271811, version 1

Citation

Justin Carpentier, Rohan Budhiraja, Nicolas Mansard. Proximal and Sparse Resolution of Constrained Dynamic Equations. Robotics: Science and Systems 2021, Jul 2021, Austin / Virtual, United States. ⟨hal-03271811⟩

Share

Metrics

Record views

222

Files downloads

368