Update I2C to working build