Make sure the mpu6050 can read/write the data after timeout and unblock the gyro calibrate code
Add mpu6050 gyro bias fix function
Finish the implementation the accel calibration
Fix the mpu6050 calibration function (working now)