Another stab at implementing the TWI application notes from the '328 datasheet