gcode seems to work, need testing on real machine