WIP - fix twi driver