Added motor calibration routine
Decreased I2C_TIMEOUT