added fail check in hardware i2c driver. this doesn't solve the fact that it sucks. needs to be rewritten w/o IRQ
Enable software and disable hardware I2C driver.
Software one has been tested and works, hardware causes issues with new PWM code.