Flush after debug prints, except SAMD (flush routine too big for SAMD21)

Author: tyeth

src/Wippersnapper.cpp

@@ -2711,8 +2711,10 @@ void print_reset_reason(int reason) {
 */
 /**************************************************************************/
 void printDeviceInfo() {
+  WS_PRINTER.flush();
   WS_DEBUG_PRINTLN("-------Device Information-------");
   WS_DEBUG_PRINT("Firmware Version: ");
+  WS_PRINTER.flush();
   WS_DEBUG_PRINTLN(WS_VERSION);
   WS_DEBUG_PRINT("Board ID: ");
   WS_DEBUG_PRINTLN(BOARD_ID);

src/Wippersnapper.h

@@ -46,17 +46,49 @@
 
 // Define actual debug output functions when necessary.
 #ifdef WS_DEBUG
+#if defined(ARDUINO_SAMD_NANO_33_IOT) || defined(ARDUINO_SAMD_MKRWIFI1010)
 #define WS_DEBUG_PRINT(...)                                                    \
-  { WS_PRINTER.print(__VA_ARGS__); } ///< Prints debug output.
+  {                                                                            \
+    WS_PRINTER.print(__VA_ARGS__);                                             \
+    yield();                                                                   \
+  } ///< Prints line from debug output.
+#define WS_DEBUG_PRINTLN(...)                                                  \
+  {                                                                            \
+    WS_PRINTER.println(__VA_ARGS__);                                           \
+    yield();                                                                   \
+  } ///< Prints line from debug output.
+#define WS_DEBUG_PRINTHEX(...)                                                 \
+  {                                                                            \
+    WS_PRINTER.print(__VA_ARGS__, HEX);                                        \
+    yield();                                                                   \
+  } ///< Prints debug output.
+#else
+#define WS_DEBUG_PRINT(...)                                                    \
+  {                                                                            \
+    WS_PRINTER.print(__VA_ARGS__);                                             \
+    WS_PRINTER.flush();                                                        \
+    yield();                                                                   \
+  } ///< Prints line from debug output.
 #define WS_DEBUG_PRINTLN(...)                                                  \
-  { WS_PRINTER.println(__VA_ARGS__); } ///< Prints line from debug output.
+  {                                                                            \
+    WS_PRINTER.println(__VA_ARGS__);                                           \
+    WS_PRINTER.flush();                                                        \
+    yield();                                                                   \
+  } ///< Prints line from debug output.
 #define WS_DEBUG_PRINTHEX(...)                                                 \
-  { WS_PRINTER.print(__VA_ARGS__, HEX); } ///< Prints debug output.
+  {                                                                            \
+    WS_PRINTER.print(__VA_ARGS__, HEX);                                        \
+    WS_PRINTER.flush();                                                        \
+    yield();                                                                   \
+  } ///< Prints debug output.
+#endif
 #else
 #define WS_DEBUG_PRINT(...)                                                    \
   {} ///< Prints debug output
 #define WS_DEBUG_PRINTLN(...)                                                  \
   {} ///< Prints line from debug output.
+#define WS_DEBUG_PRINTHEX(...)                                                 \
+  {} ///< Prints debug output.
 #endif
 
 #define WS_DELAY_WITH_WDT(timeout)                                             \