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

Fuente: arXiv
Saved in:
Bibliographic Details
Main Authors: Garg, Shruti, Cohn, Thomas, Tedrake, Russ
Format: Preprint
Published: 2024
Subjects:
Online Access:
Tags: Add Tag
No Tags, Be the first to tag this record!
_version_ 1866916687094218752
author Garg, Shruti
Cohn, Thomas
Tedrake, Russ
author_facet Garg, Shruti
Cohn, Thomas
Tedrake, Russ
contents Optimization based motion planning provides a useful modeling framework through various costs and constraints. Using Graph of Convex Sets (GCS) for trajectory optimization gives guarantees of feasibility and optimality by representing configuration space as the finite union of convex sets. Nonlinear parametrizations can be used to extend this technique to handle cases such as kinematic loops, but this distorts distances, such that solving with convex objectives will yield paths that are suboptimal in the original space. We present a method to extend GCS to nonconvex objectives, allowing us to "undistort" the optimization landscape while maintaining feasibility guarantees. We demonstrate our method's efficacy on three different robotic planning domains: a bimanual robot moving an object with both arms, the set of 3D rotations using Euler angles, and a rational parametrization of kinematics that enables certifying regions as collision free. Across the board, our method significantly improves path length and trajectory duration with only a minimal increase in runtime. Website: https://shrutigarg914.github.io/pgd-gcs-results/
format Preprint
id arxiv_https___arxiv_org_abs_2411_18913
institution arXiv
publishDate 2024
record_format arxiv
spellingShingle Planning Shorter Paths in Graphs of Convex Sets by Undistorting Parametrized Configuration Spaces
Garg, Shruti
Cohn, Thomas
Tedrake, Russ
Robotics
Optimization based motion planning provides a useful modeling framework through various costs and constraints. Using Graph of Convex Sets (GCS) for trajectory optimization gives guarantees of feasibility and optimality by representing configuration space as the finite union of convex sets. Nonlinear parametrizations can be used to extend this technique to handle cases such as kinematic loops, but this distorts distances, such that solving with convex objectives will yield paths that are suboptimal in the original space. We present a method to extend GCS to nonconvex objectives, allowing us to "undistort" the optimization landscape while maintaining feasibility guarantees. We demonstrate our method's efficacy on three different robotic planning domains: a bimanual robot moving an object with both arms, the set of 3D rotations using Euler angles, and a rational parametrization of kinematics that enables certifying regions as collision free. Across the board, our method significantly improves path length and trajectory duration with only a minimal increase in runtime. Website: https://shrutigarg914.github.io/pgd-gcs-results/
title Planning Shorter Paths in Graphs of Convex Sets by Undistorting Parametrized Configuration Spaces
topic Robotics
url https://arxiv.org/abs/2411.18913