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

03/03/2022
by   Shubham Singh, et al.
0

Optimization-based control methods for robots often rely on first-order dynamics approximation methods like in iLQR. Using second-order approximations of the dynamics is expensive due to the costly second-order partial derivatives of dynamics with respect to the state and control. Current approaches for calculating these derivatives typically use automatic differentiation (AD) and chain-rule accumulation or finite-difference. In this paper, for the first time, we present closed-form analytical second-order partial derivatives of inverse dynamics for rigid-body systems with floating base and multi-DoF joints. A new extension of spatial vector algebra is proposed that enables the analysis. A recursive 𝒪(Nd^2) algorithm is also provided where N is the number of bodies and d is the depth of the kinematic tree. A comparison with AD in CasADi shows speedups of 1.5-3× for serial kinematic trees with N> 5, and a C++ implementation shows runtimes of ≈400μ s for a quadruped.

READ FULL TEXT

page 1

page 2

page 3

page 4

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
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
05/11/2021

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

Optimization algorithms are increasingly important for the control of ri...
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
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
01/01/2022

Fitting Matérn Smoothness Parameters Using Automatic Differentiation

The Matérn covariance function is ubiquitous in the application of Gauss...
research
09/10/2023

An Overview of Formulae for the Higher-Order Kinematics of Lower-Pair Chains with Applications in Robotics and Mechanism Theory

The motions of mechanisms can be described in terms of screw coordinates...

Please sign up or login with your details

Forgot password? Click here to reset