Dynamic walking over rough terrains by nonlinear predictive control of the floating-base inverted pendulum

We present a real-time pattern generator for dynamic walking over rough terrains. Our method automatically finds step durations, a critical issue over rough terrains where they depend on terrain topology. To achieve this level of generality, we consider a Floating-base Inverted Pendulum (FIP) model where the center of mass can translate freely and the zero-tilting moment point is allowed to leave the contact surface. This model is equivalent to a linear inverted pendulum with variable center-of-mass height, but its equations of motion remain linear. Our solution then follows three steps: (i) we characterize the FIP contact-stability condition; (ii) we compute feedforward controls by solving a nonlinear optimization over receding-horizon FIP trajectories. Despite running at 30 Hz in a model-predictive fashion, simulations show that the latter is too slow to stabilize dynamic motions. To remedy this, we (iii) linearize FIP feedback control into a constrained linear-quadratic regulator that runs at 300 Hz. We finally demonstrate our solution in simulations with a model of the HRP-4 humanoid robot, including noise and delays over state estimation and foot force control.

[1]  Tedrake Russ,et al.  Balance control using center of mass height variation: Limitations imposed by unilateral contact , 2016 .

[2]  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).

[3]  Yoshihiko Nakamura,et al.  Reactive stepping strategies for bipedal walking based on neutral point and boundary condition optimization , 2013, 2013 IEEE International Conference on Robotics and Automation.

[4]  Olivier Stasse,et al.  A Reactive Walking Pattern Generator Based on Nonlinear Model Predictive Control , 2017, IEEE Robotics and Automation Letters.

[5]  Leonardo Lanari,et al.  Planning desired center of Mass and zero moment point trajectories for bipedal locomotion , 2015, 2015 IEEE-RAS 15th International Conference on Humanoid Robots (Humanoids).

[6]  Yoshihiko Nakamura,et al.  Stability of surface contacts for humanoid robots: Closed-form formulae of the Contact Wrench Cone for rectangular support areas , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

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

[8]  Joel Andersson,et al.  A General-Purpose Software Framework for Dynamic Optimization (Een algemene softwareomgeving voor dynamische optimalisatie) , 2013 .

[9]  Alexander Herzog,et al.  Step timing adjustment: A step toward generating robust gaits , 2016, 2016 IEEE-RAS 16th International Conference on Humanoid Robots (Humanoids).

[10]  Alexander Herzog,et al.  A convex model of humanoid momentum dynamics for multi-contact motion generation , 2016, 2016 IEEE-RAS 16th International Conference on Humanoid Robots (Humanoids).

[11]  Sergey V. Drakunov,et al.  Capture Point: A Step toward Humanoid Push Recovery , 2006, 2006 6th IEEE-RAS International Conference on Humanoid Robots.

[12]  Olivier Stasse,et al.  A versatile and efficient pattern generator for generalized legged locomotion , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

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

[14]  Ye Zhao,et al.  A three dimensional foot placement planner for locomotion in very rough terrains , 2012, 2012 12th IEEE-RAS International Conference on Humanoid Robots (Humanoids 2012).

[15]  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.

[16]  Shuuji Kajita,et al.  A Pattern Generator of Humanoid Robots Walking on a Rough Terrain , 2008, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[17]  Pierre-Brice Wieber,et al.  A Newton method with always feasible iterates for Nonlinear Model Predictive Control of walking in a multi-contact situation , 2016, 2016 IEEE-RAS 16th International Conference on Humanoid Robots (Humanoids).

[18]  Lorenz T. Biegler,et al.  On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programming , 2006, Math. Program..

[19]  Abderrahmane Kheddar,et al.  Multi-contact walking pattern generation based on model preview control of 3D COM accelerations , 2016, 2016 IEEE-RAS 16th International Conference on Humanoid Robots (Humanoids).

[20]  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).

[21]  Quang-Cuong Pham,et al.  A General, Fast, and Robust Implementation of the Time-Optimal Path Parameterization Algorithm , 2013, IEEE Transactions on Robotics.

[22]  Yoshihiko Nakamura,et al.  ZMP Support Areas for Multicontact Mobility Under Frictional Constraints , 2015, IEEE Transactions on Robotics.

[23]  Eiichi Yoshida,et al.  Model preview control in multi-contact motion-application to a humanoid robot , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[24]  Kazuhito Yokoi,et al.  Reactive stepping to prevent falling for humanoids , 2009, 2009 9th IEEE-RAS International Conference on Humanoid Robots.

[25]  Quang-Cuong Pham,et al.  When to make a step? Tackling the timing problem in multi-contact locomotion by TOPP-MPC , 2016, 2017 IEEE-RAS 17th International Conference on Humanoid Robotics (Humanoids).

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

[27]  Kirill Van Heerden,et al.  Real-Time Variable Center of Mass Height Trajectory Planning for Humanoids Robots , 2017, IEEE Robotics and Automation Letters.