$ 0 0 Just a thought — it might be better to use a Gcode preprocessor instead. Just modify the coordinates depending on the Z-height.