Updated setup

join I2C as master only if needed