added pen_up pen_down
cleaned up printing gcode to sysout or file