Need to have some sort of recovery mode if a cone waypoint is reached - either an intermediate cone or the final cone - before it is seen. If it is an intermediate cone, /mavros/mission/waypoints will be received with a new waypoint index. If it is the final cone, the state will change to HOLD.
Need to have some sort of recovery mode if a cone waypoint is reached - either an intermediate cone or the final cone - before it is seen. If it is an intermediate cone, /mavros/mission/waypoints will be received with a new waypoint index. If it is the final cone, the state will change to HOLD.