Test and refactor

Marlin/Marlin_main.cpp

 
         }
 
+        //If command was e-stop process now
         if(strcmp(cmdbuffer[bufindw], "M112") == 0)
-        {
           kill();
-        }
         
         bufindw = (bufindw + 1)%BUFSIZE;
         buflen += 1;