Frontiers of Optimization for Robotics