Fix stepper control problems with 20MHz CPU frequency.
Fix compilation on Arduino 1.0.