Not fully optimized Gcode but good enough !