diff --git a/AntennaTracker/tracking.pde b/AntennaTracker/tracking.pde index e4028d6f99..96bbb4328a 100644 --- a/AntennaTracker/tracking.pde +++ b/AntennaTracker/tracking.pde @@ -82,6 +82,11 @@ static void update_tracking(void) return; } + // do not perform updates if safety switch is disarmed (i.e. servos can't be moved) + if (hal.util->safety_switch_state() == AP_HAL::Util::SAFETY_DISARMED) { + return; + } + switch (control_mode) { case AUTO: update_auto();