CHOMP: Covariant Hamiltonian optimization for motion planning

  title={CHOMP: Covariant Hamiltonian optimization for motion planning},
  author={Matthew Zucker and Nathan D. Ratliff and Anca D. Dragan and Mihail Pivtoraiko and Matthew Klingensmith and Christopher M. Dellin and J. Andrew Bagnell and Siddhartha S. Srinivasa},
  journal={The International Journal of Robotics Research},
  pages={1164 - 1193}
In this paper, we present CHOMP (covariant Hamiltonian optimization for motion planning), a method for trajectory optimization invariant to reparametrization. CHOMP uses functional gradient techniques to iteratively improve the quality of an initial trajectory, optimizing a functional that trades off between a smoothness and an obstacle avoidance component. CHOMP can be used to locally optimize feasible trajectories, as well as to solve motion planning queries, converging to low-cost… 
Space-time functional gradient optimization for motion planning
By manipulating time, T-CHOMP produces lower-cost trajectories leading to behavior that is meaningfully different from CHOMP, and this work outlines a framework for joint space-time optimization, derive an efficient trajectory-wide update for maintaining time monotonicity, and demonstrates the significance of T-ChOMP over ChOMP in several scenarios.
Motion planning with sequential convex optimization and convex collision checking
A sequential convex optimization procedure, which penalizes collisions with a hinge loss and increases the penalty coefficients in an outer loop as necessary, and an efficient formulation of the no-collisions constraint that directly considers continuous-time safety are presented.
Finding Locally Optimal, Collision-Free Trajectories with Sequential Convex Optimization
A novel approach for incorporating collision avoidance into trajectory optimization as a method of solving robotic motion planning problems, solving a suite of 7-degree-of-freedom arm-planning problems and 18-DOF full-body planning problems and benchmarked the algorithm against several other motion planning algorithms.
Gaussian Process Motion planning
This paper develops the Gaussian Process Motion Planner (GPMP), a gradient-based optimization technique that optimizes continuous-time trajectories with respect to a cost functional by exploiting GP interpolation.
Batch and Incremental Kinodynamic Motion Planning using Dynamic Factor Graphs
This paper presents a kinodynamic motion planner that is able to produce energy efficient motions by taking the full robot dynamics into account, and making use of gravity, inertia, and momentum to
High-DOF Robots in Dynamic Environments Using Incremental Trajectory Optimization
A novel optimization-based motion planning algorithm for high degree-of-freedom (DOF) robots in dynamic environments that decomposes the high-dimensional motion planning problem into a sequence of low-dimensional sub-problems and compute collision-free and smooth paths using optimized planning and trajectory perturbation for each sub-problem.
Robust Multi-Robot Trajectory Optimization Using Alternating Direction Method of Multiplier
This work proposes a variant of alternating direction method of multiplier (ADMM) to solve constrained trajectory optimization problems, and highlights an order of magnitude’s speedup, while generating trajectories of comparable qualities as state-of-the-art P-IPM solver.
A new optimization-driven path planning method with probabilistic completeness for wheeled mobile robots
A randomized variant of the improved dual covariant Hamiltonian optimization for motion planning based on simulated annealing and Hamiltonian Monte Carlo methods is proposed to solve the problem that the path planning process is locked in weak minima or non-convergence.
Combining Method of Alternating Projections and Augmented Lagrangian for Task Constrained Trajectory Optimization
A novel custom optimizer is presented which exploits the underlying structure present in many task constraints and achieves cyclic motion in the joint space corresponding to a similar nature trajectory in the task space.
Tron: A Fast Solver for Trajectory Optimization with Non-Smooth Cost Functions
TRON is presented, an iterative solver that can be used for efficient trajectory optimization in applications with non-smooth cost functions that are composed of smooth components and has faster convergence and lower final costs when compared to other trajectory optimization methods.


STOMP: Stochastic trajectory optimization for motion planning
It is experimentally show that the stochastic nature of STOMP allows it to overcome local minima that gradient-based methods like CHOMP can get stuck in.
CHOMP: Gradient optimization techniques for efficient motion planning
This paper presents CHOMP, a novel method for continuous path refinement that uses covariant gradient techniques to improve the quality of sampled trajectories and relax the collision-free feasibility prerequisite on input paths required by those strategies.
ITOMP: Incremental Trajectory Optimization for Real-Time Replanning in Dynamic Environments
We present a novel optimization-based algorithm for motion planning in dynamic environments. Our approach uses a stochastic trajectory optimization framework to avoid collisions and satisfy
Optimization and learning for rough terrain legged locomotion
We present a novel approach to legged locomotion over rough terrain that is thoroughly rooted in optimization. This approach relies on a hierarchy of fast, anytime algorithms to plan a set of
Manipulation planning with goal sets using constrained trajectory optimization
CHOMP is extended, a recent trajectory optimizer that has proven effective on high-dimensional problems, to handle trajectory-wide constraints, and the solution is related to the intuition of taking unconstrained steps and subsequently projecting them onto the constraints.
SANDROS: a dynamic graph search algorithm for motion planning
SANDROS is a dynamic-graph search algorithm, and can be described as a hierarchical, nonuniform-multiresolution, best-first search to find a heuristically short motion in the configuration space.
Search-based planning for manipulation with motion primitives
This paper presents a heuristic search-based manipulation planner that does deal effectively with the high-dimensionality of the problem and shows the ability of the planner to solve manipulation in cluttered spaces by generating consistent, low-cost motion trajectories while providing guarantees on completeness and bounds on suboptimality.
Robot trajectory optimization using approximate inference
This work considers a probabilistic model for which the maximum likelihood (ML) trajectory coincides with the optimal trajectory and which reproduces the classical SOC solution and utilizes approximate inference methods that efficiently generalize to non-LQG systems.
Learning Dimensional Descent for Optimal Motion Planning in High-dimensional Spaces
This work shows how a profitable set of directions in which to perform this dimensional descent procedure can be learned efficiently, and provides sufficient conditions for global optimality of dimensional descent in this learned basis, based upon the low-dimensional structure of the planning cost function.
Trajectory prediction in cluttered voxel environments
This work builds on the previous work on trajectory prediction by adapting it to environments modeled with voxel grids and defining a frame invariant prototype trajectory space, allowing to predict good movement trajectories and speed up convergence of robot motion planning.