Multicontact Locomotion of Legged Robots

Locomotion of legged robots on arbitrary terrain using multiple contacts is yet an open problem. To tackle it, a common approach is to rely on reduced template models (e.g., the linear inverted pendulum). However, most of existing template models are based on some restrictive hypotheses that limit their range of applications. Moreover, reduced models are generally not able to cope with the constraints of the robot complete model, such as the kinematic limits. In this paper, we propose a complete solution relying on a generic template model, based on the centroidal dynamics, able to quickly compute multicontact locomotion trajectories for any legged robot on arbitrary terrains. The template model relies on exact dynamics and is thus not limited by arbitrary assumption. We also propose a generic procedure to handle feasibility constraints due to the robot's whole body as occupancy measures, and a systematic way to approximate them using offline learning in simulation. An efficient solver is finally obtained by introducing an original second-order approximation of the centroidal wrench cone. The effectiveness and the versatility of the approach are demonstrated in several multicontact scenarios with two humanoid robots both in reality and in simulation.

[1]  Satoshi Kagami,et al.  High frequency walking pattern generation based on preview control of ZMP , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

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

[3]  Peter Ney,et al.  Occupation measures for Markov chains , 1995 .

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

[5]  Nicolas Mansard,et al.  HPP: A new software for constrained motion planning , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

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

[7]  Pierre-Brice Wieber,et al.  Fast Direct Multiple Shooting Algorithms for Optimal Robot Control , 2005 .

[8]  David E. Orin,et al.  Centroidal dynamics of a humanoid robot , 2013, Auton. Robots.

[9]  Olivier Stasse,et al.  TALOS: A new humanoid research platform targeted for industrial applications , 2017, 2017 IEEE-RAS 17th International Conference on Humanoid Robotics (Humanoids).

[10]  Sylvain Miossec,et al.  Planning support contact-points for humanoid robots and experiments on HRP-2 , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[11]  Andrei Herdt,et al.  Walking without thinking about it , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[12]  Pierre-Brice Wieber,et al.  A robust linear MPC approach to online generation of 3D biped walking motion , 2015, 2015 IEEE-RAS 15th International Conference on Humanoid Robots (Humanoids).

[13]  Olivier Stasse,et al.  Towards reactive whole-body motion planning in cluttered environments by precomputing feasible motion spaces , 2013, 2013 13th IEEE-RAS International Conference on Humanoid Robots (Humanoids).

[14]  Stephen J. Wright,et al.  Object-oriented software for quadratic programming , 2003, TOMS.

[15]  Giorgio Metta,et al.  Prioritized motion-force control of constrained fully-actuated robots: "Task Space Inverse Dynamics" , 2014, Robotics Auton. Syst..

[16]  J. Chestnutt,et al.  Planning Biped Navigation Strategies in Complex Environments , 2003 .

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

[18]  Yizhar Or,et al.  Characterization of frictional multi-legged equilibrium postures on uneven terrains , 2017, Int. J. Robotics Res..

[19]  Vincent Padois,et al.  Effective Generation of Dynamically Balanced Locomotion with Multiple Non-coplanar Contacts , 2015, ISRR.

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

[21]  Yoshihiko Nakamura,et al.  Leveraging Cone Double Description for Multi-contact Stability of Humanoids with Applications to Statics and Dynamics , 2015, Robotics: Science and Systems.

[22]  D. Rubin,et al.  Maximum likelihood from incomplete data via the EM - algorithm plus discussions on the paper , 1977 .

[23]  Komei Fukuda,et al.  Double Description Method Revisited , 1995, Combinatorics and Computer Science.

[24]  Johannes P. Schlöder,et al.  An efficient multiple shooting based reduced SQP strategy for large-scale dynamic process optimization. Part 1: theoretical aspects , 2003, Comput. Chem. Eng..

[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]  Yuval Tassa,et al.  Control-limited differential dynamic programming , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[27]  Nicolas Mansard,et al.  Learning Feasibility Constraints for Multicontact Locomotion of Legged Robots , 2017, Robotics: Science and Systems.

[28]  Darwin G. Caldwell,et al.  Application of Wrench-Based Feasibility Analysis to the Online Trajectory Optimization of Legged Robots , 2017, IEEE Robotics and Automation Letters.

[29]  Pierre-Brice Wieber,et al.  Viability and predictive control for safe locomotion , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[31]  Alexander Herzog,et al.  On Time Optimization of Centroidal Momentum Dynamics , 2017, 2018 IEEE International Conference on Robotics and Automation (ICRA).

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

[33]  Kai Henning Koch,et al.  Optimization-Based Walking Generation for Humanoid Robot , 2012, SyRoCo.

[34]  Alexander Herzog,et al.  Structured contact force optimization for kino-dynamic motion generation , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

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

[36]  François Keith,et al.  Dynamic Whole-Body Motion Generation Under Rigid Contacts and Other Unilateral Constraints , 2013, IEEE Transactions on Robotics.

[37]  Pierre-Brice Wieber,et al.  Holonomy and Nonholonomy in the Dynamics of Articulated Motion , 2006 .

[38]  Olivier Stasse,et al.  COCoMoPL: A Novel Approach for Humanoid Walking Generation Combining Optimal Control, Movement Primitives and Learning and its Transfer to the Real Robot HRP-2 , 2017, IEEE Robotics and Automation Letters.

[39]  Timothy Bretl,et al.  Motion Planning of Multi-Limbed Robots Subject to Equilibrium Constraints: The Free-Climbing Robot Problem , 2006, Int. J. Robotics Res..

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

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

[42]  F. John Extremum Problems with Inequalities as Subsidiary Conditions , 2014 .

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

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

[45]  Darwin G. Caldwell,et al.  A Feasibility Metric for Trajectory Optimization of Legged Robots using Wrench Polytopes , 2017, ArXiv.

[46]  Qingwei Jin,et al.  Quadratic optimization over a polyhedral cone , 2015 .

[47]  Radford M. Neal Pattern Recognition and Machine Learning , 2007, Technometrics.

[48]  Olivier Stasse,et al.  Fast Humanoid Robot Collision-Free Footstep Planning Using Swept Volume Approximations , 2012, IEEE Transactions on Robotics.

[49]  Pierre-Brice Wieber,et al.  Whole body motion controller with long-term balance constraints , 2014, 2014 IEEE-RAS International Conference on Humanoid Robots.

[50]  Olivier Stasse,et al.  Multi-contact Locomotion of Legged Robots in Complex Environments – The Loco3D project , 2017 .

[51]  Marco Hutter,et al.  Gait and Trajectory Optimization for Legged Systems Through Phase-Based End-Effector Parameterization , 2018, IEEE Robotics and Automation Letters.

[52]  E. Parzen On Estimation of a Probability Density Function and Mode , 1962 .

[53]  Yuval Tassa,et al.  Synthesis and stabilization of complex behaviors through online trajectory optimization , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[54]  John R. Hershey,et al.  Approximating the Kullback Leibler Divergence Between Gaussian Mixture Models , 2007, 2007 IEEE International Conference on Acoustics, Speech and Signal Processing - ICASSP '07.

[55]  Emmanuel Trélat,et al.  Nonlinear Optimal Control via Occupation Measures and LMI-Relaxations , 2007, SIAM J. Control. Optim..

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

[57]  Shuuji Kajita,et al.  A universal stability criterion of the foot contact of legged robots - adios ZMP , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[58]  Richard Courant,et al.  Studies and Essays presented to R Courant on his 60th Birthday, January 8, 1948 , 1948, Nature.

[59]  Zoran Popovic,et al.  Discovery of complex behaviors through contact-invariant optimization , 2012, ACM Trans. Graph..

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

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

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

[63]  P. Zaytsev Using Controllability Of Simple Models To Generate Maximally Robust Walking-Robot Controllers , 2015 .