Fixed multiple I2C issues.
I2C: working demo.

The I2C channel is working properly with a simple demo application.