Started the refactor of the gcode parser.
New classes to wrap gcode commands
Code cleanup and comments.