AP_Baro: fixed MS5611 semaphore handling

2012-12-21 19:32:16 +11:00 · 2012-12-21 19:32:16 +11:00 · c5ba33d39a
commit c5ba33d39a
parent 47358929e2
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)
                            "100 times in AP_Baro_MS5611::_update"));
            }
            return;
+        } else {
+            semfail_ctr = 0;
        }
    }