Read and Write functions implemented

No longer boilerplate, uses the arduino wire.h library to use I2C