Testing code for ATMega2560