diff --git a/src/DpsClass.cpp b/src/DpsClass.cpp index 89231d1..82f795d 100644 --- a/src/DpsClass.cpp +++ b/src/DpsClass.cpp @@ -212,6 +212,10 @@ int16_t DpsClass::measureTempOnce(float &result, uint8_t oversamplingRate) int16_t ret = startMeasureTempOnce(oversamplingRate); if (ret != DPS__SUCCEEDED) { + if (ret == DPS__FAIL_TOOBUSY) + { + standby(); + } return ret; } @@ -269,6 +273,10 @@ int16_t DpsClass::measurePressureOnce(float &result, uint8_t oversamplingRate) int16_t ret = startMeasurePressureOnce(oversamplingRate); if (ret != DPS__SUCCEEDED) { + if (ret == DPS__FAIL_TOOBUSY) + { + standby(); + } return ret; }