Application of Wrench-Based Feasibility Analysis to the Online Trajectory Optimization of Legged Robots

Motion planning in multicontact scenarios has recently gathered interest within the legged robotics community, however actuator force/torque limits are rarely considered. We believe that these limits gain paramount importance when the complexity of the terrains to be traversed increases. We build on previous research from the field of robotic grasping to propose two new six-dimensional bounded polytopes named the Actuation Wrench Polytope (AWP) and the Feasible Wrench Polytope (FWP). We define theAWP as the set of all the wrenches that a robot can generate while considering its actuation limits. This considers the admissible contact forces that the robot can generate given its current configuration and actuation capabilities. The Contact Wrench Cone (CWC) instead includes features of the environment such as the contact normal or the friction coefficient. The intersection of the AWP and of the CWC results in a convex polytope, the FWP, which turns out to be more descriptive of the real robot capabilities than existing simplified models, while maintaining the same compact representation. We explain how to efficiently compute the vertex-description of the FWP that is then used to evaluate a feasibility factor that we adapted from the field of robotic grasping. This allows us to optimize for robustness to external disturbance wrenches. Based on this, we present an implementation of a motion planner for our quadruped robot HyQ that provides online Center of Mass trajectories that are guaranteed to be statically stable and actuation-consistent.

[1]  Stéphane Caro,et al.  Measuring How Well a Structure Supports Varying External Wrenches , 2014 .

[2]  Tsuneo Yoshikawa,et al.  FSW (feasible solution of wrench) for multi-legged robots , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

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

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

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

[6]  Ferdinando Cannella,et al.  Design of HyQ – a hydraulically and electrically actuated quadruped robot , 2011 .

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

[8]  Abderrahmane Kheddar,et al.  Post-impact adaptive compliance for humanoid falls using predictive control of a reduced model , 2017, 2017 IEEE-RAS 17th International Conference on Humanoid Robotics (Humanoids).

[9]  Imme Ebert-Uphoff,et al.  Wrench-feasible workspace generation for cable-driven robots , 2006, IEEE Transactions on Robotics.

[10]  Nicolas Mansard,et al.  Fast algorithms to test robust static equilibrium for legged robots , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[11]  Denis Teissandier,et al.  Minkowski sum of polytopes defined by their vertices , 2014, ArXiv.

[12]  F. Pierrot,et al.  Force polytope and force ellipsoid for redundant manipulators , 1997 .

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

[14]  Clément Gosselin,et al.  On the Ability of a Cable-Driven Robot to Generate a Prescribed Set of Wrenches , 2008 .

[15]  Darwin G. Caldwell,et al.  Trajectory and foothold optimization using low-dimensional models for rough terrain locomotion , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[16]  Abderrahmane Kheddar,et al.  Dynamic walking over rough terrains by nonlinear predictive control of the floating-base inverted pendulum , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[17]  Darwin G. Caldwell,et al.  The Actuation-consistent Wrench Polytope (AWP) and the Feasible Wrench Polytope (FWP) , 2017, ArXiv.

[18]  Carlos Mastalli,et al.  Simultaneous Contact, Gait, and Motion Planning for Robust Multilegged Locomotion via Mixed-Integer Convex Optimization , 2017, IEEE Robotics and Automation Letters.

[19]  Darwin G. Caldwell,et al.  High-slope terrain locomotion for torque-controlled quadruped robots , 2016, Autonomous Robots.

[20]  Darwin G. Caldwell,et al.  Reactive trotting with foot placement corrections through visual pattern classification , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[21]  Danica Kragic,et al.  Analytic grasp success prediction with tactile feedback , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

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

[23]  Darwin G. Caldwell,et al.  Viscosity-based height reflex for workspace augmentation for quadrupedal locomotion on rough terrain , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[24]  Antonio Bicchi,et al.  On the Closure Properties of Robotic Grasping , 1995, Int. J. Robotics Res..

[25]  Denis Teissandier,et al.  Applying screw theory for summing sets of constraints in geometric tolerancing , 2017 .

[26]  Hongkai Dai,et al.  Robust multi-contact dynamical motion planning using contact wrench set , 2016 .