Tested with arduino - max rev/sec = 4.
Added S parameter to G00 (speed in steps per second)
There are a few problems: the seperation of the axis steps didn't work,
the acceleration is not as it should be - has to be reworked