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.
Access this chapter
Tax calculation will be finalised at checkout
Purchases are for personal use only
Notes
- 1.
The distinction between facts captured or not captured by the configuration space is largely a choice of granularity in representation.
- 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.
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
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)
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
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
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)
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
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)
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)
Coumans, E., et al.: Bullet physics library (2013)
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)
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
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)
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
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))
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
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)
Hauser, K., Latombe, J.C.: Multi-modal motion planning in non-expansive spaces. Int. J. Robot. Res. 29(7), 897–915 (2010)
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)
Hoffmann, J., Nebel, B.: The FF planning system: fast plan generation through heuristic search. J. Artif. Intell. Res. 14, 263–312 (2001)
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)
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)
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)
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)
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)
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)
LaValle, S.M.: Planning Algorithms. Cambridge University Press, Cambridge (2006)
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
LaValle, S.M.: Rapidly-exploring random trees: a new tool for path planning. Technical report, pp. 98–11. Iowa State University (1998)
Drew McDermott: PDDL - the planning domain definition language. In: AIPS Planning Competition (1998)
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)
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
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
Sucan, I.A., Moll, M., Kavraki, L.E.: The open motion planning library. IEEE Rob. Autom. Mag. 19(4), 72–82 (2012)
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)
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
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)
Author information
Authors and Affiliations
Corresponding author
Editor information
Editors and Affiliations
1 Electronic supplementary material
Below is the link to the electronic supplementary material.
Rights and permissions
Copyright information
© 2022 The Author(s), under exclusive license to Springer Nature Switzerland AG
About this paper
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
DOI: https://doi.org/10.1007/978-3-030-95459-8_47
Published:
Publisher Name: Springer, Cham
Print ISBN: 978-3-030-95458-1
Online ISBN: 978-3-030-95459-8
eBook Packages: Intelligent Technologies and RoboticsIntelligent Technologies and Robotics (R0)