robotics 2 project quadratic programming