Trade-off in the computation of minimum constraint removal paths for manipulation planning

Graphical Abstract Abstract The typical objective in path planning is to find the shortest feasible path. Many times, however, such paths may not be available given constraints, such as movable obstacles. This frequently happens in manipulation planning, where it may be desirable to identify the minimum set of movable obstacles to be cleared to manipulate a target object. This is a similar objective to that of the Minimum Constraint Removal (MCR) problem, which, however, does not exhibit dynamic programming properties, i.e. subsets of optimum solutions are not necessarily optimal. Thus, searching for MCR paths is computationally expensive. Motivated by this challenge and related work, this paper investigates approximations for computing MCR paths in the context of manipulation planning. The proposed framework searches for MCR paths up to a certain length of solution in terms of end-effector distance. This length can be defined as a multiple of the shortest path length in the space when movable objects are ignored. Given experimental evaluation on simulated manipulation planning challenges, the bounded-length approximation provides a desirable trade-off between minimizing constraints, computational cost, and path length.

[1]  Maxim Likhachev,et al.  Single- and dual-arm motion planning with heuristic search , 2014, Int. J. Robotics Res..

[2]  Leonidas J. Guibas,et al.  Disconnection proofs for motion planning , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[3]  Kostas E. Bekris,et al.  Rearranging similar objects with a manipulator using pebble graphs , 2014, 2014 IEEE-RAS International Conference on Humanoid Robots.

[4]  Rachid Alami,et al.  A geometrical approach to planning manipulation tasks. The case of discrete placements and grasps , 1991 .

[5]  Leslie Pack Kaelbling,et al.  Implicit belief-space pre-images for hierarchical planning and execution , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[6]  Yong K. Hwang,et al.  Practical path planning among movable obstacles , 1991, Proceedings. 1991 IEEE International Conference on Robotics and Automation.

[7]  Steven M. LaValle,et al.  A Simple, but NP-Hard, Motion Planning Problem , 2013, AAAI.

[8]  Timothy Bretl,et al.  Proving path non-existence using sampling and alpha shapes , 2012, 2012 IEEE International Conference on Robotics and Automation.

[9]  Erik D. Demaine,et al.  PSPACE-completeness of sliding-block puzzles and other problems through the nondeterministic constraint logic model of computation , 2002, Theor. Comput. Sci..

[10]  Luciana S. Buriol,et al.  Finding Optimal Solutions to Sokoban Using Instance Dependent Pattern Databases , 2013, SOCS.

[11]  Kostas E. Bekris,et al.  High-Quality Tabletop Rearrangement with Overhand Grasps: Hardness Results and Fast Methods , 2017, Robotics: Science and Systems.

[12]  Jonathan Schaeffer,et al.  Using Abstraction for Planning in Sokoban , 2002, Computers and Games.

[13]  Kris K. Hauser,et al.  Minimum Constraint Displacement Motion Planning , 2013, Robotics: Science and Systems.

[14]  Gordon T. Wilfong Motion planning in the presence of movable obstacles , 1988, SCG '88.

[15]  Kostas E. Bekris,et al.  Dealing with Difficult Instances of Object Rearrangement , 2015, Robotics: Science and Systems.

[16]  Kostas E. Bekris,et al.  Computational Tradeoffs of Search Methods for Minimum Constraint Removal Paths , 2015, SOCS.

[17]  Nathan R. Sturtevant,et al.  Conflict-based search for optimal multi-agent pathfinding , 2012, Artif. Intell..

[18]  James J. Kuffner,et al.  Navigation among movable obstacles: real-time reasoning in complex environments , 2004, 4th IEEE/RAS International Conference on Humanoid Robots, 2004..

[19]  Emilio Frazzoli,et al.  Incremental sampling-based algorithm for minimum-violation motion planning , 2013, 52nd IEEE Conference on Decision and Control.

[20]  Bernhard Nebel,et al.  Coming up With Good Excuses: What to do When no Plan Can be Found , 2010, Cognitive Robotics.

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

[22]  Kostas E. Bekris,et al.  Efficiently solving general rearrangement tasks: A fast extension primitive for an incremental sampling-based planner , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[23]  Steven M. LaValle,et al.  Randomized Kinodynamic Planning , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[24]  James J. Kuffner,et al.  Planning Among Movable Obstacles with Artificial Constraints , 2008, WAFR.

[25]  Erik D. Demaine,et al.  PushPush and Push-1 are NP-hard in 2D , 2000, CCCG.

[26]  Siddhartha S. Srinivasa,et al.  Task Space Regions , 2011, Int. J. Robotics Res..

[27]  Kris K. Hauser,et al.  The minimum constraint removal problem with three robotics applications , 2014, Int. J. Robotics Res..

[28]  Swarat Chaudhuri,et al.  Incremental Task and Motion Planning: A Constraint-Based Approach , 2016, Robotics: Science and Systems.

[29]  Dinesh Manocha,et al.  A Simple Path Non-existence Algorithm Using C-Obstacle Query , 2006, WAFR.

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

[31]  Siddhartha S. Srinivasa,et al.  A Framework for Push-Grasping in Clutter , 2011, Robotics: Science and Systems.

[32]  Mark H. Overmars,et al.  An Effective Framework for Path Planning Amidst Movable Obstacles , 2006, WAFR.