finish mpu6050 function