134 lines
3.2 KiB
C
134 lines
3.2 KiB
C
|
/*
|
||
|
|
Cubesat Space Protocol - A small network-layer protocol designed for Cubesats
|
||
|
|
Copyright (C) 2012 Gomspace ApS (http://www.gomspace.com)
|
||
|
|
Copyright (C) 2012 AAUSAT3 Project (http://aausat3.space.aau.dk)
|
||
|
|
|
||
|
|
This library is free software; you can redistribute it and/or
|
||
|
|
modify it under the terms of the GNU Lesser General Public
|
||
|
|
License as published by the Free Software Foundation; either
|
||
|
|
version 2.1 of the License, or (at your option) any later version.
|
||
|
|
|
||
|
|
This library is distributed in the hope that it will be useful,
|
||
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
||
|
|
Lesser General Public License for more details.
|
||
|
|
|
||
|
|
You should have received a copy of the GNU Lesser General Public
|
||
|
|
License along with this library; if not, write to the Free Software
|
||
|
|
Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <stdint.h>
|
||
|
|
#include <stdio.h>
|
||
|
|
#include <stdarg.h>
|
||
|
|
#include <string.h>
|
||
|
|
|
||
|
|
#ifdef __AVR__
|
||
|
|
#include <avr/pgmspace.h>
|
||
|
|
#endif
|
||
|
|
|
||
|
|
/* CSP includes */
|
||
|
|
#include <csp/csp.h>
|
||
|
|
|
||
|
|
#include <csp/arch/csp_system.h>
|
||
|
|
|
||
|
|
/* Custom debug function */
|
||
|
|
csp_debug_hook_func_t csp_debug_hook_func = NULL;
|
||
|
|
|
||
|
|
/* Debug levels */
|
||
|
|
static bool csp_debug_level_enabled[] = {
|
||
|
|
[CSP_ERROR] = true,
|
||
|
|
[CSP_WARN] = true,
|
||
|
|
[CSP_INFO] = false,
|
||
|
|
[CSP_BUFFER] = false,
|
||
|
|
[CSP_PACKET] = false,
|
||
|
|
[CSP_PROTOCOL] = false,
|
||
|
|
[CSP_LOCK] = false,
|
||
|
|
};
|
||
|
|
|
||
|
|
/* Some compilers do not support weak symbols, so this function
|
||
|
|
* can be used instead to set a custom debug hook */
|
||
|
|
void csp_debug_hook_set(csp_debug_hook_func_t f)
|
||
|
|
{
|
||
|
|
csp_debug_hook_func = f;
|
||
|
|
}
|
||
|
|
|
||
|
|
void do_csp_debug(csp_debug_level_t level, const char *format, ...)
|
||
|
|
{
|
||
|
|
int color = COLOR_RESET;
|
||
|
|
va_list args;
|
||
|
|
|
||
|
|
/* Don't print anything if log level is disabled */
|
||
|
|
if (level > CSP_LOCK || !csp_debug_level_enabled[level])
|
||
|
|
return;
|
||
|
|
|
||
|
|
switch(level) {
|
||
|
|
case CSP_INFO:
|
||
|
|
color = COLOR_GREEN | COLOR_BOLD;
|
||
|
|
break;
|
||
|
|
case CSP_ERROR:
|
||
|
|
color = COLOR_RED | COLOR_BOLD;
|
||
|
|
break;
|
||
|
|
case CSP_WARN:
|
||
|
|
color = COLOR_YELLOW | COLOR_BOLD;
|
||
|
|
break;
|
||
|
|
case CSP_BUFFER:
|
||
|
|
color = COLOR_MAGENTA;
|
||
|
|
break;
|
||
|
|
case CSP_PACKET:
|
||
|
|
color = COLOR_GREEN;
|
||
|
|
break;
|
||
|
|
case CSP_PROTOCOL:
|
||
|
|
color = COLOR_BLUE;
|
||
|
|
break;
|
||
|
|
case CSP_LOCK:
|
||
|
|
color = COLOR_CYAN;
|
||
|
|
break;
|
||
|
|
default:
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
|
||
|
|
va_start(args, format);
|
||
|
|
|
||
|
|
/* If csp_debug_hook symbol is defined, pass on the message.
|
||
|
|
* Otherwise, just print with pretty colors ... */
|
||
|
|
if (csp_debug_hook_func) {
|
||
|
|
csp_debug_hook_func(level, format, args);
|
||
|
|
} else {
|
||
|
|
csp_sys_set_color(color);
|
||
|
|
#ifdef __AVR__
|
||
|
|
vfprintf_P(stdout, format, args);
|
||
|
|
#else
|
||
|
|
vprintf(format, args);
|
||
|
|
#endif
|
||
|
|
printf("\r\n");
|
||
|
|
csp_sys_set_color(COLOR_RESET);
|
||
|
|
}
|
||
|
|
|
||
|
|
va_end(args);
|
||
|
|
}
|
||
|
|
|
||
|
|
void csp_debug_set_level(csp_debug_level_t level, bool value)
|
||
|
|
{
|
||
|
|
if (level > CSP_LOCK)
|
||
|
|
return;
|
||
|
|
csp_debug_level_enabled[level] = value;
|
||
|
|
}
|
||
|
|
|
||
|
|
int csp_debug_get_level(csp_debug_level_t level)
|
||
|
|
{
|
||
|
|
if (level > CSP_LOCK)
|
||
|
|
return 0;
|
||
|
|
return csp_debug_level_enabled[level];
|
||
|
|
}
|
||
|
|
|
||
|
|
void csp_debug_toggle_level(csp_debug_level_t level)
|
||
|
|
{
|
||
|
|
if (level > CSP_LOCK) {
|
||
|
|
printf("Max level is 6\r\n");
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
csp_debug_level_enabled[level] = (csp_debug_level_enabled[level]) ? false : true;
|
||
|
|
printf("Level %u: value %u\r\n", level, csp_debug_level_enabled[level]);
|
||
|
|
}
|