Add proper delay in stepper.cpp

Issue #1385 describes a delay that the compiler is optimizing out and
this solution.