Got M221 command working again (broken by last merge) Fix issue with printing Treito's file after a pause and reset