Fixed issue with I2C timeouts