Skip to main content

A Unified Sampling-Based Approach to Integrated Task and Motion Planning

  • Conference paper
  • First Online:
Robotics Research (ISRR 2019)

Part of the book series: Springer Proceedings in Advanced Robotics ((SPAR,volume 20))

Included in the following conference series:

Abstract

We present a novel method for performing integrated task and motion planning (TMP) by adapting any off-the-shelf sampling-based motion planning algorithm to simultaneously solve for a symbolically and geometrically feasible plan using a single motion planner invocation. The core insight of our technique is an embedding of symbolic state into continuous space, coupled with a novel means of automatically deriving a function guiding a planner to regions of continuous space where symbolic actions can be executed. Our technique makes few assumptions and offers a great degree of flexibility and generality compared to state of the art planners. We describe our technique and offer a proof of probabilistic completeness along with empirical evaluation of our technique on manipulation benchmark problems.

This material is based upon work supported by the National Science Foundation under Grant No. 1646417 and by the Department of Defense (DoD) through the National Defense Science & Engineering Graduate Fellowship (NDSEG) Program. We are grateful for this support.

This is a preview of subscription content, log in via an institution to check access.

Access this chapter

Chapter
USD 29.95
Price excludes VAT (USA)
  • Available as PDF
  • Read on any device
  • Instant download
  • Own it forever
eBook
USD 169.00
Price excludes VAT (USA)
  • Available as EPUB and PDF
  • Read on any device
  • Instant download
  • Own it forever
Softcover Book
USD 219.99
Price excludes VAT (USA)
  • Compact, lightweight edition
  • Dispatched in 3 to 5 business days
  • Free shipping worldwide - see info
Hardcover Book
USD 219.99
Price excludes VAT (USA)
  • Durable hardcover edition
  • Dispatched in 3 to 5 business days
  • Free shipping worldwide - see info

Tax calculation will be finalised at checkout

Purchases are for personal use only

Institutional subscriptions

Notes

  1. 1.

    The distinction between facts captured or not captured by the configuration space is largely a choice of granularity in representation.

  2. 2.

    Although we restrict ourselves to this sufficient set of operators in this paper, \(\epsilon \)-weakening can be extended to allow a broader operator set.

  3. 3.

    For deterministic, stateless \(\mathbb {H}\), the set of actions returned will be the same on every invocation. If \(\mathbb {H}\) tracks the set of actions already suggested or is nondeterministic, then the set of actions returned may differ on subsequent invocations of \(\mathbb {H}\) for q.

References

  1. Alami, R., Siméon, T., Laumond, J.-P.: A geometrical approach to planning manipulation tasks. In: Proceedings International Symposium on Robotics Research, pp. 113–119 (1989)

    Google Scholar 

  2. Barry, J., Hsiao, K., Kaelbling, L.P., Lozano-Pérez, T.: Manipulation with multiple action types. In: Desai, J., Dudek, G., Khatib, O., Kumar, V. (eds.) International Symposium on Experimental Robotics (ISER), vol. 88, pp. 531–545. Springer, Cham (2013). https://doi.org/10.1007/978-3-319-00065-7_36

  3. Barry, J., Hsiao, K., Kaelbling, L.P., Lozano-Pérez, T.: A hierarchical approach to manipulation with diverse actions. In: 2013 IEEE International Conference on Robotics and Automation (ICRA), pp. 1799–1806. IEEE, May 2013

    Google Scholar 

  4. Berenson, D., Srinivasa, S., Kuffner, J.: Task space regions: a framework for pose-constrained manipulation planning. Int. J. Robot. Res. 30(12), 1435–1460 (2011)

    Google Scholar 

  5. Branicky, M.S., Curtiss, M.M., Levine, J.A., Morgan, S.B.: RRTs for nonlinear, discrete, and hybrid planning and control. In: 42nd IEEE International Conference on Decision and Control, vol. 1, pp. 657–663. IEEE (2003). IEEE Cat. No. 03CH37475

    Google Scholar 

  6. Burfoot, D., Pineau, J., Dudek, G.: RRT-plan: a randomized algorithm for strips planning. In: Proceedings of the Sixteenth International Conference on International Conference on Automated Planning and Scheduling. ICAPS 2006. AAAI Press, pp. 362–365 (2006)

    Google Scholar 

  7. Cambon, S., Alami, R., Gravot, F.: A hybrid approach to intricate motion, manipulation and task planning. Int. J. Robot. Res. 28(1), 104–126 (2009)

    Google Scholar 

  8. Coumans, E., et al.: Bullet physics library (2013)

    Google Scholar 

  9. Dantam, N.T., Kingston, Z.K., Chaudhuri, S., Kavraki, L.E.: Incremental task and motion planning: a constraint-based approach. In: Robotics: Science and Systems XII (2016)

    Google Scholar 

  10. Dornhege, C., Eyerich, P., Keller, T., Trüg, S., Brenner, M., Nebel, B.: Semantic attachments for domain-independent planning systems. In: Prassler, E., et al. (eds.) Towards Service Robots for Everyday Environments, vol. 76, pp. 99–115. Springer, Heidelberg (2012). https://doi.org/10.1007/978-3-642-25116-0_9

  11. Fikes, R.E., Nilsson, N.J.: STRIPS: a new approach to the application of theorem proving to problem solving. Artif. Intell. 2(3–4), pp. 189–208 (1971)

    Google Scholar 

  12. Garrett, C.R., Lozano-Pérez, T., Kaelbling, L.P.: FFRob: an efficient heuristic for task and motion planning. In: Akin, H., Amato, N., Isler, V., van der Stappen, A. (eds.) International Workshop on the Algorithmic Foundations of Robotics (WAFR), pp. 179–195. Springer, Cham (2014). https://doi.org/10.1007/978-3-319-16595-0_11

  13. Garrett, C.R., Lozano-Pérez, T., Kaelbling, L.P.: Sampling-based methods for factored task and motion planning. Int. J. Robot. Res. 37(13–14), 1796–1825 (2018))

    Google Scholar 

  14. Grossman, R.L., Nerode, A., Ravn, A.P., Rischel, H.: Hybrid Systems. vol. 736. Springer, Cham (1993). https://doi.org/10.1007/3-540-57318-6

  15. Hauser, K., Latombe, J.C.: Integrating task and PRM motion planning: dealing with many infeasible motion planning queries. In: ICAPS 2009 Workshop on Bridging the Gap between Task and Motion Planning. ICAPS 2009 (2009)

    Google Scholar 

  16. Hauser, K., Latombe, J.C.: Multi-modal motion planning in non-expansive spaces. Int. J. Robot. Res. 29(7), 897–915 (2010)

    Google Scholar 

  17. Hauser, K., Ng-Thow-Hing, V.: Randomized multi-modal motion planning for a humanoid robot manipulation task. Int. J. Robot. Res. 30(6) 678–698 (2011)

    Google Scholar 

  18. Hoffmann, J., Nebel, B.: The FF planning system: fast plan generation through heuristic search. J. Artif. Intell. Res. 14, 263–312 (2001)

    Google Scholar 

  19. Kaelbling, L., Lozano-Perez, T.: Hierarchical task and motion planning in the now. In: 2011 IEEE International Conference on Robotics and Automation, pp. 1470–1477. IEEE (2011)

    Google Scholar 

  20. Kavraki, L.E., Svestka, P., Latombe, J.C., Overmars, M.H.: Probabilistic roadmaps for path planning in high-dimensional configuration spaces. IEEE Trans. Robot. Autom. 12(4), 566–580 (1996)

    Google Scholar 

  21. Kingston, Z., Moll, M., Kavraki, L.E.: Sampling-based methods for motion planning with constraints. In: Annual Review of Control, Robotics, and Autonomous Systems, vol. 1, no. 1, pp. 159–185 (2018)

    Google Scholar 

  22. Lagriffoul, F., Dantam, N.T., Garrett, C., Akbari, A., Srivastava, S., Kavraki, L.E.: Platform-independent benchmarks for task and motion planning. IEEE Robot. Autom. Lett. 3(4), 3765–3772 (2018)

    Google Scholar 

  23. Lagriffoul, F., Dimitrov, D., Bidot, J., Saffiotti, A., Karlsson, L.: Efficiently combining task and motion planning using geometric constraints. Int. J. Robot. Res. 33(14), 1726–1747 (2014)

    Google Scholar 

  24. Lagriffoul, F., Dimitrov, D., Saffiotti, A., Karlsson, L.: Constraint propagation on interval bounds for dealing with geometric backtracking. In: IEEE International Conference on Intelligent Robots and Systems, pp. 957–964 (2012)

    Google Scholar 

  25. LaValle, S.M.: Planning Algorithms. Cambridge University Press, Cambridge (2006)

    Google Scholar 

  26. LaValle, S.M.: From dynamic programming to RRTs: algorithmic design of feasible trajectories. In: Bicchi, A., Prattichizzo, D., Christensen, H.I. (eds.) Control Problems in Robotics, vol. 4. Springer, Heidelberg, pp. 19–37 (2003) .https://doi.org/10.1007/3-540-36224-X_2

  27. LaValle, S.M.: Rapidly-exploring random trees: a new tool for path planning. Technical report, pp. 98–11. Iowa State University (1998)

    Google Scholar 

  28. Drew McDermott: PDDL - the planning domain definition language. In: AIPS Planning Competition (1998)

    Google Scholar 

  29. Plaku, E., Hager, G.D.: Sampling-based motion and symbolic action planning with geometric and differential constraints. In: Proceedings – IEEE International Conference on Robotics and Automation, pp. 5002–5008 (2010)

    Google Scholar 

  30. Schmitt, P.S., Neubauer, W., Feiten, W., Wurm, K.M., Wichert, G.V., Burgard, W.: Optimal, sampling-based manipulation planning. In: 2017 IEEE International Conference on Robotics and Automation (ICRA), pp. 3426–3432, May 2017

    Google Scholar 

  31. Srivastava, S., Fang, E., Riano, L., Chitnis, R., Russell, S., Abbeel, P.: Combined task and motion planning through an extensible planner-independent interface layer. In: 2014 IEEE International Conference on Robotics and Automation (ICRA), pp. 639–646, May 2014

    Google Scholar 

  32. Sucan, I.A., Moll, M., Kavraki, L.E.: The open motion planning library. IEEE Rob. Autom. Mag. 19(4), 72–82 (2012)

    Google Scholar 

  33. Toussaint, M.: Logic-geometric programming: an optimization-based approach to combined task and motion planning. In: International Joint Conference on Artificial Intelligence, p. 7 (2015)

    Google Scholar 

  34. Toussaint, M.A., Allen, K.R., Smith, K.A., Tenenbaum, J.B.: Differentiable physics and stable modes for tool-use and manipulation planning. In: Robotics: Science and Systems Foundation, 26 June 2018

    Google Scholar 

  35. Vasile, C.I., Raman, V., Karaman, S.: Sampling-based synthesis of maximally-satisfying controllers for temporal logic specifications. In: 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 3840–3847. IEEE (2017)

    Google Scholar 

Download references

Author information

Authors and Affiliations

Authors

Corresponding author

Correspondence to Wil Thomason .

Editor information

Editors and Affiliations

1 Electronic supplementary material

Below is the link to the electronic supplementary material.

Supplementary material 1 (ppt 261 KB)

Rights and permissions

Reprints and permissions

Copyright information

© 2022 The Author(s), under exclusive license to Springer Nature Switzerland AG

About this paper

Check for updates. Verify currency and authenticity via CrossMark

Cite this paper

Thomason, W., Knepper, R.A. (2022). A Unified Sampling-Based Approach to Integrated Task and Motion Planning. In: Asfour, T., Yoshida, E., Park, J., Christensen, H., Khatib, O. (eds) Robotics Research. ISRR 2019. Springer Proceedings in Advanced Robotics, vol 20. Springer, Cham. https://doi.org/10.1007/978-3-030-95459-8_47

Download citation

Publish with us

Policies and ethics