Start working on I2C write logic