Create I2C operating functions
Fix the mpu6050 read who am i is not working issue