Contact-Implicit Trajectory Optimization Using Variational Integrators

October 2019

Contact-Implicit Trajectory Optimization Using Variational Integrators

Authors:

Zac Manchester, Neel Doshi, Robert J. Wood, and Scott Kuindersma

Abstract:

Contact constraints arise naturally in many robot planning problems. In recent years, a variety of contact-implicit trajectory optimization algorithms have been developed that avoid the pitfalls of mode pre-specification by simultaneously optimizing state, input, and contact force trajectories. However, their reliance on first-order integrators leads to a linear tradeoff between optimization problem size and plan accuracy. To address this limitation, we propose a new family of trajectory optimization algorithms that leverage ideas from discrete variational mechanics to derive higher-order generalizations of the classic time-stepping method of Stewart and Trinkle. By using these dynamics formulations as constraints in direct trajectory optimization algorithms, it is possible to perform contact-implicit trajectory optimization with significantly higher accuracy. For concreteness, we derive a second-order method and evaluate it using several simulated rigid-body systems, including an underactuated biped and a quadruped. In addition, we use this second-order method to plan locomotion trajectories for a complex quadrupedal microrobot. The planned trajectories are evaluated on the physical platform and result in a number of performance improvements.
@article{Manchester-2019-122101,
author = {Zac Manchester And Neel Doshi And Robert J. Wood And Scott Kuindersma},
title = {Contact-Implicit Trajectory Optimization Using Variational Integrators},
journal = {Proceedings of International Journal of Robotics Research: Special Issue on ISRR '17},
year = {2019},
month = {October},
volume = {38},
number = {12},
pages = {1463 - 1476},
}
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.