Efficient Analytical Derivatives of Rigid-Body Dynamics using Spatial Vector Algebra

by   Shubham Singh, et al.

Optimization algorithms are increasingly important for the control of rigid-body systems. An essential requirement for these algorithms is the availability of accurate partial derivatives of the equations of motion with respect to the state and control variables. State of the art methods for calculating the derivatives use analytical differentiation methods based on the chain rule, and although these methods are an improvement over finite-difference in terms of accuracy, they are not always the most efficient. In this paper, we present an analytical method for calculating the first-order partial derivatives of rigid-body dynamics. The method uses Featherstone's spatial vector algebra and is presented in a recursive form similar to the Recursive-Newton Euler Algorithm (RNEA). Several dynamics identities and computational options are exploited for efficiency. The algorithms are bench-marked against competing approaches in Fortran and C++. Timing results are presented for kinematic trees with up to 500 links. As an example, the 100 link case leads to a 7x speedup over our Fortran implementation of the existing state-of-the-art method. Preliminary comparison of compute timings for the partial derivatives of inverse dynamics in C++ are also shown versus the existing Pinocchio framework. A speedup of 1.6x is reported for the 36-dof ATLAS humanoid using the new algorithm proposed in this paper.


page 1

page 2

page 3

page 4


Closed-Form Second-Order Partial Derivatives of Rigid-Body Inverse Dynamics

Optimization-based control methods for robots often rely on first-order ...

On Second-Order Derivatives of Rigid-Body Dynamics: Theory Implementation

Model-based control for robots has increasingly been dependent on optimi...

Numerical Methods to Compute the Coriolis Matrix and Christoffel Symbols for Rigid-Body Systems

The growth of model-based control strategies for robotics platforms has ...

Dynamics of Serial Manipulators using Dual Quaternion Algebra

This paper presents two approaches to obtain the dynamical equations of ...

Nth Order Analytical Time Derivatives of Inverse Dynamics in Recursive and Closed Forms

Derivatives of equations of motion describing the rigid body dynamics ar...

Details of Second-Order Partial Derivatives of Rigid-Body Inverse Dynamics

This document provides full details of second-order partial derivatives ...

Efficient solution method based on inverse dynamics for optimal control problems of rigid body systems

We propose an efficient way of solving optimal control problems for rigi...

Please sign up or login with your details

Forgot password? Click here to reset