Fix dispatch needed algorithm in ISR Handler. smp01 is now working on HW!