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

05/11/2021
by   Shubham Singh, et al.
0

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.

READ FULL TEXT

page 1

page 2

page 3

page 4

research
03/03/2022

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

Optimization-based control methods for robots often rely on first-order ...
research
02/12/2023

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

Model-based control for robots has increasingly been dependent on optimi...
research
10/02/2020

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 ...
research
07/16/2020

Dynamics of Serial Manipulators using Dual Quaternion Algebra

This paper presents two approaches to obtain the dynamical equations of ...
research
03/10/2021

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

Derivatives of equations of motion describing the rigid body dynamics ar...
research
03/01/2022

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

This document provides full details of second-order partial derivatives ...
research
06/08/2021

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