TWI Driver for AVR - work