Debug in I2C code