Added I2C Code

Added I2C stuff. It was not tested because it seens that the Proteus VSM
Simulator is Broken. I will test next week on real devices.