Added function for setting up I2C (nowhere near complete)

Brian needs to do more reading.