Update mpu_6000.c