Removed a few bugs from I2C