Fixed i2c freezing???