Introducing Force Feedback into Model Predictive Control

In press, IEEE/RSJ IROS 2022 - International Conference on Intelligent Robots and Systems, 2022

HAL Paper
  • 1 LAAS-CNRS, Université de Toulouse, CNRS, Toulouse
  • 2 Tandon School of Engineering, New York University, Brooklyn, NY
  • 3 Artificial and Natural Intelligence Toulouse Institute, Toulouse
  • 4 Max Planck Institute for Intelligent Systems, Tübingen

Abstract

In the literature about model predictive control (MPC), contact forces are planned rather than controlled. In this paper, we propose a novel paradigm to incorporate effort measurements into a predictive controller, hence allowing to control them by direct measurement feedback. We first demonstrate why the classical optimal control formulation, based on position and velocity state feedback, cannot handle direct feedback on force information. Following previous approaches in force control, we then propose to augment the classical formulations with a model of the robot actuation, which naturally allows to generate online trajectories that adapt to sensed position, velocity and torques. We propose a complete implementation of this idea on the upper part of a real humanoid robot, and show through hardware experiments that this new formulation incorporating effort feedback outperforms classical MPC in challenging tasks where physical interaction with the environment is crucial.