Abstract:—Task and Motion Planning (TAMP) requires the integration of symbolic reasoning with metric motion planning that accounts for the robot’s actions’ geometric feasibility. This hierarchical structure inevitably prevents the symbolic planners from accessing the environment’s low-level geometric description, vital to the problem’s solution. Most TAMP approaches fail to provide feasible solutions when there is missing knowledge about the environment at the symbolic level. The incapability of devising alternative high-level plans leads existing planners to a dead end. We propose a novel approach for decision-making on extended decision spaces over plan skeletons and action parameters. We integrate top-k planning for constructing an explicit skeleton space, where a skeleton planner generates a variety of candidate skeleton plans. Moreover, we effectively combine this skeleton space with the resultant motion parameter spaces into a single extended decision space. Accordingly, we use Monte-Carlo Tree Search (MCTS) to ensure an exploration-exploitation balance at each decision node and optimize globally to produce minimum-cost solutions. The proposed seamless combination of symbolic top-k planning with streams, with the proved optimality of MCTS, leads to a powerful planning algorithm that can handle the combinatorial complexity of long-horizon manipulation tasks. We empirically evaluate our proposed algorithm in challenging manipulation tasks with different domains that require multi-stage decisions and show how our method can overcome dead-ends through its effective alternate plans compared to its most competitive baseline method.

Task and motion planning using mixed integer linear programming for solving fetch-and-carry tasks by a mobile manipulator

Dynamical Obstacle Avoidance of Task- Constrained Mobile Manipulation Using Model Predictive Control

Fast MILP-based Task and Motion Planning for Pick-and-Place with Hard/Soft Constraints of Collision-Free Route

Implicit Contact-Rich Manipulation Planning for a Manipulator with Insufficient Payload

An Interleaved Algorithm for Integration of Robotic Task and Motion Planning

Toward Holistic Planning and Control Optimization for Dual-Arm Rearrangement

Anticipatory Task and Motion Planning

Differentiable Task Assignment and Motion Planning

R-LGP: A Reachability-guided Logic-geometric Programming Framework for Optimal Task and Motion Planning on Mobile Manipulators

Optimization-based Motion Planning of Mobile Manipulator with High Degree of Kinematic Redundancy

Simultaneous Optimization of Task Allocation and Path Planning Using Mixed-Integer Programming for Time and Capacity Constrained Multi-Agent Pickup and Delivery

Extended Task and Motion Planning of Long-horizon Robot Manipulation

A novel coordinated motion planner based on capability map for autonomous mobile manipulator

Motion Planning for a Mobile Manipulator Considering Stability and Task Constraints

Planning for Complex Non-prehensile Manipulation Among Movable Objects by Interleaving Multi-Agent Pathfinding and Physics-Based Simulation

A Task-Priority Coordinated Motion Planner Combined with Visual Servo for Mobile Manipulator*

Dynamic Planning for Sequential Whole-body Mobile Manipulation

Collision-Free Motion Planning of a Six-Link Manipulator Used in a Citrus Picking Robot

PAAMP: Polytopic Action-Set And Motion Planning for Long Horizon Dynamic Motion Planning via Mixed Integer Linear Programming

Cooperative Motion Planning for Mobile Humanoid Robots Based on the Manipulability Map

Efficient online motion planning method for the robotic arm to pick-up moving objects smoothly with temporal constraints