Calling the step control ISRs.
Prevented a hang at the end of a set of blocks.
TODO: Fix the systick priority.