Started work on i2c mode

Added code based off SPI and an example file.