debug.cpp

Go to the documentation of this file.

 
#include "debug.h"
 
int_t fputc(int_t c, FILE *stream)
{
   // Standard output or error output?
   if (stream == stdout || stream == stderr)
   {
      #ifndef DISABLE_SERIAL
      Serial.write(c);
      #endif
      return c;
   }
   // Unknown output?
   else
   {
      // If a writing error occurs, EOF is returned
      return EOF;
   }
}
 
void init_debug(uint32_t baudrate) {
  #ifndef DISABLE_SERIAL
  Serial.begin(baudrate);
  while (!Serial);
  #endif
}
 
void print_debug(const char *fmt, ...)
{
  va_list args;
  va_start(args, fmt);
  vfprintf(stdout, fmt, args);
  va_end(args);
  #ifndef DISABLE_SERIAL
  Serial.flush();
  #endif
}
 
void print_debug_array(const char *prepend, const void *data, size_t length)
{
   for (uint8_t i = 0; i < length; i++)
   {
      // Beginning of a new line?
      if ((i % 16) == 0)
      {
         TRACE_PRINTF("%s", prepend);
      }
      // Display current data byte
      TRACE_PRINTF("%02" PRIX8 " ", *((const uint8_t *)data + i));
      // End of current line?
      if ((i % 16) == 15 || i == (length - 1))
      {
         TRACE_PRINTF("\r\n");
      }
   }
}
 
void print_debug_F(const __FlashStringHelper *fmt, ...)
{
  osSuspendAllTasks();
  va_list args;
  va_start(args, fmt);
  vfprintf(stdout, (const char *)fmt, args);
  va_end(args);
  #ifndef DISABLE_SERIAL
  Serial.flush();
  #endif
  osResumeAllTasks();
}