diff --git a/rewritegcode.py b/rewritegcode.py
index daed7eb..8aa0c98 100644
--- a/rewritegcode.py
+++ b/rewritegcode.py
@@ -45,6 +45,9 @@ def rewrite_gcode(infile, outfile):
 
         fp.write(lines)
 
+    # Raise pen as final control
+    fp.write(f"G0 Z{ZUP}\n")
+
     fp.close()
 
 if __name__ == '__main__':