From 46624d28ca68bfb08d8ac9fe83c8e49a7328001c Mon Sep 17 00:00:00 2001
From: mikeller <github@ike.ch>
Date: Fri, 20 Oct 2017 11:58:31 +1300
Subject: [PATCH] Added switching off of beeper in all cases when crash
 recovery is disabled.

---
 src/main/flight/pid.c | 19 +++++++++----------
 1 file changed, 9 insertions(+), 10 deletions(-)

diff --git a/src/main/flight/pid.c b/src/main/flight/pid.c
index 0fcf135553..c8ee291b4d 100644
--- a/src/main/flight/pid.c
+++ b/src/main/flight/pid.c
@@ -517,22 +517,21 @@ void pidController(const pidProfile_t *pidProfile, const rollAndPitchTrims_t *an
             // if crash recovery is on and accelerometer enabled then check for a crash
             if (pidProfile->crash_recovery) {
                 if (ARMING_FLAG(ARMED)) {
-                    if (motorMixRange >= 1.0f && inCrashRecoveryMode == false
-                       && ABS(delta) > crashDtermThreshold
-                       && ABS(errorRate) > crashGyroThreshold
-                       && ABS(getSetpointRate(axis)) < crashSetpointThreshold) {
+                    if (motorMixRange >= 1.0f && !inCrashRecoveryMode
+                        && ABS(delta) > crashDtermThreshold
+                        && ABS(errorRate) > crashGyroThreshold
+                        && ABS(getSetpointRate(axis)) < crashSetpointThreshold) {
                         inCrashRecoveryMode = true;
                         crashDetectedAtUs = currentTimeUs;
                     }
-                    if (cmpTimeUs(currentTimeUs, crashDetectedAtUs) < crashTimeDelayUs && (ABS(errorRate) < crashGyroThreshold
-                       || ABS(getSetpointRate(axis)) > crashSetpointThreshold)) {
+                    if (inCrashRecoveryMode && cmpTimeUs(currentTimeUs, crashDetectedAtUs) < crashTimeDelayUs && (ABS(errorRate) < crashGyroThreshold
+                        || ABS(getSetpointRate(axis)) > crashSetpointThreshold)) {
                         inCrashRecoveryMode = false;
+                        BEEP_OFF;
                     }
-                } else {
-                    if (inCrashRecoveryMode) {
-                       BEEP_OFF;
-                    }
+                } else if (inCrashRecoveryMode) {
                     inCrashRecoveryMode = false;
+                    BEEP_OFF;
                 }
             }
             axisPID_D[axis] = Kd[axis] * delta * tpaFactor;