Debugged new G00 command and everything is working.
The code is a bit messy, using all global variables like and EE should!
Gcode parser is a nightmare, but works. Need to take an input of a whole string from user.
Up to date code should run Receive_Gcode(), NOT stepx or stepy alone.
This will be the code used for hardware show.