Logic-geometric programming: an optimization-based approach to combined task and motion planning
A direct method for trajectory optimization of rigid bodies through contact