Solving Task Space Problems with Multi-Step Planning

Modern robotics research has developed a mature family of planners for solving robot motion planning problems, but task space problems (where we want to reason about objects) remain difficult. Other approaches for solving what are often referred to as combined task and motion planning problems rely on bringing logical problem structure into the design of the high level planner. While programming assumptions around logical problem structure cannot be avoided, we propose the multistep planning approach which maintains high level generality while pushing these logical assumptions to a lower level of the program. Through experiments on a real robot and in simulation we demonstrate the ability of this architecture to solve real (though small) problems. We also demonstrate how carefully chosen heuristics can be key to making this approach faster. Note to Practitioners: This paper proposes techniques for using multi-step planning to solve problems defined in the way we would like objects to move in the space, rather than how we would like the robot to move. Successful applications of this technique will depend of the ability of the practitioner to define useful families of planning spaces, and provide algorithms that can plan and sample states in those families. Additionally, in order to get good performance, particularly on larger problems, the practitioner should provide an informative heuristic that matches the cost function used in the planning process. Our results suggest that with good heuristics, multi-step planning could be a practical technique for problems with relatively small search complexity, and suggest the potential for developing stronger heuristics to target larger problems.

[1]  Stefan Schaal,et al.  STOMP: Stochastic trajectory optimization for motion planning , 2011, 2011 IEEE International Conference on Robotics and Automation.

[2]  Oliver Brock,et al.  Interactive Perception of Articulated Objects , 2010, ISER.

[3]  Sven Koenig,et al.  Fast replanning for navigation in unknown terrain , 2005, IEEE Transactions on Robotics.

[4]  S. LaValle,et al.  Randomized Kinodynamic Planning , 2001 .

[5]  Anthony Stentz,et al.  Optimal and efficient path planning for partially-known environments , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[6]  Lydia E. Kavraki,et al.  The Open Motion Planning Library , 2012, IEEE Robotics & Automation Magazine.

[7]  Thierry Siméon,et al.  Manipulation Planning with Probabilistic Roadmaps , 2004, Int. J. Robotics Res..

[8]  Swarat Chaudhuri,et al.  SMT-based synthesis of integrated task and motion plans from plan outlines , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[9]  Pieter Abbeel,et al.  Combined task and motion planning through an extensible planner-independent interface layer , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[10]  Timothy Bretl,et al.  Learning-Assisted Multi-Step Planning , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[11]  Leslie Pack Kaelbling,et al.  A hierarchical approach to manipulation with diverse actions , 2013, 2013 IEEE International Conference on Robotics and Automation.

[12]  Wolfram Burgard,et al.  A Probabilistic Framework for Learning Kinematic Models of Articulated Objects , 2011, J. Artif. Intell. Res..

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

[14]  Maxim Likhachev,et al.  Multi-Heuristic A* , 2014, Int. J. Robotics Res..

[15]  Gaurav S. Sukhatme,et al.  Multi-step planning for robotic manipulation , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

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

[17]  Timothy Bretl,et al.  Multi-Step Motion Planning for Free-Climbing Robots , 2004, WAFR.

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

[19]  Emilio Frazzoli,et al.  Sampling-based algorithms for optimal motion planning , 2011, Int. J. Robotics Res..

[20]  Nils J. Nilsson,et al.  A Formal Basis for the Heuristic Determination of Minimum Cost Paths , 1968, IEEE Trans. Syst. Sci. Cybern..