Added timeout to I2C

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();