Assignment 2 - Fixed Scheduler

stack corruption fixed
restore SREG
wait for release (Button)