Continuous trajectory optimization for autonomous humanoid door opening

The upcoming DARPA Robotics Challenge (DRC) presents a demanding set of real-world tasks to be accomplished autonomously by robots. In this paper, we describe the development of a system to control an existing humanoid robot to open a door, one of the many tasks of the DRC. Special emphasis is placed upon generating smooth trajectories which minimize unnecessary motion of the robot. We describe methods for generating and optimizing trajectories for the robot, and present preliminary results demonstrated on the physical robotic platform. To the best of our knowledge, we demonstrate the first large scale application of the CHOMP trajectory optimization in a situation with closed kinematic chain constraints.

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

[2]  Siddhartha S. Srinivasa,et al.  Manipulation planning with goal sets using constrained trajectory optimization , 2011, 2011 IEEE International Conference on Robotics and Automation.

[3]  Stefan Schaal,et al.  Inverse dynamics control of floating base systems using orthogonal decomposition , 2010, 2010 IEEE International Conference on Robotics and Automation.

[4]  Jun-Ho Oh,et al.  Mechanical design of humanoid robot platform KHR-3 (KAIST Humanoid Robot 3: HUBO) , 2005, 5th IEEE-RAS International Conference on Humanoid Robots, 2005..

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

[6]  J. Pasciak,et al.  Computer solution of large sparse positive definite systems , 1982 .

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

[8]  Siddhartha S. Srinivasa,et al.  CHOMP: Covariant Hamiltonian optimization for motion planning , 2013, Int. J. Robotics Res..

[9]  Mike Stilman,et al.  Navigation among movable obstacles , 2007 .

[10]  Kurt Konolige,et al.  Autonomous door opening and plugging in with a personal robot , 2010, 2010 IEEE International Conference on Robotics and Automation.

[11]  Kazuhito Yokoi,et al.  Whole-body motion of a humanoid robot for passing through a door - opening a door by impulsive force - , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[12]  Christopher G. Atkeson,et al.  Optimization and learning for rough terrain legged locomotion , 2011, Int. J. Robotics Res..

[13]  Siddhartha S. Srinivasa,et al.  CHOMP: Gradient optimization techniques for efficient motion planning , 2009, 2009 IEEE International Conference on Robotics and Automation.

[14]  Dinesh Manocha,et al.  FCL: A general purpose library for collision and proximity queries , 2012, 2012 IEEE International Conference on Robotics and Automation.

[15]  Jun-Ho Oh,et al.  Development of humanoid robot platform KHR-2 (KAIST humanoid robot-2) , 2004, 4th IEEE/RAS International Conference on Humanoid Robots, 2004..