Updated I2C driver
Tested I2C phisical interface OK