AP_Baro: fixed MS5611 semaphore handling

12 years ago · c5ba33d39a
1 changed files with 2 additions and 0 deletions
--- a/libraries/AP_Baro/AP_Baro_MS5611.cpp
+++ b/libraries/AP_Baro/AP_Baro_MS5611.cpp
@ -176,6 +176,8 @@ void AP_Baro_MS5611::_update(uint32_t tnow)
				@@ -176,6 +176,8 @@ void AP_Baro_MS5611::_update(uint32_t tnow)
                            "100 times in AP_Baro_MS5611::_update"));
            }
            return;
+        } else {
+            semfail_ctr = 0;
        }
    }