StepAndDirection: Removed floating point math from sharedInterrupt (unsharedInterrupt is untested).
This was done to speed up the interrupt but the functionality is the same, math happens when vectors are pushed onto the queue.
Switch to doing skip calcs when creating the vector (rather than in the interrupt (to save interrupt processing power.
Got rid of NOP's in step interrupt!!! Skip timing still needs adjustment.