162 lines
3.8 KiB
C
162 lines
3.8 KiB
C
/* Debugging/Logging support code */
|
|
/* (C) 2008 by Harald Welte <laforge@gnumonks.org>
|
|
* (C) 2008 by Holger Hans Peter Freyther <zecke@selfish.org>
|
|
* All Rights Reserved
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program 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 General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License along
|
|
* with this program; if not, write to the Free Software Foundation, Inc.,
|
|
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
|
|
*
|
|
*/
|
|
|
|
#include <stdarg.h>
|
|
#include <stdlib.h>
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include <strings.h>
|
|
#include <time.h>
|
|
|
|
#include <openbsc/debug.h>
|
|
|
|
unsigned int debug_mask = 0xffffffff & ~(DMI|DMIB);
|
|
|
|
struct debug_info {
|
|
const char *name;
|
|
const char *color;
|
|
const char *description;
|
|
int number;
|
|
};
|
|
|
|
#define DEBUG_CATEGORY(NUMBER, NAME, COLOR, DESCRIPTION) \
|
|
{ .name = NAME, .color = COLOR, .description = DESCRIPTION, .number = NUMBER },
|
|
|
|
#define ARRAY_SIZE(array) (sizeof(array)/sizeof(array[0]))
|
|
|
|
static const struct debug_info debug_info[] = {
|
|
DEBUG_CATEGORY(DRLL, "DRLL", "\033[1;31m", "")
|
|
DEBUG_CATEGORY(DCC, "DCC", "\033[1;32m", "")
|
|
DEBUG_CATEGORY(DMM, "DMM", "\033[1;33m", "")
|
|
DEBUG_CATEGORY(DRR, "DRR", "\033[1;34m", "")
|
|
DEBUG_CATEGORY(DRSL, "DRSL", "\033[1;35m", "")
|
|
DEBUG_CATEGORY(DNM, "DNM", "\033[1;36m", "")
|
|
DEBUG_CATEGORY(DSMS, "DSMS", "\033[1;37m", "")
|
|
DEBUG_CATEGORY(DPAG, "DPAG", "\033[1;38m", "")
|
|
DEBUG_CATEGORY(DMNCC, "DMNCC","\033[1;39m", "")
|
|
DEBUG_CATEGORY(DINP, "DINP", "", "")
|
|
DEBUG_CATEGORY(DMI, "DMI", "", "")
|
|
DEBUG_CATEGORY(DMIB, "DMIB", "", "")
|
|
DEBUG_CATEGORY(DMUX, "DMUX", "", "")
|
|
};
|
|
|
|
static int use_color = 1;
|
|
|
|
void debug_use_color(int color)
|
|
{
|
|
use_color = color;
|
|
}
|
|
|
|
static int print_timestamp = 0;
|
|
|
|
void debug_timestamp(int enable)
|
|
{
|
|
print_timestamp = enable;
|
|
}
|
|
|
|
|
|
/*
|
|
* Parse the category mask.
|
|
* category1:category2:category3
|
|
*/
|
|
void debug_parse_category_mask(const char *_mask)
|
|
{
|
|
unsigned int new_mask = 0;
|
|
int i = 0;
|
|
char *mask = strdup(_mask);
|
|
char *category_token = NULL;
|
|
|
|
category_token = strtok(mask, ":");
|
|
do {
|
|
for (i = 0; i < ARRAY_SIZE(debug_info); ++i) {
|
|
if (strcasecmp(debug_info[i].name, category_token) == 0)
|
|
new_mask |= debug_info[i].number;
|
|
}
|
|
} while ((category_token = strtok(NULL, ":")));
|
|
|
|
|
|
free(mask);
|
|
debug_mask = new_mask;
|
|
}
|
|
|
|
const char* color(int subsys)
|
|
{
|
|
int i = 0;
|
|
|
|
for (i = 0; use_color && i < ARRAY_SIZE(debug_info); ++i) {
|
|
if (debug_info[i].number == subsys)
|
|
return debug_info[i].color;
|
|
}
|
|
|
|
return "";
|
|
}
|
|
|
|
void debugp(unsigned int subsys, char *file, int line, int cont, const char *format, ...)
|
|
{
|
|
va_list ap;
|
|
FILE *outfd = stderr;
|
|
|
|
if (!(debug_mask & subsys))
|
|
return;
|
|
|
|
va_start(ap, format);
|
|
|
|
fprintf(outfd, "%s", color(subsys));
|
|
|
|
if (!cont) {
|
|
if (print_timestamp) {
|
|
char *timestr;
|
|
time_t tm;
|
|
tm = time(NULL);
|
|
timestr = ctime(&tm);
|
|
timestr[strlen(timestr)-1] = '\0';
|
|
fprintf(outfd, "%s ", timestr);
|
|
}
|
|
fprintf(outfd, "<%4.4x> %s:%d ", subsys, file, line);
|
|
}
|
|
vfprintf(outfd, format, ap);
|
|
fprintf(outfd, "\033[0;m");
|
|
|
|
va_end(ap);
|
|
|
|
fflush(outfd);
|
|
}
|
|
|
|
static char hexd_buff[4096];
|
|
|
|
char *hexdump(unsigned char *buf, int len)
|
|
{
|
|
int i;
|
|
char *cur = hexd_buff;
|
|
|
|
hexd_buff[0] = 0;
|
|
for (i = 0; i < len; i++) {
|
|
int len_remain = sizeof(hexd_buff) - (cur - hexd_buff);
|
|
int rc = snprintf(cur, len_remain, "%02x ", buf[i]);
|
|
if (rc <= 0)
|
|
break;
|
|
cur += rc;
|
|
}
|
|
hexd_buff[sizeof(hexd_buff)-1] = 0;
|
|
return hexd_buff;
|
|
}
|
|
|