Improved I2C Wire.h read and write functions