Whole-body Motion Planning – Building Blocks for Intelligent Systems

Humanoid robots have become increasingly sophisticated, both in terms of their movement as well as their sensorial capabilities. This allows one to target for more challenging problems, eventually leading to robotic systems that can perform useful tasks in everyday environments. In this paper, we review some elements we consider to be important for a movement control and planning architecture. We first explain the whole-body control concept, which is the underlying basis for the subsequent elements. We then present a method to determine optimal stance locations with respect to a given task. This is a key element in an action selection scheme that evaluates a set of controllers within a parallel prediction architecture. It allows the robot to quickly react to changing environments. We then review a more global movement planning approach which casts the overall robot movement into an integral optimization problem, and leads to smooth and collision-free movements within interaction time. This scheme is then extended to cover the problem of grasping simple objects.

[1]  Jean-Paul Laumond,et al.  Robot Motion Planning and Control , 1998 .

[2]  Michael Gienger,et al.  Exploiting Task Intervals for Whole Body Robot Control , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[3]  E. Bizzi,et al.  Book Review: Modular Organization of Spinal Motor Systems , 2002, The Neuroscientist : a review journal bringing neurobiology, neurology and psychiatry.

[4]  C. Colby Action-Oriented Spatial Reference Frames in Cortex , 1998, Neuron.

[5]  Anthony A. Maciejewski,et al.  On the implementation of velocity control for kinematically redundant manipulators , 2000, IEEE Trans. Syst. Man Cybern. Part A.

[6]  Helge J. Ritter,et al.  Task-oriented quality measures for dextrous grasping , 2005, 2005 International Symposium on Computational Intelligence in Robotics and Automation.

[7]  Michael Beetz,et al.  Positioning mobile manipulators to perform constrained linear trajectories , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[8]  Jun Nakanishi,et al.  Control, Planning, Learning, and Imitation with Dynamic Movement Primitives , 2003 .

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

[10]  Helge J. Ritter,et al.  Situated robot learning for multi-modal instruction and imitation of grasping , 2004, Robotics Auton. Syst..

[11]  Mark Dunn,et al.  Predictive Behavior Generation - A Sensor-Based Walking and Reaching Architecture for Humanoid Robots , 2007, AMS.

[12]  Henrik I. Christensen,et al.  Automatic grasp planning using shape primitives , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[13]  A. Liegeois,et al.  Automatic supervisory control of the configuration and behavior of multi-body mechanisms , 1977 .

[14]  Heiko Wersing,et al.  Towards incremental hierarchical behavior generation for humanoids , 2007, 2007 7th IEEE-RAS International Conference on Humanoid Robots.

[15]  Maximilian Schlemmer,et al.  Real-Time Collision- Free Trajectory Optimization of Robot Manipulators via Semi-Infinite Parameter Optimization , 1998, Int. J. Robotics Res..

[16]  Yoshihiko Nakamura,et al.  Advanced robotics - redundancy and optimization , 1990 .

[17]  S. Schaal Movement Planning and Imitation by Shaping Nonlinear Attractors , 2003 .

[18]  E. Bizzi,et al.  Linear combinations of primitives in vertebrate motor control. , 1994, Proceedings of the National Academy of Sciences of the United States of America.

[19]  Michael Gienger,et al.  Real-time collision avoidance with whole body motion control for humanoid robots , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[20]  Satoshi Kagami,et al.  An adaptive action model for legged navigation planning , 2007, 2007 7th IEEE-RAS International Conference on Humanoid Robots.

[21]  Yoshihiko Nakamura,et al.  Optimal Redundancy Control of Robot Manipulators , 1987 .

[22]  O. von Stryk,et al.  Trajectory optimization of industrial robots with application to computer-aided robotics and robot controllers , 2000 .

[23]  Stefano Chiaverini,et al.  Singularity-robust task-priority redundancy resolution for real-time kinematic control of robot manipulators , 1997, IEEE Trans. Robotics Autom..

[24]  R. Boulic,et al.  Interactive identification of the center of mass reachable space for an articulated manipulator , 1997, 1997 8th International Conference on Advanced Robotics. Proceedings. ICAR'97.

[25]  Takeo Kanade,et al.  Vision-guided humanoid footstep planning for dynamic environments , 2005, 5th IEEE-RAS International Conference on Humanoid Robots, 2005..

[26]  Marc Toussaint,et al.  Optimization of fluent approach and grasp motions , 2008, Humanoids 2008 - 8th IEEE-RAS International Conference on Humanoid Robots.

[27]  Kazuhito Yokoi,et al.  Reachable boundary of a humanoid robot with two feet fixed on the ground , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[28]  Éric Marchand,et al.  A redundancy-based iterative approach for avoiding joint limits: application to visual servoing , 2001, IEEE Trans. Robotics Autom..

[29]  Steven M. LaValle,et al.  RRT-connect: An efficient approach to single-query path planning , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[30]  Lydia E. Kavraki,et al.  Probabilistic roadmaps for path planning in high-dimensional configuration spaces , 1996, IEEE Trans. Robotics Autom..

[31]  Michael Gienger,et al.  Task-oriented whole body motion for humanoid robots , 2005, 5th IEEE-RAS International Conference on Humanoid Robots, 2005..

[32]  Marc Toussaint,et al.  Optimization of sequential attractor-based movement for compact behaviour generation , 2007, 2007 7th IEEE-RAS International Conference on Humanoid Robots.

[33]  Anthony A. Maciejewski,et al.  Dealing with the ill-conditioned equations of motion for articulated figures , 1990, IEEE Computer Graphics and Applications.

[34]  Satoshi Kagami,et al.  Efficient prioritized inverse kinematic solutions for redundant manipulators , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[35]  Oussama Khatib,et al.  A unified approach for motion and force control of robot manipulators: The operational space formulation , 1987, IEEE J. Robotics Autom..

[36]  Helge J. Ritter,et al.  Dynamic Path Planning for a 7-DOF Robot Arm , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[38]  Friedrich Pfeiffer,et al.  Mechanical System Dynamics , 2008 .

[39]  Sunil Arya,et al.  An optimal algorithm for approximate nearest neighbor searching fixed dimensions , 1998, JACM.

[40]  Karim Abdel-Malek,et al.  Optimization-based trajectory planning of the human upper body , 2006, Robotica.

[41]  Yoshihiko Nakamura,et al.  Whole-body Cooperative Balancing of Humanoid Robot using COG Jacobian , 2002 .

[42]  Kazuhito Yokoi,et al.  Numerical Methods for Reachable Space Generation of Humanoid Robots , 2008, Int. J. Robotics Res..

[43]  Marc Toussaint,et al.  Task maps in humanoid robot manipulation , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[44]  Yoshihiko Nakamura,et al.  Whole-body cooperative balancing of humanoid robot using COG Jacobian , 2002, IEEE/RSJ International Conference on Intelligent Robots and Systems.

[45]  Jun Nakanishi,et al.  Learning Attractor Landscapes for Learning Motor Primitives , 2002, NIPS.

[46]  Dmitry Berenson,et al.  Grasp planning in complex scenes , 2007, 2007 7th IEEE-RAS International Conference on Humanoid Robots.

[47]  Jun Nakanishi,et al.  Movement imitation with nonlinear dynamical systems in humanoid robots , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[48]  Robert Platt,et al.  Improving Grasp Skills Using Schema Structured Learning , 2006 .

[49]  Shuuji Kajita,et al.  International Journal of Humanoid Robotics c ○ World Scientific Publishing Company An Analytical Method on Real-time Gait Planning for a Humanoid Robot , 2022 .

[50]  Werner von Seelen,et al.  Complex behavior by means of dynamical systems for an anthropomorphic robot , 1999, Neural Networks.

[51]  Mark Dunn,et al.  Visually Guided Whole Body Interaction , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[52]  Ronan Boulic,et al.  Task-priority formulations for the kinematic control of highly redundant articulated structures , 1998, Proceedings. 1998 IEEE/RSJ International Conference on Intelligent Robots and Systems. Innovations in Theory, Practice and Applications (Cat. No.98CH36190).

[53]  B. Faverjon,et al.  Probabilistic Roadmaps for Path Planning in High-Dimensional Con(cid:12)guration Spaces , 1996 .

[54]  Helge J. Ritter,et al.  On-line planning of time-optimal, jerk-limited trajectories , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[55]  Jean-Claude Latombe,et al.  Robot motion planning , 1970, The Kluwer international series in engineering and computer science.

[56]  Friedrich Pfeiffer,et al.  Optimization based gait pattern generation for a biped robot , 2005, 5th IEEE-RAS International Conference on Humanoid Robots, 2005..

[57]  Jun Nakanishi,et al.  Learning Movement Primitives , 2005, ISRR.

[58]  M. Hirose,et al.  Development of Humanoid Robot ASIMO , 2001 .

[59]  Raúl Suárez Feijóo,et al.  Grasp quality measures , 2006 .

[60]  A. A. Maciejewsk Dealing with the Ill-Conditioned Epuations of Motion for Articulated Figures , 1990 .

[61]  Éric Marchand,et al.  Using the task function approach to avoid robot joint limits and kinematic singularities in visual servoing , 1996, Proceedings of IEEE/RSJ International Conference on Intelligent Robots and Systems. IROS '96.

[62]  Behzad Dariush,et al.  Online and markerless motion retargeting with kinematic constraints , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[63]  Inna Mikhailova,et al.  Expectation-driven autonomous learning and interaction system , 2008, Humanoids 2008 - 8th IEEE-RAS International Conference on Humanoid Robots.

[64]  Steven M. LaValle,et al.  Planning algorithms , 2006 .