Inverse-Dynamics MPC via Nullspace Resolution
Top Cited Papers
- 12 April 2023
- journal article
- research article
- Published by Institute of Electrical and Electronics Engineers (IEEE) in IEEE Transactions on Robotics
- Vol. 39 (4) , 3222-3241
Abstract
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 propose a novel approach to handle equality constraints based on nullspace parameterization. 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 modify our feasibility-driven search by incorporating a merit function. Furthermore, we introduce a condensed formulation of inverse dynamics that considers arbitrary actuator models. We also propose a novel MPC based on inverse dynamics within a perceptive locomotion framework. Finally, we present a theoretical comparison of OC with forward and inverse dynamics and evaluate both numerically. Our approach enables the first application of inverse-dynamics MPC on hardware, resulting in the 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}\boldsymbol{\%}$ ). 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 .Keywords
All Related Versions
Funding Information
- European Commission under the Horizon 2020 (780684)
- Natural Intelligence (101016970)
- Engineering and Physical Sciences Research Council
- Offshore Robotics for Certification of Assets (EP/R026173/1)
- Alan Turing Institute
This publication has 64 references indexed in Scilit:
- Learning, planning, and control for quadruped locomotion over challenging terrainThe International Journal of Robotics Research, 2010
- Fast Direct Multiple Shooting Algorithms for Optimal Robot Control2007
- An interior algorithm for nonlinear optimization that combines line search and trust region stepsMathematical Programming, 2005
- On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programmingMathematical Programming, 2005
- SNOPT: An SQP Algorithm for Large-Scale Constrained OptimizationSIAM Review, 2005
- An Interior Point Algorithm for Large-Scale Nonlinear ProgrammingSIAM Journal on Optimization, 1999
- Minimizing a differentiable function over a differential manifoldJournal of Optimization Theory and Applications, 1982
- Stabilization of constraints and integrals of motion in dynamical systemsComputer Methods in Applied Mechanics and Engineering, 1972
- A Second-order Gradient Method for Determining Optimal Trajectories of Non-linear Discrete-time SystemsInternational Journal of Control, 1966
- The theory of dynamic programmingBulletin of the American Mathematical Society, 1954