Better I2C Code