Jump to Content
  1. Queen's
  2. Smith Eng.
  3. ECE

Estimation, Search, and Planning (ESP) Research Group

ESP @ IROS 2022 — Task and Motion Informed Trees (TMIT*)

Jonathan worked with Wil Thomason and Marlin to apply asymmetric bidirectional search to task and motion planning (TMP). Task and Motion Informed Trees (TMIT*) is an anytime TMP algorithm that finds initial solutions and then improves them as time allows. It has been published in RA-L and is being presented at IROS in Kyoto, Japan. The code is available open source and you can watch the presentation video on YouTube and read the paper on arXiv. Wil is a postdoctoral research associate in Lydia Kavraki's group at Rice University.

Authors
  1. W. Thomason
  2. M. P. Strub
  3. J. D. Gammell
Title
Task and Motion Informed Trees (TMIT*): Almost-surely asymptotically optimal integrated task and motion planning
Publication
Journal
IEEE Robotics and Automation Letters (RA-L)
Volume
7
Number
4
Pages
11370–11377
Date
Notes
Presented at IROS 2022
Code
Code
Presentations
Presentation
PDFs
PDF
Digital Object Identifier (DOI)
doi: 10.1109/LRA.2022.3199676
arXiv
Google Scholar
Google Scholar

Abstract

High-level autonomy requires discrete and continuous reasoning to decide both what actions to take and how to execute them. Integrated Task and Motion Planning (TMP) algorithms solve these hybrid problems jointly to consider constraints between the discrete symbolic actions (i.e., the task plan) and their continuous geometric realization (i.e., motion plans). This joint approach solves more difficult problems than approaches that address the task and motion subproblems independently.

TMP algorithms combine and extend results from both task and motion planning. TMP has mainly focused on computational performance and completeness and less on solution optimality. Optimal TMP is difficult because the independent optima of the subproblems may not be the optimal integrated solution, which can only be found by jointly optimizing both plans.

This paper presents Task and Motion Informed Trees (TMIT*), an optimal TMP algorithm that combines results from makespan-optimal task planning and almost-surely asymptotically optimal motion planning. TMIT* interleaves asymmetric forward and reverse searches to delay computationally expensive operations until necessary and perform an efficient informed search directly in the problem’s hybrid state space. This allows it to solve problems quickly and then converge towards the optimal solution with additional computational time, as demonstrated on the evaluated robotic-manipulation benchmark problems.