M112 Emergency stop

To fix
https://github.com/reprappro/RepRapFirmware/issues/36