Finished I2C raw setup function that compiles

I2c_Setup