New code for I2C communication