Planning and Fast Replanning Safe Motions for Humanoid Robots

This paper introduces effective numerical methods for the planning and fast replanning of safe motions to ensure the safety, balance, and integrity of humanoid robots over the whole motion duration. Our safe methods do not depend on, nor are connected to, any type of modeling or constraints. To plan safe motions, certain constraints have to be satisfied over a continuous interval of time. Classical methods revert to time-grid discretization, which can be risky for the robot. We introduce a hybrid method to plan safe motions, which combines a classical unsafe method with a verification step that checks constraint violation and computes excess by the usage of interval analysis. When the robot meets unexpected situations, it has to replan a new motion, which is often too time consuming. Hence, we introduce a new method to rapidly replan safe motions, i.e., in less than 2 s CPU time. It computes offline feasible subsets in the vicinity of safe motions and finds online a solution in these subsets without actually recomputing the nonlinear constraints. Our methods are validated by the use the HOAP-3 robot, where the motions are run with no balance controller.

[1]  Kazuhito Yokoi,et al.  Development of a software for motion optimization of robots - Application to the kick motion of the HRP-2 robot , 2006, 2006 IEEE International Conference on Robotics and Biomimetics.

[2]  Frank Chongwoo Park,et al.  Newton-type algorithms for dynamics-based robot movement optimization , 2005, IEEE Transactions on Robotics.

[3]  Katsu Yamane,et al.  Dynamics Filter - concept and implementation of online motion Generator for human figures , 2000, IEEE Trans. Robotics Autom..

[4]  Eiichi Yoshida,et al.  Humanoid motion planning for dynamic tasks , 2005, 5th IEEE-RAS International Conference on Humanoid Robots, 2005..

[5]  Kazuhito Yokoi,et al.  Resolved momentum control: humanoid motion planning based on the linear and angular momentum , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[6]  Philippe Fraisse,et al.  Guaranteed computation of constraints for safe path planning , 2007, 2007 7th IEEE-RAS International Conference on Humanoid Robots.

[7]  O. V. Stryk,et al.  Numerical Solution of Optimal Control Problems by Direct Collocation , 1993 .

[8]  Lorenz T. Biegler,et al.  On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programming , 2006, Math. Program..

[9]  Eiichi Yoshida,et al.  On humanoid motion optimization , 2007, 2007 7th IEEE-RAS International Conference on Humanoid Robots.

[10]  M Vukobratović,et al.  Contribution to the synthesis of biped gait. , 1969, IEEE transactions on bio-medical engineering.

[11]  M. Kawato,et al.  Formation and control of optimal trajectory in human multijoint arm movement , 1989, Biological Cybernetics.

[12]  Philippe Fraisse,et al.  Planning and fast re-planning of safe motions for humanoid robots: Application to a kicking motion , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[13]  T. Tsujita,et al.  Humanoid robot motion generation for nailing task , 2008, 2008 IEEE/ASME International Conference on Advanced Intelligent Mechatronics.

[14]  Masayuki Inaba,et al.  Online mixture and connection of basic motions for humanoid walking control by footprint specification , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[15]  Oskar von Stryk,et al.  Direct and indirect methods for trajectory optimization , 1992, Ann. Oper. Res..

[16]  Olivier Stasse,et al.  Fast foot prints re-planning and motion generation during walking in physical human-humanoid interaction , 2009, 2009 9th IEEE-RAS International Conference on Humanoid Robots.

[17]  Rembert Reemtsen.  Semi-infinite Programming: Discretization Methods , 2009, Encyclopedia of Optimization.

[18]  Sung-Hee Lee,et al.  Reaction Mass Pendulum (RMP): An explicit model for centroidal angular momentum of humanoid robots , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[19]  Enrico Pagello,et al.  The challenge of motion planning for humanoid robots playing soccer , 2006 .

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

[21]  Olivier Stasse,et al.  Intercontinental, multimodal, wide-range tele-cooperation using a humanoid robot , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[22]  Philippe Fraisse,et al.  Safe motion planning computation for databasing balanced movement of humanoid robots , 2009, 2009 IEEE International Conference on Robotics and Automation.

[23]  Luc Jaulin,et al.  Applied Interval Analysis , 2001, Springer London.

[24]  Masayuki Inaba,et al.  Footstep planning among obstacles for biped robots , 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]  A. Piazzi,et al.  Global minimum-time trajectory planning of mechanical manipulators using interval analysis , 1998 .

[26]  Sven Behnke,et al.  See, walk, and kick: Humanoid robots start to play soccer , 2006, 2006 6th IEEE-RAS International Conference on Humanoid Robots.

[27]  Aurelio Piazzi,et al.  Global minimum-jerk trajectory planning of robot manipulators , 2000, IEEE Trans. Ind. Electron..

[28]  Kenneth O. Kortanek,et al.  Semi-Infinite Programming: Theory, Methods, and Applications , 1993, SIAM Rev..

[29]  Jian L. Zhou,et al.  User's Guide for CFSQP Version 2.0: A C Code for Solving (Large Scale) Constrained Nonlinear (Minimax) Optimization Problems, Generating Iterates Satisfying All Inequality Constraints , 1994 .

[30]  Marco A. López,et al.  Semi-infinite programming , 2007, Eur. J. Oper. Res..

[31]  Masayuki Inaba,et al.  AutoBalancer: An Online Dynamic Balance Compensation Scheme for Humanoid Robots , 2000 .

[32]  Hyeong-Seok Ko,et al.  Motion Balance Filtering , 2000, Comput. Graph. Forum.