Fixing stepgen when first step is faster than desired speed