High-Quality Tabletop Rearrangement with Overhand Grasps: Hardness Results and Fast Methods

This paper studies the underlying combinatorial structure of a class of object rearrangement problems, which appear frequently in applications. The problems involve multiple, similar-geometry objects placed on a flat, horizontal surface, where a robot can approach them from above and perform pick-and-place operations to rearrange them. The paper considers both the case where the start and goal object poses overlap, and where they do not. For overlapping poses, the primary objective is to minimize the number of pick-and-place actions and then to minimize the distance traveled by the end-effector. For the non-overlapping case, the objective is solely to minimize the end-effector distance. While such problems do not involve all the complexities of general rearrangement, they remain computationally hard challenges in both cases. This is shown through two-way reductions between well-understood, hard combinatorial challenges and these rearrangement problems. The benefit of the reduction is that there are well studied algorithms for solving these well-established combinatorial challenges. These algorithms can be very efficient in practice despite the hardness results. The paper builds on these reduction results to propose an algorithmic pipeline for dealing with the rearrangement problems. Experimental evaluation shows that the proposed pipeline achieves high-quality paths with regards to the optimization objectives. Furthermore, it exhibits highly desirable scalability as the number of objects increases in both the overlapping and non-overlapping setups.

[1]  Gilbert Laporte,et al.  Dynamic pickup and delivery problems , 2010, Eur. J. Oper. Res..

[2]  Steven M. LaValle,et al.  Multi-agent Path Planning and Network Flow , 2012, WAFR.

[3]  Tamim Asfour,et al.  Manipulation Planning Among Movable Obstacles , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[4]  Mark H. Overmars,et al.  Prioritized motion planning for multiple robots , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[6]  Refael Hassin,et al.  The swapping problem , 1992, Networks.

[7]  Arne Løkketangen,et al.  Creating lasso-solutions for the traveling salesman problem with pickup and delivery by Tabu search , 2006, Central Eur. J. Oper. Res..

[8]  Nicos Christofides,et al.  An Algorithm for the Vehicle-dispatching Problem , 1969 .

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

[10]  Refael Hassin,et al.  Multi-Color Pebble Motion on Graphs , 2009, Algorithmica.

[11]  Gilbert Laporte,et al.  The vehicle routing problem: An overview of exact and approximate algorithms , 1992 .

[12]  Surya P. N. Singh,et al.  V-REP: A versatile and scalable robot simulation framework , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[13]  William J. Cook,et al.  The Traveling Salesman Problem: A Computational Study , 2007 .

[14]  L. N. Wassenhove,et al.  Collection and Vehicle Routing Issues in Reverse Logistics , 2004 .

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

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

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

[18]  Rachid Alami,et al.  Combining symbolic and geometric planning to synthesize human-aware plans: toward more efficient combined search. , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[19]  Jun Ota,et al.  Rearrangement Planning of Multiple Movable Objects by a Mobile Robot , 2009, Adv. Robotics.

[20]  Mimmo Parente,et al.  A Linear-Time Algorithm for the Feasibility of Pebble Motion on Trees , 1999, Algorithmica.

[21]  Nicholas Roy,et al.  Asymptotically Optimal Planning under Piecewise-Analytic Constraints , 2016, WAFR.

[22]  S. Safra,et al.  On the hardness of approximating minimum vertex cover , 2005 .

[23]  Christos H. Papadimitriou,et al.  The Euclidean Traveling Salesman Problem is NP-Complete , 1977, Theor. Comput. Sci..

[24]  Howie Choset,et al.  Probabilistic path planning for multiple robots with subdimensional expansion , 2012, 2012 IEEE International Conference on Robotics and Automation.

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

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

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

[28]  Dinesh Manocha,et al.  Path Planning among Movable Obstacles: A Probabilistically Complete Approach , 2008, WAFR.

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

[30]  János Pach,et al.  Reconfigurations in Graphs and Grids , 2008, SIAM J. Discret. Math..

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

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

[33]  Esra Erdem,et al.  Geometric rearrangement of multiple movable objects on cluttered surfaces: A hybrid reasoning approach , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[34]  Greg N. Frederickson,et al.  Nonpreemptive Ensemble Motion Planning on a Tree , 1993, J. Algorithms.

[35]  Rachid Alami,et al.  A Hybrid Approach to Intricate Motion, Manipulation and Task Planning , 2009, Int. J. Robotics Res..

[36]  Gregory D. Hager,et al.  Sampling-Based Motion and Symbolic Action Planning with geometric and differential constraints , 2010, 2010 IEEE International Conference on Robotics and Automation.

[37]  Richard M. Karp,et al.  Reducibility among combinatorial problems" in complexity of computer computations , 1972 .

[38]  Nancy M. Amato,et al.  Disassembly sequencing using a motion planning approach , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

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

[40]  Matei T. Ciocarlie,et al.  Hand Posture Subspaces for Dexterous Robotic Grasping , 2009, Int. J. Robotics Res..

[41]  Akansel Cosgun,et al.  Push planning for object placement on cluttered table surfaces , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[42]  Chul E. Kim,et al.  Approximation algorithms for some routing problems , 1976, 17th Annual Symposium on Foundations of Computer Science (sfcs 1976).

[43]  Leslie Pack Kaelbling,et al.  FFRob: An Efficient Heuristic for Task and Motion Planning , 2015, WAFR.

[44]  Paul G. Spirakis,et al.  Coordinating Pebble Motion on Graphs, the Diameter of Permutation Groups, and Applications , 2015, FOCS.

[45]  Dan Halperin,et al.  On the hardness of unlabeled multi-robot motion planning , 2014, Int. J. Robotics Res..

[46]  Gilbert Laporte,et al.  Static pickup and delivery problems: a classification scheme and survey , 2007 .

[47]  Ehud Rivlin,et al.  Practical pushing planning for rearrangement tasks , 1996, Proceedings of IEEE International Conference on Robotics and Automation.

[48]  Hermann Schichl,et al.  An Exact Method for the Minimum Feedback Arc Set Problem , 2021, ACM J. Exp. Algorithmics.

[49]  Jean-Claude Latombe,et al.  Geometric Reasoning About Mechanical Assembly , 1994, Artif. Intell..

[50]  David S. Johnson,et al.  Computers and Intractability: A Guide to the Theory of NP-Completeness , 1978 .

[51]  Dinesh Manocha,et al.  Centralized path planning for multiple robots: Optimal decoupling into sequential plans , 2009, Robotics: Science and Systems.

[52]  Danica Kragic,et al.  Data-Driven Grasp Synthesis—A Survey , 2013, IEEE Transactions on Robotics.

[53]  Thierry Siméon,et al.  Multiple Path Coordination for Mobile Robots: A Geometric Algorithm , 1999, IJCAI.

[54]  Jean-Claude Latombe,et al.  A General Framework for Assembly Planning: The Motion Space Approach , 1998, SCG '98.

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

[56]  Dan Halperin,et al.  Motion Planning for Unlabeled Discs with Optimality Guarantees , 2015, Robotics: Science and Systems.

[57]  Gilbert Laporte,et al.  General solutions to the single vehicle routing problem with pickups and deliveries , 2007, Eur. J. Oper. Res..

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

[59]  Boris Aronov,et al.  Motion Planning for Multiple Robots , 1998, SCG '98.

[60]  Richard M. Karp,et al.  Reducibility Among Combinatorial Problems , 1972, 50 Years of Integer Programming.

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

[62]  Emilio Frazzoli,et al.  Asymptotically Optimal Algorithms for One-to-One Pickup and Delivery Problems With Applications to Transportation Systems , 2012, IEEE Transactions on Automatic Control.

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

[64]  Steven M. LaValle,et al.  Optimal Multirobot Path Planning on Graphs: Complete Algorithms and Effective Heuristics , 2015, IEEE Transactions on Robotics.