Analytical Derivatives of Rigid Body Dynamics Algorithms - LAAS - Laboratoire d'Analyse et d'Architecture des Systèmes Accéder directement au contenu
Communication Dans Un Congrès Année : 2018

Analytical Derivatives of Rigid Body Dynamics Algorithms

Résumé

Rigid body dynamics is a well-established framework in robotics. It can be used to expose the analytic form of kinematic and dynamic functions of the robot model. So far, two major algorithms, namely the recursive Newton-Euler algorithm (RNEA) and the articulated body algorithm (ABA), have been proposed to compute the inverse dynamics and the forward dynamics in a few microseconds. Evaluating their derivatives is an important challenge for various robotic applications (optimal control, estimation, co-design or reinforcement learning). However it remains time consuming, whether using finite differences or automatic differentiation. In this paper, we propose new algorithms to efficiently compute them thanks to closed-form formulations. Using the chain rule and adequate algebraic differentiation of spatial algebra, we firstly differentiate explicitly RNEA. Then, using properties about the derivative of function composition, we show that the same algorithm can also be used to compute the derivatives of ABA with a marginal additional cost. For this purpose, we introduce a new algorithm to compute the inverse of the joint-space inertia matrix, without explicitly computing the matrix itself. All the algorithms are implemented in our open-source C++ framework called Pinocchio. Benchmarks show computational costs varying between 3 microseconds (for a 7-dof arm) up to 17 microseconds (for a 36-dof humanoid), outperforming the alternative approaches of the state of the art.
Fichier principal
Vignette du fichier
18-rss-analytical-derivatives-carpentier.pdf (275.21 Ko) Télécharger le fichier
Origine : Fichiers produits par l'(les) auteur(s)
Loading...

Dates et versions

hal-01790971 , version 1 (14-05-2018)
hal-01790971 , version 2 (25-05-2018)

Identifiants

  • HAL Id : hal-01790971 , version 2

Citer

Justin Carpentier, Nicolas Mansard. Analytical Derivatives of Rigid Body Dynamics Algorithms. Robotics: Science and Systems (RSS 2018), Jun 2018, Pittsburgh, United States. ⟨hal-01790971v2⟩
1367 Consultations
448 Téléchargements

Partager

Gmail Facebook X LinkedIn More