compute_robot_command in test_13 is splitted into parts, which form constraints and objective.