From 3e45052a75e6cd4a43303eebfb5c286c2842b6c7 Mon Sep 17 00:00:00 2001
From: Randy Mackay <rmackay9@yahoo.com>
Date: Mon, 9 Mar 2015 14:46:39 +0900
Subject: [PATCH] Copter: reply with failed if gyro or accel cal fails

---
 ArduCopter/GCS_Mavlink.pde | 4 ++++
 1 file changed, 4 insertions(+)

diff --git a/ArduCopter/GCS_Mavlink.pde b/ArduCopter/GCS_Mavlink.pde
index 4047eef5cd..04c4d7d4fb 100644
--- a/ArduCopter/GCS_Mavlink.pde
+++ b/ArduCopter/GCS_Mavlink.pde
@@ -1134,6 +1134,8 @@ void GCS_MAVLINK::handleMessage(mavlink_message_t* msg)
                 if (ins.gyro_calibrated_ok_all()) {
                     ahrs.reset_gyro_drift();
                     result = MAV_RESULT_ACCEPTED;
+                } else {
+                    result = MAV_RESULT_FAILED;
                 }
             } else if (packet.param3 == 1) {
                 // fast barometer calibration
@@ -1150,6 +1152,8 @@ void GCS_MAVLINK::handleMessage(mavlink_message_t* msg)
                     // reset ahrs's trim to suggested values from calibration routine
                     ahrs.set_trim(Vector3f(trim_roll, trim_pitch, 0));
                     result = MAV_RESULT_ACCEPTED;
+                } else {
+                    result = MAV_RESULT_FAILED;
                 }
             } else if (packet.param6 == 1) {
                 // compassmot calibration