Driver code for the ATMega128 TWI unit in master mode