Bug fixes

Got M221 command working again (broken by last merge)
Fix issue with printing Treito's file after a pause and reset
Merge remote-tracking branch 'dc42/duet' into duet