diff --git a/libraries/AC_Fence/AC_Fence.cpp b/libraries/AC_Fence/AC_Fence.cpp index ac9d7f50a0..c1e3b4cebb 100644 --- a/libraries/AC_Fence/AC_Fence.cpp +++ b/libraries/AC_Fence/AC_Fence.cpp @@ -205,6 +205,9 @@ void AC_Fence::disable_floor() */ void AC_Fence::auto_enable_fence_after_takeoff(void) { + if (_enabled) { + return; + } switch(auto_enabled()) { case AC_Fence::AutoEnable::ALWAYS_ENABLED: case AC_Fence::AutoEnable::ENABLE_DISABLE_FLOOR_ONLY: