Cleanup library code

Prepare for better implementation of partc and real usage of gcode library code.