diff --git a/src/boards/Main/Radio/Radio.cpp b/src/boards/Main/Radio/Radio.cpp
index bdbb5c67eae1c358b48631592b0ec197990b5b04..fe8d4473ef4ff439c572cf070fad792059e64dfb 100644
--- a/src/boards/Main/Radio/Radio.cpp
+++ b/src/boards/Main/Radio/Radio.cpp
@@ -238,7 +238,9 @@ void Radio::handleMessage(const mavlink_message_t& msg)
                 mavlink_msg_wiggle_servo_tc_get_servo_id(&msg));
 
             if (getModule<FlightModeManager>()->getState() ==
-                FlightModeManagerState::TEST_MODE)
+                    FlightModeManagerState::TEST_MODE ||
+                getModule<FlightModeManager>()->getState() ==
+                    FlightModeManagerState::LANDED)
             {
                 // If the state is test mode, the wiggle is done
                 getModule<Actuators>()->wiggleServo(servoId);