Three-dimensional humanoid motion planning using COM feasible region and its application to ladder climbing tasks

Motion planning of humanoid's full-body trajectory requires satisfying various constraints such as balance, contact, joint limitation, kinematics, and collision. To obtain trajectory efficiently, related research has integrated coarse motion planning to fine full-body trajectory generation. In a three-dimensional motion, coarse motion planning considering at swing phase in addition to support phase is important because constraints at swing phase drastically change from support phase. In this paper, we propose a humanoid motion planner satisfying various constraints based on key pose generation by exploiting center-of-mass (COM) feasible region (CFR): (a) We show a method to project approximately balance constraints of statics and dynamics into CFR. (b) We propose a key pose generation capable of considering swing and support phase to satisfy asymptotically CFR constraint while satisfying kinematics constraints. (c) We show a method to interpolate obtained key pose and to obtain full-body trajectory. We validate our proposed method through experiments, in which the robot performs locomotion tasks especially related to ladder climbing under the stringent constraints.

[1]  Takashi Matsumoto,et al.  Real time motion generation and control for biped robot -2nd report: Running gait pattern generation- , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[2]  Shuuji Kajita,et al.  Kinodynamic Planning for Humanoid Robots Walking on Uneven Terrain , 2009, J. Robotics Mechatronics.

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

[4]  Masayuki Inaba,et al.  Robust vertical ladder climbing and transitioning between ladder and catwalk for humanoid robots , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[5]  François Keith,et al.  Exploring humanoid robots locomotion capabilities in virtual disaster response scenarios , 2012, 2012 12th IEEE-RAS International Conference on Humanoid Robots (Humanoids 2012).

[6]  Shuuji Kajita,et al.  ZMP analysis for arm/leg coordination , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

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

[8]  Kris K. Hauser,et al.  Fast interpolation and time-optimization with contact , 2014, Int. J. Robotics Res..

[9]  Jun-Ho Oh,et al.  Robust ladder-climbing with a humanoid robot with application to the DARPA Robotics Challenge , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[10]  Tomomichi Sugihara,et al.  Motion Planning of a Humanoid Robot in a Complex Environment Using RRT and Spatiotemporal Post-Processing Techniques , 2014, Int. J. Humanoid Robotics.

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

[12]  Alberto Bemporad,et al.  The explicit linear quadratic regulator for constrained systems , 2003, Autom..

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

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

[15]  Takahide Yoshiike,et al.  Dynamic gait transition between bipedal and quadrupedal locomotion , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[16]  Eiichi Yoshida,et al.  Vertical ladder climbing by the HRP-2 humanoid robot , 2014, 2014 IEEE-RAS International Conference on Humanoid Robots.

[17]  Timothy Bretl,et al.  A fast and adaptive test of static equilibrium for legged robots , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[18]  Shuuji Kajita,et al.  Dynamical balance of a humanoid robot grasping an environment , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[19]  Yasuhisa Hasegawa,et al.  Vertical ladder climbing motion with posture control for multi-locomotion robot , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[20]  Timothy Bretl,et al.  Non-gaited humanoid locomotion planning , 2005, 5th IEEE-RAS International Conference on Humanoid Robots, 2005..

[21]  Eiichi Yoshida,et al.  Two-Stage Time-Parametrized Gait Planning for Humanoid Robots , 2010, IEEE/ASME Transactions on Mechatronics.

[22]  Eiichi Yoshida,et al.  Integrating geometric constraints into reactive leg motion generation , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

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

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

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