An Efficient Paradigm for Feasibility Guarantees in Legged Locomotion

Developing feasible body trajectories for legged systems on arbitrary terrains is a challenging task. Given some contact points, the trajectories for the Center of Mass (CoM) and body orientation, designed to move the robot, must satisfy crucial constraints to maintain balance, and to avoid violating physical actuation and kinematic limits. In this paper, we present a paradigm that allows to design feasible trajectories in an efficient manner. In continuation to our previous work, we extend the notion of the 2D feasible region, where static balance and the satisfaction of actuation limits were guaranteed, whenever the projection of the CoM lies inside the proposed admissible region. We here develop a general formulation of the improved feasible region to guarantee dynamic balance alongside the satisfaction of both actuation and kinematic limits for arbitrary terrains in an efficient manner. To incorporate the feasibility of the kinematic limits, we introduce an algorithm that computes the reachable region of the CoM. Furthermore, we propose an efficient planning strategy that utilizes the improved feasible region to design feasible CoM and body orientation trajectories. Finally, we validate the capabilities of the improved feasible region and the effectiveness of the proposed planning strategy, using simulations and experiments on the HyQ robot and comparing them to a previously developed heuristic approach. Various scenarios and terrains that mimic confined and challenging environments are used for the validation.

[1]  Giuseppe Oriolo,et al.  Gait Generation using Intrinsically Stable MPC in the Presence of Persistent Disturbances , 2019, 2019 IEEE-RAS 19th International Conference on Humanoid Robots (Humanoids).

[2]  Claudio Semini,et al.  Feasible Region: An Actuation-Aware Extension of the Support Region , 2019, IEEE Transactions on Robotics.

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

[4]  Nicolas Mansard,et al.  2PAC: Two Point Attractors for Center of Mass Trajectories in Multi Contact Scenarios , 2018 .

[5]  Carlos Mastalli,et al.  Passive Whole-Body Control for Quadruped Robots: Experimental Validation Over Challenging Terrain , 2018, IEEE Robotics and Automation Letters.

[6]  Masayuki Inaba,et al.  Walking on a Steep Slope Using a Rope by a Life-Size Humanoid Robot , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[7]  Sangbae Kim,et al.  Dynamic Locomotion in the MIT Cheetah 3 Through Convex Model-Predictive Control , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[8]  Michel Taïx,et al.  CROC: Convex Resolution of Centroidal Dynamics Trajectories to Provide a Feasibility Criterion for the Multi Contact Planning Problem , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[9]  Darwin G. Caldwell,et al.  Heuristic Planning for Rough Terrain Locomotion in Presence of External Disturbances and Variable Perception Quality , 2018, ECHORD++.

[10]  Peter Fankhauser,et al.  Robust Rough-Terrain Locomotion with a Quadrupedal Robot , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[11]  A. Kheddar,et al.  3-D Robust Stability Polyhedron in Multicontact , 2018, IEEE Transactions on Robotics.

[12]  Marco Hutter,et al.  Dynamic Locomotion Through Online Nonlinear Motion Optimization for Quadrupedal Robots , 2018, IEEE Robotics and Automation Letters.

[13]  Nicholas Rotella,et al.  An MPC Walking Framework with External Contact Forces , 2017, 2018 IEEE International Conference on Robotics and Automation (ICRA).

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

[15]  Marco Hutter,et al.  Whole-Body Nonlinear Model Predictive Control Through Contacts for Quadrupeds , 2017, IEEE Robotics and Automation Letters.

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

[17]  Masayuki Inaba,et al.  Three-dimensional humanoid motion planning using COM feasible region and its application to ladder climbing tasks , 2016, 2016 IEEE-RAS 16th International Conference on Humanoid Robots (Humanoids).

[18]  Giuseppe Oriolo,et al.  Intrinsically stable MPC for humanoid gait generation , 2016, 2016 IEEE-RAS 16th International Conference on Humanoid Robots (Humanoids).

[19]  Roland Siegwart,et al.  Dynamic trotting on slopes for quadrupedal robots , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

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

[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]  David E. Orin,et al.  Centroidal dynamics of a humanoid robot , 2013, Auton. Robots.

[23]  Darwin G. Caldwell,et al.  A reactive controller framework for quadrupedal locomotion on challenging terrain , 2013, 2013 IEEE International Conference on Robotics and Automation.

[24]  Lluís Ros,et al.  A Complete Method for Workspace Boundary Determination on General Structure Manipulators , 2012, IEEE Transactions on Robotics.

[25]  Stefan Behnel,et al.  Cython: The Best of Both Worlds , 2011, Computing in Science & Engineering.

[26]  Timothy Bretl,et al.  Testing Static Equilibrium for Legged Robots , 2008, IEEE Transactions on Robotics.

[27]  Ron Wein,et al.  Exact and approximate construction of offset polygons , 2007, Comput. Aided Des..

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

[29]  Antoine Vigneron,et al.  Motorcycle Graphs and Straight Skeletons , 2002, SODA '02.

[30]  Guangming Zhang,et al.  Workspace Variation of a Hexapod Machine Tool | NIST , 1998 .

[31]  Friedrich M. Wahl,et al.  Stability analysis of assemblies considering friction , 1997, IEEE Trans. Robotics Autom..

[32]  Pradeep K. Khosla,et al.  Finding all stable orientations of assemblies with friction , 1996, IEEE Trans. Robotics Autom..

[33]  J. Trinkle,et al.  On Dynamic Multi‐Rigid‐Body Contact Problems with Coulomb Friction , 1995 .

[34]  Paul R. Detmer,et al.  Centroid of a Polygon , 1994, Graphics Gems.

[35]  C. Gosselin Determination of the Workspace of 6-DOF Parallel Manipulators , 1990 .

[36]  J. E. Kelley,et al.  The Cutting-Plane Method for Solving Convex Programs , 1960 .

[37]  A. Plaat Heuristic Planning , 2020, Learning to Play.

[38]  Frank Chongwoo Park,et al.  Parallel Robots , 2015, Encyclopedia of Systems and Control.

[39]  Giuseppe Oriolo,et al.  Kinematically Redundant Manipulators , 2008, Springer Handbook of Robotics.

[40]  Joel W. Burdick,et al.  Contact Modeling and Manipulation , 2008, Springer Handbook of Robotics.