All i2c functions return bool
Fixed read/write poll
Fixed read IRQ handling
Better main