File content as of revision 3:53f6e0430d8e:

/* dbg.cpp */
/* Copyright (C) 2012 mbed.org, MIT License
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
 * and associated documentation files (the "Software"), to deal in the Software without restriction,
 * including without limitation the rights to use, copy, modify, merge, publish, distribute,
 * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in all copies or
 * substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
 */

#include "dbg.h"

#include "mbed.h"
#include "rtos.h"

#include <cstdio>
#include <cstdarg>

using namespace std;

static Serial debug_pc(USBTX, USBRX);

Mutex* debug_printf_mutex; //Singleton runtime initialisation to avoid static initialisation chaos problems

static char debug_newline[3];

void debug_init()
{
  debug_set_newline("\n");
  debug_pc.baud(115200);
  debug_printf_mutex = new Mutex();
  printf("[START]\n");
  fflush(stdout);
}

void debug_set_newline(const char* newline)
{
  strncpy( debug_newline, newline, 2 );
  debug_newline[2] = '\0';
}

void debug(int level, const char* module, int line, const char* fmt, ...)
{
  osStatus ret = debug_printf_mutex->lock();
  if(ret != osOK)
  {
    /*
    printf("[FATAL] DBG Mutex failed!! (ret code = %02x - Mutex is @ %p)\n", ret, &debug_printf_mutex);
    error("");
    while(1); //FATAL
    */
  }
  switch(level)
  {
  default:
  case 1:
    printf("[ERROR]");
    break;
  case 2:
    printf("[WARN]");
    break;
  case 3:
    printf("[INFO]");
    break;
  case 4:
    printf("[DBG]");
    break;
  }

  printf(" Module %s - Line %d: ", module, line);

  va_list argp;

  va_start(argp, fmt);
  vprintf(fmt, argp);
  va_end(argp);

  printf(debug_newline);

  fflush(stdout);

  if(ret == osOK)
  {
    debug_printf_mutex->unlock();
  }

}

void debug_error(const char* module, int line, int ret)
{
  debug_printf_mutex->lock();
  printf("[RC] Module %s - Line %d : Error %d\n", module, line, ret);
  fflush(stdout);
  debug_printf_mutex->unlock();
}

void debug_exact(const char* fmt, ...)
{
  osStatus ret = debug_printf_mutex->lock();
  if(ret != osOK)
  {
    /*
    printf("[FATAL] DBG Mutex failed!! (ret code = %02x - Mutex is @ %p)\n", ret, &debug_printf_mutex);
    error("");
    while(1); //FATAL
    */
  }
  
  va_list argp;

  va_start(argp, fmt);
  vprintf(fmt, argp);
  va_end(argp);
  
  if(ret == osOK)
  {
    debug_printf_mutex->unlock();
  }
}