Fixed slowdown of previous commit

Reverted the introduction of delay() in favour of the timing based on planned time for the next step. Cleaned up some other bits of code and changed the handling of forward motion. This now happens when the [counter for color changes] modulo [colorChangesPerSte] equals zero.