From 2c2926882a924d1deabaf046f8a9a82eae9f3594 Mon Sep 17 00:00:00 2001
From: Alex Voinea <voinea.dragos.alexandru@gmail.com>
Date: Tue, 18 Aug 2020 19:29:18 +0300
Subject: [PATCH] Don't switch unnecessarily. Also "\n" the ";S" request

---
 Firmware/Marlin_main.cpp | 18 ++++++++----------
 1 file changed, 8 insertions(+), 10 deletions(-)

diff --git a/Firmware/Marlin_main.cpp b/Firmware/Marlin_main.cpp
index 49470ae1..70a8f7e5 100755
--- a/Firmware/Marlin_main.cpp
+++ b/Firmware/Marlin_main.cpp
@@ -3287,25 +3287,23 @@ void gcode_M701()
 static void gcode_PRUSA_SN()
 {
     uint8_t selectedSerialPort_bak = selectedSerialPort;
+    char SN[20];
     selectedSerialPort = 0;
-    putchar(';');
-    putchar('S');
-    int numbersRead = 0;
+    SERIAL_ECHOLNRPGM(PSTR(";S"));
+    uint8_t numbersRead = 0;
     ShortTimer timeout;
     timeout.start();
 
-    while (numbersRead < 19) {
-        while (MSerial.available() > 0) {
-            uint8_t serial_char = MSerial.read();
-            selectedSerialPort = selectedSerialPort_bak;
-            putchar(serial_char);
+    while (numbersRead < (sizeof(SN) - 1)) {
+        if (MSerial.available() > 0) {
+            SN[numbersRead] = MSerial.read();
             numbersRead++;
-            selectedSerialPort = 0;
         }
         if (timeout.expired(100u)) break;
     }
+    SN[numbersRead] = 0;
     selectedSerialPort = selectedSerialPort_bak;
-    putchar('\n');
+    SERIAL_ECHOLN(SN);
 }
 //! Detection of faulty RAMBo 1.1b boards equipped with bigger capacitors
 //! at the TACH_1 pin, which causes bad detection of print fan speed.