Updated i2c driver to work with our compiler