Online DCM Trajectory Generation for Push Recovery of Torque-Controlled Humanoid Robots

We present a computationally efficient method for online planning of bipedal walking trajectories with push recovery. In particular, the proposed methodology fits control architectures where the Divergent-Component-of-Motion (DCM) is planned beforehand, and adds a step adapter to adjust the planned trajectories and achieve push recovery. Assuming that the robot is in a single support state, the step adapter generates new positions and timings for the next step. The step adapter is active in single support phases only, but the proposed torque-control architecture considers double support phases too. The key idea for the design of the step adapter is to impose both initial and final DCM step values using an exponential interpolation of the time varying ZMP trajectory. This allows us to cast the push recovery problem as a Quadratic Programming (QP) one, and to solve it online with state-of-the-art optimisers. The overall approach is validated with simulations of the torque-controlled 33 kg humanoid robot iCub. Results show that the proposed strategy prevents the humanoid robot from falling while walking at 0.28 m/s and pushed with external forces up to 150 Newton for 0.05 seconds.

[1]  Reza Olfati-Saber,et al.  Nonlinear control of underactuated mechanical systems with application to robotics and aerospace vehicles , 2001 .

[2]  Giulio Sandini,et al.  The iCub humanoid robot: An open-systems platform for research in cognitive development , 2010, Neural Networks.

[3]  Gabriele Nava,et al.  Stability analysis and design of momentum-based controllers for humanoid robots , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[4]  Alin Albu-Schäffer,et al.  Trajectory generation for continuous leg forces during double support and heel-to-toe shift based on divergent component of motion , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[5]  Jun-Ho Oh,et al.  Balance recovery through model predictive control based on capture point dynamics for biped walking robot , 2018, Robotics Auton. Syst..

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

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

[8]  Alexander Leonessa,et al.  Walking stabilization using step timing and location adjustment on the humanoid robot, Atlas , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[9]  Christopher G. Atkeson,et al.  Optimization‐based Full Body Control for the DARPA Robotics Challenge , 2015, J. Field Robotics.

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

[11]  Gabriele Nava,et al.  A Control Architecture with Online Predictive Planning for Position and Torque Controlled Walking of Humanoid Robots , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[12]  Jerrold E. Marsden,et al.  Introduction to Mechanics and Symmetry: A Basic Exposition of Classical Mechanical Systems , 1999 .

[13]  Christian Ott,et al.  DCM-Based Gait Generation for Walking on Moving Support Surfaces , 2018, 2018 IEEE-RAS 18th International Conference on Humanoid Robots (Humanoids).

[14]  Christopher G. Atkeson,et al.  Dynamic Balance Force Control for compliant humanoid robots , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[15]  Russ Tedrake,et al.  Whole-body motion planning with centroidal dynamics and full kinematics , 2014, 2014 IEEE-RAS International Conference on Humanoid Robots.

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

[17]  Jean-Paul Laumond,et al.  Reactive synthesizing of human locomotion combining nonholonomic and holonomic behaviors , 2010, 2010 3rd IEEE RAS & EMBS International Conference on Biomedical Robotics and Biomechatronics.

[18]  A. Hof.  The 'extrapolated center of mass' concept suggests a simple control of balance in walking. , 2008, Human movement science.

[19]  Atsuo Takanishi,et al.  Human-like walking with knee stretched, heel-contact and toe-off motion by a humanoid robot , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[20]  M. Vukobratovic,et al.  Contribution to the Synthesis of Biped Gait , 1968 .

[21]  Alexander Herzog,et al.  Trajectory generation for multi-contact momentum control , 2015, 2015 IEEE-RAS 15th International Conference on Humanoid Robots (Humanoids).

[22]  Andrew Howard,et al.  Design and use paradigms for Gazebo, an open-source multi-robot simulator , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

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

[24]  Kazuhito Yokoi,et al.  The 3D linear inverted pendulum mode: a simple modeling for a biped walking pattern generation , 2001, Proceedings 2001 IEEE/RSJ International Conference on Intelligent Robots and Systems. Expanding the Societal Role of Robotics in the the Next Millennium (Cat. No.01CH37180).

[25]  David E. Orin,et al.  Centroidal Momentum Matrix of a humanoid robot: Structure and properties , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[26]  Daniele Pucci,et al.  A Benchmarking of DCM Based Architectures for Position and Velocity Controlled Walking of Humanoid Robots , 2018, 2018 IEEE-RAS 18th International Conference on Humanoid Robots (Humanoids).

[27]  Aghil Yousefi-Koma,et al.  Robust bipedal locomotion control based on model predictive control and divergent component of motion , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[28]  Arthur D Kuo,et al.  Energetics of actively powered locomotion using the simplest walking model. , 2002, Journal of biomechanical engineering.

[29]  Christian Kirches,et al.  qpOASES: a parametric active-set algorithm for quadratic programming , 2014, Mathematical Programming Computation.

[30]  Daniele Pucci,et al.  iCub: The not-yet-finished story of building a robot child , 2017, Science Robotics.