clean up i2c code for mpu6050