tmk_core/common/mbed/xprintf.cpp

   1 #include <cstdarg>
   2 //#include <stdarg.h>
   3 #include "mbed.h"
   4 #include "mbed/xprintf.h"
   5
   6 #define STRING_STACK_LIMIT 120
   7
   8 // TODO
   9 int __xprintf(const char* format, ...) { return 0; }
  10
  11 #if 0
  12 /* mbed Serial */
  13 Serial ser(UART_TX, UART_RX);
  14
  15 /* TODO: Need small implementation for embedded */
  16 int xprintf(const char* format, ...)
  17 {
  18     /* copy from mbed/common/RawSerial.cpp */
  19     std::va_list arg;
  20     va_start(arg, format);
  21     int len = vsnprintf(NULL, 0, format, arg);
  22     if (len < STRING_STACK_LIMIT) {
  23         char temp[STRING_STACK_LIMIT];
  24         vsprintf(temp, format, arg);
  25         ser.puts(temp);
  26     } else {
  27         char *temp = new char[len + 1];
  28         vsprintf(temp, format, arg);
  29         ser.puts(temp);
  30         delete[] temp;
  31     }
  32     va_end(arg);
  33     return len;
  34
  35 /* Fail: __builtin_va_arg_pack?
  36  * https://gcc.gnu.org/onlinedocs/gcc-4.3.5/gcc/Constructing-Calls.html#Constructing-Calls
  37     void *arg = __builtin_apply_args();
  38     void *ret = __builtin_apply((void*)(&(ser.printf)), arg, 100);
  39     __builtin_return(ret)
  40 */
  41 /* Fail: varargs can not be passed to printf
  42     //int r = ser.printf("test %i\r\n", 123);
  43     va_list arg;
  44     va_start(arg, format);
  45     int r = ser.printf(format, arg);
  46     va_end(arg);
  47     return r;
  48 */
  49 }
  50 #endif