From 553261d4ce00593d624d2c0e5f33bcfd23cef03b Mon Sep 17 00:00:00 2001 From: Randy Mackay Date: Tue, 10 Mar 2015 16:01:09 +0900 Subject: [PATCH] Copter: send EKF_STATUS_REPORT in extra3 stream --- ArduCopter/GCS_Mavlink.pde | 7 +++++++ 1 file changed, 7 insertions(+) diff --git a/ArduCopter/GCS_Mavlink.pde b/ArduCopter/GCS_Mavlink.pde index b03b829c2c..7bc4346815 100644 --- a/ArduCopter/GCS_Mavlink.pde +++ b/ArduCopter/GCS_Mavlink.pde @@ -625,6 +625,12 @@ bool GCS_MAVLINK::try_send_message(enum ap_message id) #endif break; + case MSG_EKF_STATUS_REPORT: +#if AP_AHRS_NAVEKF_AVAILABLE + CHECK_PAYLOAD_SIZE(EKF_STATUS_REPORT); + ahrs.get_NavEKF().send_status_report(chan); +#endif + break; case MSG_FENCE_STATUS: case MSG_WIND: @@ -854,6 +860,7 @@ GCS_MAVLINK::data_stream_send(void) send_message(MSG_MOUNT_STATUS); send_message(MSG_OPTICAL_FLOW); send_message(MSG_GIMBAL_REPORT); + send_message(MSG_EKF_STATUS_REPORT); } }