Abstracted the I2C read functions from the rest of the code. (needs cleanup)