diff --git a/libraries/AP_Avoidance/AP_Avoidance.cpp b/libraries/AP_Avoidance/AP_Avoidance.cpp index 9832975cc2..b19e9fac2a 100644 --- a/libraries/AP_Avoidance/AP_Avoidance.cpp +++ b/libraries/AP_Avoidance/AP_Avoidance.cpp @@ -153,6 +153,7 @@ void AP_Avoidance::deinit(void) delete [] _obstacles; _obstacles = nullptr; _obstacles_allocated = 0; + handle_recovery(AP_AVOIDANCE_RECOVERY_RTL); } _obstacle_count = 0; }