Variable Horizon MPC With Swing Foot Dynamics for Bipedal Walking Control

In this letter, we present a novel two-level variable Horizon Model Predictive Control (VH-MPC) framework for bipedal locomotion. In this framework, the higher level computes the landing location and timing (horizon length) of the swing foot to stabilize the unstable part of the center of mass (CoM) dynamics, using feedback from the CoM states. The lower level takes into account the swing foot dynamics and generates dynamically consistent trajectories for landing at the desired time as close as possible to the desired location. To do that, we use a simplified model of the robot dynamics projected in swing foot space that takes into account joint torque constraints as well as the friction cone constraints of the stance foot. We show the effectiveness of our proposed control framework by implementing robust walking patterns on our torque-controlled and open-source biped robot, Bolt. We report extensive simulations and real robot experiments in the presence of various disturbances and uncertainties.

[1]  Rupak Majumdar,et al.  Shrinking Horizon Model Predictive Control With Signal Temporal Logic Constraints Under Stochastic Disturbances , 2017, IEEE Transactions on Automatic Control.

[2]  Christopher G. Atkeson,et al.  Robust dynamic walking using online foot step optimization , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[3]  Dmitry Berenson,et al.  Efficient Humanoid Contact Planning using Learned Centroidal Dynamics Prediction , 2018, 2019 International Conference on Robotics and Automation (ICRA).

[4]  Ludovic Righetti,et al.  Operational Space Control of Constrained and Underactuated Systems , 2011, Robotics: Science and Systems.

[5]  Andrei Herdt,et al.  Online Walking Motion Generation with Automatic Footstep Placement , 2010, Adv. Robotics.

[6]  Alin Albu-Schäffer,et al.  Three-Dimensional Bipedal Walking Control Based on Divergent Component of Motion , 2015, IEEE Transactions on Robotics.

[7]  Ludovic Righetti,et al.  Robust walking based on MPC with viability-based feasibility guarantees , 2020, ArXiv.

[8]  Chonhyon Park,et al.  An Efficient Acyclic Contact Planner for Multiped Robots , 2018, IEEE Transactions on Robotics.

[9]  Eiichi Yoshida,et al.  Generation of whole-body optimal dynamic multi-contact motions , 2013, Int. J. Robotics Res..

[10]  Hsiu-Chin Lin,et al.  An Optimization-Based Locomotion Controller for Quadruped Robots Leveraging Cartesian Impedance Control , 2020, Frontiers in Robotics and AI.

[11]  Kazuhito Yokoi,et al.  Biped walking pattern generation by using preview control of zero-moment point , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[12]  Graham C. Goodwin,et al.  Harmonic suppression and delay compensation for inverters via variable horizon nonlinear model predictive control , 2015, Int. J. Control.

[13]  Robin Deits,et al.  Footstep planning on uneven terrain with mixed-integer convex optimization , 2014, 2014 IEEE-RAS International Conference on Humanoid Robots.

[14]  Nicolas Mansard,et al.  Multicontact Locomotion of Legged Robots , 2018, IEEE Transactions on Robotics.

[15]  Alexander Herzog,et al.  Walking Control Based on Step Timing Adaptation , 2017, IEEE Transactions on Robotics.

[16]  Ludovic Righetti,et al.  An Open Torque-Controlled Modular Robot Architecture for Legged Locomotion Research , 2019, IEEE Robotics and Automation Letters.

[17]  T. B. Putsyata,et al.  Analytical dynamics , 1973 .

[18]  Gerardo Bledt,et al.  Extracting Legged Locomotion Heuristics with Regularized Predictive Control , 2020, 2020 IEEE International Conference on Robotics and Automation (ICRA).

[19]  Rohan C. Shekhar,et al.  Robust variable horizon MPC with move blocking , 2012, Syst. Control. Lett..

[20]  Jun-Ho Oh,et al.  A Robust Walking Controller Based on Online Optimization of Ankle, Hip, and Stepping Strategies , 2019, IEEE Transactions on Robotics.

[21]  Russ Tedrake,et al.  A direct method for trajectory optimization of rigid bodies through contact , 2014, Int. J. Robotics Res..

[22]  Pierre-Brice Wieber,et al.  Trajectory Free Linear Model Predictive Control for Stable Walking in the Presence of Strong Perturbations , 2006, 2006 6th IEEE-RAS International Conference on Humanoid Robots.

[23]  Jianwen Luo,et al.  Dynamic locomotion for passive-ankle biped robots and humanoids using whole-body locomotion control , 2019, Int. J. Robotics Res..

[24]  Emanuel Todorov,et al.  First-exit model predictive control of fast discontinuous dynamics: Application to ball bouncing , 2011, 2011 IEEE International Conference on Robotics and Automation.

[25]  Russ Tedrake,et al.  Planning robust walking motion on uneven terrain via convex optimization , 2016, 2016 IEEE-RAS 16th International Conference on Humanoid Robots (Humanoids).

[26]  Ludovic Righetti,et al.  Efficient Multicontact Pattern Generation With Sequential Convex Approximations of the Centroidal Dynamics , 2020, IEEE Transactions on Robotics.

[27]  Lorenzo Fagiano,et al.  Shrinking horizon parametrized predictive control with application to energy-efficient train operation , 2020, Autom..