Tree Search-based Task and Motion Planning with Prehensile and Non-prehensile Manipulation for Obstacle Rearrangement in Clutter

We propose a tree search-based planning algorithm for a robot manipulator to rearrange objects and grasp a target in a dense space. We consider environments where tasks cannot be completed with prehensile planning only. As assuming that a manipulator is only allowed to grasp from the top, we aim to minimize the number of rearrangement actions and the total execution time, which affects the efficiency of manipulation. The proposed search algorithm determines the optimal sequence of object rearrangement with prehensile and non-prehensile grasping until grasping a target. For non-prehensile grasping, a heuristic function is employed to model frictions and contacts between objects and a table. Experimental results in a realistic simulated environment show that the proposed algorithm can reduce the number of rearranged obstacles up to 27% and the total execution time up to 15% with 14 objects compared to the previous work.

[1]  Tamim Asfour,et al.  Predicting Pushing Action Effects on Spatial Object Relations by Learning Internal Prediction Models , 2020, 2020 IEEE International Conference on Robotics and Automation (ICRA).

[2]  Changjoo Nam,et al.  Fast and resilient manipulation planning for target retrieval in clutter , 2020, 2020 IEEE International Conference on Robotics and Automation (ICRA).

[3]  Maxim Likhachev,et al.  Planning with Selective Physics-based Simulation for Manipulation Among Movable Objects , 2020, 2020 IEEE International Conference on Robotics and Automation (ICRA).

[4]  Mehmet R. Dogar,et al.  Human-like Planning for Reaching in Cluttered Environments , 2020, 2020 IEEE International Conference on Robotics and Automation (ICRA).

[5]  Dieter Fox,et al.  6-DOF Grasping for Target-driven Object Manipulation in Clutter , 2019, 2020 IEEE International Conference on Robotics and Automation (ICRA).

[6]  Mehmet Remzi Dogar,et al.  Non-Prehensile Manipulation in Clutter with Human-In-The-Loop , 2019, 2020 IEEE International Conference on Robotics and Automation (ICRA).

[7]  ChangHwan Kim,et al.  Efficient Obstacle Rearrangement for Object Manipulation Tasks in Cluttered Environments , 2019, 2019 International Conference on Robotics and Automation (ICRA).

[8]  Danica Kragic,et al.  Rearrangement with Nonprehensile Manipulation Using Deep Reinforcement Learning , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[9]  Alberto Rodriguez,et al.  Friction Variability in Planar Pushing Data: Anisotropic Friction and Data-Collection Bias , 2018, IEEE Robotics and Automation Letters.

[10]  Mark Moll,et al.  Randomized Physics-Based Motion Planning for Grasping in Cluttered and Uncertain Environments , 2017, IEEE Robotics and Automation Letters.

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

[12]  Leslie Pack Kaelbling,et al.  A constraint-based method for solving sequential manipulation planning problems , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[13]  Leslie Pack Kaelbling,et al.  Integrated task and motion planning in belief space , 2013, Int. J. Robotics Res..

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

[15]  S. Srinivasa,et al.  A Planning Framework for Non-Prehensile Manipulation under Clutter and Uncertainty , 2012, Autonomous Robots.

[16]  Sachin Chitta,et al.  MoveIt! [ROS Topics] , 2012, IEEE Robotics Autom. Mag..

[17]  Nobuto Matsuhira,et al.  Virtual Robot Experimentation Platform V-REP: A Versatile 3D Robot Simulator , 2010, SIMPAR.

[18]  Gerd Hirzinger,et al.  Bridging the Gap between Task Planning and Path Planning , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[20]  R. K. Shyamasundar,et al.  Introduction to algorithms , 1996 .