Print and debug improvements

cores/arduino/Print.cpp

@@ -277,6 +277,17 @@ int Print::printf(const __FlashStringHelper *format, ...)
   return retval;
 }
 
+int Print::vprintf(const char *format, va_list ap)
+{
+  return vdprintf((int)this, format, ap);
+}
+
+int Print::vprintf(const __FlashStringHelper *format, va_list ap)
+{
+  return vdprintf((int)this, (const char *)format, ap);
+}
+
+
 // Private Methods /////////////////////////////////////////////////////////////
 
 size_t Print::printNumber(unsigned long n, uint8_t base)

cores/arduino/Print.h

@@ -106,6 +106,8 @@ class Print {
 
     int printf(const char *format, ...);
     int printf(const __FlashStringHelper *format, ...);
+    int vprintf(const __FlashStringHelper *format, va_list ap);
+    int vprintf(const char *format, va_list ap);
 
     virtual void flush() { /* Empty implementation for backward compatibility */ }
 };

cores/arduino/core_debug.c

@@ -0,0 +1,6 @@
+#include "core_debug.h"
+
+// Ensure inline functions have a definition emitted for when they are
+// not inlined (needed for C functions only)
+extern void core_debug(const char *format, ...);
+extern void vcore_debug(const char *format, va_list args);

cores/arduino/core_debug.h

@@ -1,8 +1,9 @@
 #ifndef _CORE_DEBUG_H
 #define _CORE_DEBUG_H
+
+#include <stdarg.h>
 #if !defined(NDEBUG)
   #include <stdio.h>
-  #include <stdarg.h>
 #endif /* NDEBUG */
 
 #ifdef __cplusplus
@@ -16,7 +17,7 @@ extern "C" {
  * the code, use a lot of stack. An alternative, will be to implement a tiny
  * and limited functionality implementation of printf.
  */
-static inline void core_debug(const char *format, ...)
+inline void core_debug(const char *format, ...)
 {
 #if !defined(NDEBUG)
   va_list args;
@@ -28,6 +29,16 @@ static inline void core_debug(const char *format, ...)
 #endif /* NDEBUG */
 }
 
+inline void vcore_debug(const char *format, va_list args)
+{
+#if !defined(NDEBUG)
+  vfprintf(stderr, format, args);
+#else
+  (void)(format);
+  (void)(args);
+#endif /* NDEBUG */
+}
+
 #ifdef __cplusplus
 }
 #endif