Cleanup
Implement correct rapid handling

Not tracking of maximum velocity but tracking of duration for
moves in rapids based on maximum traversal rate for each axis.