Closed merose closed 6 years ago
Added recovery mode when a cone is achieved in AUTO mode but never seen. Recovery mode circles once, slowly, and goes to DRIVING_TO_CONE if the cone is seen. If never seen while circling, either FAIL or skip the cone to the next waypoint.
Added recovery mode when a cone is achieved in AUTO mode but never seen. Recovery mode circles once, slowly, and goes to DRIVING_TO_CONE if the cone is seen. If never seen while circling, either FAIL or skip the cone to the next waypoint.