Debugging and I2C fix