Recover from I2C timeouts in data collection.

Restart I2C driver on RDY_TIMEOUT. Use last known valid imu data when
data acquisition fails.