Adding I2C code for transmitting

The I2C TX code has not been tested yet