Fixes Gcode issue 256, improve readability