I2C write is working