Gcode to interpolated points