Saved in:
Bibliographic Details
Main Authors: Power, Thomas, Berenson, Dmitry
Format: Preprint
Published: 2023
Subjects:
Online Access:https://arxiv.org/abs/2308.12110
Tags: Add Tag
No Tags, Be the first to tag this record!
_version_ 1866914882083880960
author Power, Thomas
Berenson, Dmitry
author_facet Power, Thomas
Berenson, Dmitry
contents We present Constrained Stein Variational Trajectory Optimization (CSVTO), an algorithm for performing trajectory optimization with constraints on a set of trajectories in parallel. We frame constrained trajectory optimization as a novel form of constrained functional minimization over trajectory distributions, which avoids treating the constraints as a penalty in the objective and allows us to generate diverse sets of constraint-satisfying trajectories. Our method uses Stein Variational Gradient Descent (SVGD) to find a set of particles that approximates a distribution over low-cost trajectories while obeying constraints. CSVTO is applicable to problems with differentiable equality and inequality constraints and includes a novel particle re-sampling step to escape local minima. By explicitly generating diverse sets of trajectories, CSVTO is better able to avoid poor local minima and is more robust to initialization. We demonstrate that CSVTO outperforms baselines in challenging highly-constrained tasks, such as a 7DoF wrench manipulation task, where CSVTO outperforms all baselines both in success and constraint satisfaction.
format Preprint
id arxiv_https___arxiv_org_abs_2308_12110
institution arXiv
publishDate 2023
record_format arxiv
spellingShingle Constrained Stein Variational Trajectory Optimization
Power, Thomas
Berenson, Dmitry
Robotics
Machine Learning
We present Constrained Stein Variational Trajectory Optimization (CSVTO), an algorithm for performing trajectory optimization with constraints on a set of trajectories in parallel. We frame constrained trajectory optimization as a novel form of constrained functional minimization over trajectory distributions, which avoids treating the constraints as a penalty in the objective and allows us to generate diverse sets of constraint-satisfying trajectories. Our method uses Stein Variational Gradient Descent (SVGD) to find a set of particles that approximates a distribution over low-cost trajectories while obeying constraints. CSVTO is applicable to problems with differentiable equality and inequality constraints and includes a novel particle re-sampling step to escape local minima. By explicitly generating diverse sets of trajectories, CSVTO is better able to avoid poor local minima and is more robust to initialization. We demonstrate that CSVTO outperforms baselines in challenging highly-constrained tasks, such as a 7DoF wrench manipulation task, where CSVTO outperforms all baselines both in success and constraint satisfaction.
title Constrained Stein Variational Trajectory Optimization
topic Robotics
Machine Learning
url https://arxiv.org/abs/2308.12110