Mixed Integer Nonlinear Programming Methods For Robots