From de9e9b90e5c9bacb1c58cd8d7220048b94fd5dcb Mon Sep 17 00:00:00 2001
From: Josh Welsh <josh@joshco.us>
Date: Mon, 3 Aug 2020 19:38:55 -0700
Subject: [PATCH] Copter: Tradheli servo_test fix

---
 ArduCopter/AP_Arming.cpp | 7 +++++++
 1 file changed, 7 insertions(+)

diff --git a/ArduCopter/AP_Arming.cpp b/ArduCopter/AP_Arming.cpp
index 07f5b7556f..564bb1f4ed 100644
--- a/ArduCopter/AP_Arming.cpp
+++ b/ArduCopter/AP_Arming.cpp
@@ -299,6 +299,13 @@ bool AP_Arming_Copter::motor_checks(bool display_failure)
         return false;
     }
 
+	    //servo_test check
+#if FRAME_CONFIG == HELI_FRAME
+    if(copter.motors->servo_test_running()) {
+        check_failed(display_failure, "Servo Test is still running");
+        return false;
+    }
+#endif
     // further checks enabled with parameters
     if (!check_enabled(ARMING_CHECK_PARAMETERS)) {
         return true;