GCS*: Forward Heuristic Search on Implicit Graphs of Convex Sets

Fuente: arXiv
Enregistré dans:
Détails bibliographiques
Auteurs principaux: Chia, Shao Yuan Chew, Jiang, Rebecca H., Graesdal, Bernhard Paus, Kaelbling, Leslie Pack, Tedrake, Russ
Format: Preprint
Publié: 2024
Sujets:
Accès en ligne:
Tags: Ajouter un tag
Pas de tags, Soyez le premier à ajouter un tag!
_version_ 1866912149712928768
author Chia, Shao Yuan Chew
Jiang, Rebecca H.
Graesdal, Bernhard Paus
Kaelbling, Leslie Pack
Tedrake, Russ
author_facet Chia, Shao Yuan Chew
Jiang, Rebecca H.
Graesdal, Bernhard Paus
Kaelbling, Leslie Pack
Tedrake, Russ
contents We consider large-scale, implicit-search-based solutions to Shortest Path Problems on Graphs of Convex Sets (GCS). We propose GCS*, a forward heuristic search algorithm that generalizes A* search to the GCS setting, where a continuous-valued decision is made at each graph vertex, and constraints across graph edges couple these decisions, influencing costs and feasibility. Such mixed discrete-continuous planning is needed in many domains, including motion planning around obstacles and planning through contact. This setting provides a unique challenge for best-first search algorithms: the cost and feasibility of a path depend on continuous-valued points chosen along the entire path. We show that by pruning paths that are cost-dominated over their entire terminal vertex, GCS* can search efficiently while still guaranteeing cost-optimality and completeness. To find satisficing solutions quickly, we also present a complete but suboptimal variation, pruning instead reachability-dominated paths. We implement these checks using polyhedral-containment or sampling-based methods. The former implementation is complete and cost-optimal, while the latter is probabilistically complete and asymptotically cost-optimal and performs effectively even with minimal samples in practice. We demonstrate GCS* on planar pushing tasks where the combinatorial explosion of contact modes renders prior methods intractable and show it performs favorably compared to the state-of-the-art. Project website: https://shaoyuan.cc/research/gcs-star/
format Preprint
id arxiv_https___arxiv_org_abs_2407_08848
institution arXiv
publishDate 2024
record_format arxiv
spellingShingle GCS*: Forward Heuristic Search on Implicit Graphs of Convex Sets
Chia, Shao Yuan Chew
Jiang, Rebecca H.
Graesdal, Bernhard Paus
Kaelbling, Leslie Pack
Tedrake, Russ
Robotics
We consider large-scale, implicit-search-based solutions to Shortest Path Problems on Graphs of Convex Sets (GCS). We propose GCS*, a forward heuristic search algorithm that generalizes A* search to the GCS setting, where a continuous-valued decision is made at each graph vertex, and constraints across graph edges couple these decisions, influencing costs and feasibility. Such mixed discrete-continuous planning is needed in many domains, including motion planning around obstacles and planning through contact. This setting provides a unique challenge for best-first search algorithms: the cost and feasibility of a path depend on continuous-valued points chosen along the entire path. We show that by pruning paths that are cost-dominated over their entire terminal vertex, GCS* can search efficiently while still guaranteeing cost-optimality and completeness. To find satisficing solutions quickly, we also present a complete but suboptimal variation, pruning instead reachability-dominated paths. We implement these checks using polyhedral-containment or sampling-based methods. The former implementation is complete and cost-optimal, while the latter is probabilistically complete and asymptotically cost-optimal and performs effectively even with minimal samples in practice. We demonstrate GCS* on planar pushing tasks where the combinatorial explosion of contact modes renders prior methods intractable and show it performs favorably compared to the state-of-the-art. Project website: https://shaoyuan.cc/research/gcs-star/
title GCS*: Forward Heuristic Search on Implicit Graphs of Convex Sets
topic Robotics
url https://arxiv.org/abs/2407.08848