Bug fixes

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