StringDebug.ino

#include <stdarg.h>

void serialPrintf(const char* input...) {
  if (!Serial) {
    Serial.begin(9600);
    return; // No timeout, either do in setup() and block, or just drop some stuff
  }

  va_list args;
  va_start(args, input);
  for(const char* i=input; *i!=0; ++i) {
    if (*i!='%') {
      Serial.print(*i);
      continue;
    }

    switch (*(++i)) {
      case '%': Serial.print('%'); break;
      case 'd': Serial.print(va_arg(args, int), DEC); break;
      case 'x': Serial.print(va_arg(args, int), HEX); break;
      // Can save some space by commenting out
      case 'f': Serial.print(va_arg(args, float), 2); break;
      default:
        Serial.print("?");
        break;
    }
  }
  va_end(args);
}

// Format to a buffer first
//void serialBufPrintf(const char * input...) {
//  if (!Serial) {
//    Serial.begin(9600);
//    return;
//  }
//
//  va_list args;
//  va_start(args, input);
//
//  char buf[50];
//  vsnprintf(buf, sizeof(buf), input, args);
//  Serial.print(buf);
//}