TRON: A Fast Solver for Trajectory Optimization with Non-Smooth Cost Functions

December 2020

TRON: A Fast Solver for Trajectory Optimization with Non-Smooth Cost Functions


Abstract:

Trajectory optimization is an important tool for control and planning of complex, underactuated robots, and has shown impressive results in real world robotic tasks. However, in applications where the cost function to be optimized is non-smooth, modern trajectory optimization methods have extremely slow convergence. In this work, we present TRON, an iterative solver that can be used for efficient trajectory optimization in applications with non-smooth cost functions that are composed of smooth components. TRON achieves this by exploiting the structure of the objective to adaptively smooth the cost function, resulting in a sequence of objectives that can be efficiently optimized. TRON is provably guaranteed to converge to the global optimum of the non-smooth convex cost function when the dynamics are linear, and to a stationary point when the dynamics are nonlinear. Empirically, we show that TRON has faster convergence and lower final costs when compared to other trajectory optimization methods on a range of simulated tasks including collision-free motion planning for a mobile robot, sparse optimal control for surgical needle, and a satellite rendezvous problem.
@conference{Vemula-2020-123696,
author = {Anirudh Vemula And J. Andrew Bagnell},
title = {TRON: A Fast Solver for Trajectory Optimization with Non-Smooth Cost Functions},
booktitle = {Proceedings of 59th IEEE Conference on Decision and Control (CDC '20)},
year = {2020},
month = {December},
pages = {4157 - 4163},
keywords = {Trajectory Optimization, Control, Nonlinear Optimization, Optimization Theory},
}
Copyright notice: This material is presented to ensure timely dissemination of scholarly and technical work. Copyright and all rights therein are retained by authors or by other copyright holders. All persons copying this information are expected to adhere to the terms and constraints invoked by each author's copyright. These works may not be reposted without the explicit permission of the copyright holder.