Added I2C write to MockIO
Added I2C function tests