Apparent fix to stall when printing

Slight tweaks to M502 to allow printing without my workaround required in previous commit (M502; M502 S1405).