DeepAI AI Chat
Log In Sign Up

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

03/03/2022
by   Shubham Singh, et al.
The University of Texas at Austin
University of Notre Dame
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

02/12/2023

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

Model-based control for robots has increasingly been dependent on optimi...
03/01/2022

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

This document provides full details of second-order partial derivatives ...
05/11/2021

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

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

Fitting Matérn Smoothness Parameters Using Automatic Differentiation

The Matérn covariance function is ubiquitous in the application of Gauss...
02/17/2023

A Legendre-Gauss Pseudospectral Collocation Method for Trajectory Optimization in Second Order Systems

Pseudospectral collocation methods have proven to be powerful tools to s...