I2C Functional. Need to add time out in I2CFlag()