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

06/08/2021
by   Sotaro Katayama, et al.
0

We propose an efficient way of solving optimal control problems for rigid-body systems on the basis of inverse dynamics and the multiple-shooting method. We treat all variables, including the state, acceleration, and control input torques, as optimization variables and treat the inverse dynamics as an equality constraint. We eliminate the update of the control input torques from the linear equation of Newton's method by applying condensing for inverse dynamics. The size of the resultant linear equation is the same as that of the multiple-shooting method based on forward dynamics except for the variables related to the passive joints and contacts. Compared with the conventional methods based on forward dynamics, the proposed method reduces the computational cost of the dynamics and their sensitivities by utilizing the recursive Newton-Euler algorithm (RNEA) and its partial derivatives. In addition, it increases the sparsity of the Hessian of the Karush-Kuhn-Tucker conditions, which reduces the computational cost, e.g., of Riccati recursion. Numerical experiments show that the proposed method outperforms state-of-the-art implementations of differential dynamic programming based on forward dynamics in terms of computational time and numerical robustness.

READ FULL TEXT

page 2

page 7

research
08/03/2021

Lifted contact dynamics for efficient direct optimal control of rigid body systems with contacts

We propose a novel and efficient lifting approach for the direct optimal...
research
09/12/2022

Inverse-Dynamics MPC via Nullspace Resolution

Optimal control (OC) using inverse dynamics provides numerical benefits ...
research
02/15/2023

Direct multiple shooting and direct collocation perform similarly in biomechanical predictive simulations

Direct multiple shooting (DMS) and direct collocation (DC) are two commo...
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
01/24/2020

Singularity-Free Inverse Dynamics for Underactuated Systems with a Rotating Mass

Underactuated systems consist of passive bodies/joints that don't have a...
research
12/14/2021

Structure-Exploiting Newton-Type Method for Optimal Control of Switched Systems

This study proposes an efficient Newton-type method for the optimal cont...
research
10/11/2020

Inverse Dynamics vs. Forward Dynamics in Direct Transcription Formulations for Trajectory Optimization

Benchmarks of state-of-the-art rigid-body dynamics libraries have report...

Please sign up or login with your details

Forgot password? Click here to reset