Check-in of the working code tested on ATmega168.