More I2C work

Added mroe I2C shit