DeepAI AI Chat
Log In Sign Up

Inverse-Dynamics MPC via Nullspace Resolution

by   Carlos Mastalli, et al.
University of Pisa
Heriot-Watt University

Optimal control (OC) using inverse dynamics provides numerical benefits such as coarse optimization, cheaper computation of derivatives, and a high convergence rate. However, to take advantage of these benefits in model predictive control (MPC) for legged robots, it is crucial to handle efficiently its large number of equality constraints. To accomplish this, we first (i) propose a novel approach to handle equality constraints based on nullspace parametrization. Our approach balances optimality, and both dynamics and equality-constraint feasibility appropriately, which increases the basin of attraction to high-quality local minima. To do so, we (ii) modify our feasibility-driven search by incorporating a merit function. Furthermore, we introduce (iii) a condensed formulation of inverse dynamics that considers arbitrary actuator models. We also propose (iv) a novel MPC based on inverse dynamics within a perceptive locomotion framework. Finally, we present (v) a theoretical comparison of optimal control with forward and inverse dynamics and evaluate both numerically. Our approach enables the first application of inverse-dynamics MPC on hardware, resulting in state-of-the-art dynamic climbing on the ANYmal robot. We benchmark it over a wide range of robotics problems and generate agile and complex maneuvers. We show the computational reduction of our nullspace resolution and condensed formulation (up to 47.3 We provide evidence of the benefits of our approach by solving coarse optimization problems with a high convergence rate (up to 10 Hz of discretization). Our algorithm is publicly available inside CROCODDYL.


page 1

page 2

page 10

page 12

page 14

page 15

page 16

page 18


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...

Robust walking based on MPC with viability-based feasibility guarantees

Model predictive control (MPC) has shown great success for controlling c...

Adaptive Complexity Model Predictive Control

This work introduces a formulation of model predictive control (MPC) whi...

Quadrupedal Locomotion via Event-Based Predictive Control and QP-Based Virtual Constraints

This paper aims to develop a hierarchical nonlinear control algorithm, b...

An Error-State Model Predictive Control on Connected Matrix Lie Groups for Legged Robot Control

This paper reports on a new error-state Model Predictive Control (MPC) a...

Reduction of the Number of Variables in Parametric Constrained Least-Squares Problems

For linearly constrained least-squares problems that depend on a vector ...

Learning Solution Manifolds for Control Problems via Energy Minimization

A variety of control tasks such as inverse kinematics (IK), trajectory o...