Correct the calculation of fullInterval in calculateMove

This patch seems to fix the odd glitches in speed that occur on fast and long moves.
The rewrite of axisInterval[] lines were probably not needed but it is much easier to read now.