Abstract:Graphs of Convex Sets (GCS) is a recent method for synthesizing smooth trajectories by decomposing the planning space into convex sets, forming a graph to encode the adjacency relationships within the decomposition, and then simultaneously searching this graph and optimizing parts of the trajectory to obtain the final trajectory. To do this, one must solve a Mixed Integer Convex Program (MICP) and to mitigate computational time, GCS proposes a convex relaxation that is empirically very tight. Despite this tight relaxation, motion planning with GCS for real-world robotics problems translates to solving the simultaneous batch optimization problem that may contain millions of constraints and therefore can be slow. This is further exacerbated by the fact that the size of the GCS problem is invariant to the planning query. Motivated by the observation that the trajectory solution lies only on a fraction of the set of convex sets, we present two implicit graph search methods for planning on the graph of convex sets called INSATxGCS (IxG) and IxG*. INterleaved Search And Trajectory optimization (INSAT) is a previously developed algorithm that alternates between searching on a graph and optimizing partial paths to find a smooth trajectory. By using an implicit graph search method INSAT on the graph of convex sets, we achieve faster planning while ensuring stronger guarantees on completeness and optimality. Moveover, introducing a search-based technique to plan on the graph of convex sets enables us to easily leverage well-established techniques such as search parallelization, lazy planning, anytime planning, and replanning as future work. Numerical comparisons against GCS demonstrate the superiority of IxG across several applications, including planning for an 18-degree-of-freedom multi-arm assembly scenario.

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

Implicit Graph Search for Planning on Graphs of Convex Sets

Multi-Query Shortest-Path Problem in Graphs of Convex Sets

Planning Shorter Paths in Graphs of Convex Sets by Undistorting Parametrized Configuration Spaces

Memoryless Cooperative Graph Search Based on the Simulated Annealing Algorithm

$A^*$ for Graphs of Convex Sets

Continuous Monte Carlo Graph Search

Learning Shortest Paths on Large Dynamic Graphs.

Motion planning around obstacles with convex optimization

GSC: A Graph and Spatio-Temporal Continuity Based Framework for Accident Anticipation

Heuristic path planning algorithm in continuous state spaces

Efficient Navigation for Constrained Shortest Path with Adaptive Expansion Control

Lazy Lifelong Planning for Efficient Replanning in Graphs with Expensive Edge Evaluation

Fast and optimal branch-and-bound planner for the grid-based coverage path planning problem based on an admissible heuristic function

A Self-Adaptive and Gradient-Based Cuckoo Search Algorithm for Global Optimization

Effective and Efficient Community Search over Large Directed Graphs

Learning real-time search on c-space GVDs

Generalized Planning as Heuristic Search: A new planning search-space that leverages pointers over objects

Graph Planarization Problem Optimization Based on Triple-Valued Gravitational Search Algorithm

Optimal Solving of Constrained Path-Planning Problems with Graph Convolutional Networks and Optimized Tree Search

Convolutionally evaluated gradient first search path planning algorithm without prior global maps