Resolve Arduino freeze problem and correct calibration.

Add a 20ms delay on IMU's FIFO read attempt to prevent active waiting of the data.