I2C fixes
Improved I2C syntax

Also fixed a few other bugs.
Improved default setup and avoid setup calls.
i2c test