Added debug code for SPI in gcode_process for M-code command