Fix stepper control problems with 20MHz CPU frequency.

Fixes https://github.com/reprappro/Marlin/issues/7 .