Refactor GCode parsing entirely