diff --git a/ArduPlane/system.cpp b/ArduPlane/system.cpp
index b853c28b17..87e7528af6 100644
--- a/ArduPlane/system.cpp
+++ b/ArduPlane/system.cpp
@@ -301,6 +301,7 @@ bool Plane::set_mode(Mode &new_mode, const mode_reason_t reason)
     // log and notify mode change
     logger.Write_Mode(control_mode->mode_number(), control_mode_reason);
     notify_mode(*control_mode);
+    gcs().send_message(MSG_HEARTBEAT);
 
     return true;
 }