E.  Todorov, ?A convex, smooth and invertible contact model for trajectory optimization?, in IEEE Conference on Robotics and Automation (ICRA), 2011.