Add support for strings stored in flash

Author: aentinger

src/Arduino_DebugUtils.cpp

@@ -58,11 +58,14 @@ void Arduino_DebugUtils::timestampOff() {
   _timestamp_on = false;
 }
 
-void Arduino_DebugUtils::print(int const debug_level, const char * fmt, ...) {
+void Arduino_DebugUtils::print(int const debug_level, const char * fmt, ...)
+{
   if (debug_level >= DBG_ERROR   &&
       debug_level <= DBG_VERBOSE &&
-      debug_level <= _debug_level) {
-    if (_timestamp_on) {
+      debug_level <= _debug_level)
+  {
+    if (_timestamp_on)
+    {
       char timestamp[20];
       snprintf(timestamp, 20, "[ %lu ] ", millis());
       _debug_output_stream->print(timestamp);
@@ -75,6 +78,28 @@ void Arduino_DebugUtils::print(int const debug_level, const char * fmt, ...) {
   }
 }
 
+void Arduino_DebugUtils::print(int const debug_level, const __FlashStringHelper * fmt, ...)
+{
+  if (debug_level >= DBG_ERROR   &&
+      debug_level <= DBG_VERBOSE &&
+      debug_level <= _debug_level)
+  {
+    if (_timestamp_on)
+    {
+      char timestamp[20];
+      snprintf(timestamp, 20, "[ %lu ] ", millis());
+      _debug_output_stream->print(timestamp);
+    }
+
+    String fmt_str(fmt);
+
+    va_list args;
+    va_start(args, fmt_str.c_str());
+    vPrint(fmt_str.c_str(), args);
+    va_end(args);
+  }
+}
+
 /******************************************************************************
    PRIVATE MEMBER FUNCTIONS
  ******************************************************************************/

src/Arduino_DebugUtils.h

@@ -57,6 +57,7 @@ class Arduino_DebugUtils {
     void timestampOff();
 
     void print(int const debug_level, const char * fmt, ...);
+    void print(int const debug_level, const __FlashStringHelper * fmt, ...);
 
 
   private: