Fixed i2c timeout error. Errors still happens, but restores quickly