Extract common functionality 'printTimestamp' in order to reduce code duplication

Author: aentinger

src/Arduino_DebugUtils.cpp

@@ -65,11 +65,7 @@ void Arduino_DebugUtils::print(int const debug_level, const char * fmt, ...)
       debug_level <= _debug_level)
   {
     if (_timestamp_on)
-    {
-      char timestamp[20];
-      snprintf(timestamp, 20, "[ %lu ] ", millis());
-      _debug_output_stream->print(timestamp);
-    }
+      printTimestamp();
 
     va_list args;
     va_start(args, fmt);
@@ -85,11 +81,7 @@ void Arduino_DebugUtils::print(int const debug_level, const __FlashStringHelper
       debug_level <= _debug_level)
   {
     if (_timestamp_on)
-    {
-      char timestamp[20];
-      snprintf(timestamp, 20, "[ %lu ] ", millis());
-      _debug_output_stream->print(timestamp);
-    }
+      printTimestamp();
 
     String fmt_str(fmt);
 
@@ -113,6 +105,13 @@ void Arduino_DebugUtils::vPrint(char const * fmt, va_list args) {
   _debug_output_stream->println(msg_buf);
 }
 
+void Arduino_DebugUtils::printTimestamp()
+{
+  char timestamp[20];
+  snprintf(timestamp, 20, "[ %lu ] ", millis());
+  _debug_output_stream->print(timestamp);
+}
+
 /******************************************************************************
    CLASS INSTANTIATION
  ******************************************************************************/

src/Arduino_DebugUtils.h

@@ -67,6 +67,7 @@ class Arduino_DebugUtils {
     Stream *  _debug_output_stream;
 
     void vPrint(char const * fmt, va_list args);
+    void printTimestamp();
 
 };