Added simple i2c fix, used seperate file