diff --git a/ArduCopter/GCS_Mavlink.pde b/ArduCopter/GCS_Mavlink.pde index cda3b207ea..f138ba03e4 100644 --- a/ArduCopter/GCS_Mavlink.pde +++ b/ArduCopter/GCS_Mavlink.pde @@ -628,6 +628,11 @@ bool GCS_MAVLINK::try_send_message(enum ap_message id) #endif break; + case MSG_HWSTATUS: + CHECK_PAYLOAD_SIZE(HWSTATUS); + send_hwstatus(chan); + break; + case MSG_MOUNT_STATUS: #if MOUNT == ENABLED CHECK_PAYLOAD_SIZE(MOUNT_STATUS); @@ -635,11 +640,6 @@ bool GCS_MAVLINK::try_send_message(enum ap_message id) #endif // MOUNT == ENABLED break; - case MSG_HWSTATUS: - CHECK_PAYLOAD_SIZE(HWSTATUS); - send_hwstatus(chan); - break; - case MSG_FENCE_STATUS: case MSG_WIND: // unused @@ -862,10 +862,10 @@ GCS_MAVLINK::data_stream_send(void) send_message(MSG_HWSTATUS); send_message(MSG_SYSTEM_TIME); send_message(MSG_RANGEFINDER); - send_message(MSG_MOUNT_STATUS); #if AP_TERRAIN_AVAILABLE send_message(MSG_TERRAIN); #endif + send_message(MSG_MOUNT_STATUS); } }