Fix focus height value
Fix gcode generation for focus presets