Stack switching works! Now on to systick