Search papers, labs, and topics across Lattice.
This paper introduces GCS-Bridging, a method that addresses the challenge of disconnected convex sets in Graph-of-Convex-Sets (GCS) trajectory optimization by reconnecting them through collision-free point paths and subsequent convex region inflation. The approach is significant as it enables successful planning in scenarios where the start and goal regions are initially in different connected components, which is a common limitation in existing GCS methods. Extensive simulations and a real-world hardware experiment demonstrate a remarkable 99.8% success rate in restoring connectivity for motion planning tasks.
Achieving a 99.8% success rate in reconnecting initially disconnected convex regions transforms the feasibility of GCS-based motion planning.
Graph-of-Convex-Sets (GCS)-based trajectory optimization represents collision-free regions in configuration space as a finite collection of convex sets and directly performs collision-free trajectory planning over these sets, substantially simplifying the planning process. However, existing GCS-based trajectory planning methods generally assume sufficient connectivity among the convex regions and do not explicitly address cases in which the start and goal regions belong to different connected components of the initial GCS map. To address this limitation, we propose GCS-Bridging, which reconnects disconnected convex regions through collision-free point paths followed by convex region inflation, thereby recovering the feasibility of otherwise disconnected GCS planning problems. Extensive simulations across multiple IRIS-related algorithms and scenarios demonstrate that GCS-Bridging restores missing start-to-goal connectivity in the initial GCS map with a 99.8% success rate. In addition, a hardware experiment on a single-arm Franka platform in a real-world scenario with initially disconnected start and goal regions validates the effectiveness of the proposed method in practical motion planning. Project website: https://zhouxk1997.github.io/GCS_Bridging/
Tsinghua AI