Port for atmega8515 and clean debugging code