Rover: ensure arming when running motor test

4 years ago · 001c39f17b
1 changed files with 3 additions and 1 deletions
--- a/Rover/motor_test.cpp
+++ b/Rover/motor_test.cpp
@ -124,7 +124,9 @@ MAV_RESULT Rover::mavlink_motor_test_start(const GCS_MAVLINK &gcs_chan, AP_Motor
				@@ -124,7 +124,9 @@ MAV_RESULT Rover::mavlink_motor_test_start(const GCS_MAVLINK &gcs_chan, AP_Motor

            // arm motors
            if (!arming.is_armed()) {
-                arming.arm(AP_Arming::Method::MOTORTEST);
+                if (!arming.arm(AP_Arming::Method::MOTORTEST)) {
+                    return MAV_RESULT_FAILED;
+                }
            }

            // disable failsafes