Solve robot control problem