Added I2c read, write, and added gyro function, not tested.