Redid i2c functions

In vain though