diff --git a/src/devices/arduino/bus/i2c.cpp b/src/devices/arduino/bus/i2c.cpp index dfc5eeb..f4ffc1e 100644 --- a/src/devices/arduino/bus/i2c.cpp +++ b/src/devices/arduino/bus/i2c.cpp @@ -13,6 +13,7 @@ namespace sta : I2C{mutex} { Wire.begin(sda, scl, frequency); + Wire.setTimeOut(10); } #else ArduinoI2C::ArduinoI2C(Mutex * mutex /* = nullptr */) @@ -56,6 +57,11 @@ namespace sta { size_t count = Wire.requestFrom((uint8_t)address_, (uint8_t)size); + if (count != size) + { + STA_DEBUG_PRINTLN("Bullshit"); + } + for (size_t i = 0; i < min(size, count); ++i) { buffer[i] = Wire.read();