diff --git a/Tools/AP_Periph/GCS_MAVLink.cpp b/Tools/AP_Periph/GCS_MAVLink.cpp
index b8a0ee55b2..1d495e1036 100644
--- a/Tools/AP_Periph/GCS_MAVLink.cpp
+++ b/Tools/AP_Periph/GCS_MAVLink.cpp
@@ -16,6 +16,9 @@
 #include "GCS_MAVLink.h"
 #include <AP_HAL/AP_HAL_Boards.h>
 #include "AP_Periph.h"
+#if CONFIG_HAL_BOARD == HAL_BOARD_CHIBIOS
+#include <hal.h>
+#endif
 
 #if HAL_GCS_ENABLED
 
@@ -66,7 +69,6 @@ uint8_t GCS_Periph::sysid_this_mav() const
 
 MAV_RESULT GCS_MAVLINK_Periph::handle_preflight_reboot(const mavlink_command_long_t &packet)
 {
-    printf("RestartNode\n");
     hal.scheduler->delay(10);
     periph.prepare_reboot();
 #if CONFIG_HAL_BOARD == HAL_BOARD_CHIBIOS