Implemented I2C callbacks to allow read-modify-write transactions.
Removed some I2C delays.