Ich weiß nicht womit du programmierst, aber im AVR-STudio kannst du auch simulieren. Von da her würde dein Programm passen.