Na samym dole posta (3 ostatnie linie) sprobuj zmienic z:

onImpliedCommand(COMMAND_END);
onImpliedCommand(COMMAND_STOP_SPINDLE);
writeBlock(mFormat.format(30)); // stop program, spindle stop, coolant off

na

onImpliedCommand(COMMAND_END);
onImpliedCommand(COMMAND_STOP_SPINDLE);
writeBlock(gAbsIncModal.format(90), gFormat.format(53), gMotionModal.format(0), "X" + xFormat.format(properties.g53HomePositionX), conditional(yOutput.isEnabled(), "Y" + yFormat.format(0))); // return to home
writeBlock(gAbsIncModal.format(90), gFormat.format(53), gMotionModal.format(0), "Z" + zFormat.format(properties.g53HomePositionZ));
writeBlock(mFormat.format(30)); // stop program, spindle stop, coolant off

I zobacz co Ci wyjdzie