Minor logic change
Debugging I2C enable and disable