Update MPU6050_Init