Holger Freyther | 32636e8 | 2008-12-27 11:07:15 +0000 | [diff] [blame] | 1 | /* Debugging/Logging support code */ |
| 2 | /* (C) 2008 by Harald Welte <laforge@gnumonks.org> |
Holger Freyther | d546e31 | 2008-12-27 12:03:07 +0000 | [diff] [blame] | 3 | * (C) 2008 by Holger Hans Peter Freyther <zecke@selfish.org> |
Holger Freyther | 32636e8 | 2008-12-27 11:07:15 +0000 | [diff] [blame] | 4 | * All Rights Reserved |
| 5 | * |
| 6 | * This program is free software; you can redistribute it and/or modify |
| 7 | * it under the terms of the GNU General Public License as published by |
| 8 | * the Free Software Foundation; either version 2 of the License, or |
| 9 | * (at your option) any later version. |
| 10 | * |
| 11 | * This program is distributed in the hope that it will be useful, |
| 12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 14 | * GNU General Public License for more details. |
| 15 | * |
| 16 | * You should have received a copy of the GNU General Public License along |
| 17 | * with this program; if not, write to the Free Software Foundation, Inc., |
| 18 | * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. |
| 19 | * |
| 20 | */ |
| 21 | |
| 22 | #include <stdarg.h> |
Holger Freyther | d546e31 | 2008-12-27 12:03:07 +0000 | [diff] [blame] | 23 | #include <stdlib.h> |
Holger Freyther | 32636e8 | 2008-12-27 11:07:15 +0000 | [diff] [blame] | 24 | #include <stdio.h> |
| 25 | #include <string.h> |
Holger Freyther | d546e31 | 2008-12-27 12:03:07 +0000 | [diff] [blame] | 26 | #include <strings.h> |
Holger Freyther | 32636e8 | 2008-12-27 11:07:15 +0000 | [diff] [blame] | 27 | #include <time.h> |
| 28 | |
| 29 | #include <openbsc/debug.h> |
| 30 | |
Harald Welte | b0f4793 | 2008-12-30 14:59:01 +0000 | [diff] [blame] | 31 | unsigned int debug_mask = 0xffffffff & ~(DMI|DMIB); |
Holger Freyther | 32636e8 | 2008-12-27 11:07:15 +0000 | [diff] [blame] | 32 | |
Holger Freyther | d546e31 | 2008-12-27 12:03:07 +0000 | [diff] [blame] | 33 | struct debug_info { |
| 34 | const char *name; |
| 35 | const char *color; |
| 36 | const char *description; |
| 37 | int number; |
| 38 | }; |
| 39 | |
| 40 | #define DEBUG_CATEGORY(NUMBER, NAME, COLOR, DESCRIPTION) \ |
| 41 | { .name = NAME, .color = COLOR, .description = DESCRIPTION, .number = NUMBER }, |
| 42 | |
| 43 | #define ARRAY_SIZE(array) (sizeof(array)/sizeof(array[0])) |
| 44 | |
| 45 | static const struct debug_info debug_info[] = { |
Holger Freyther | 7c03e4c | 2008-12-27 12:46:48 +0000 | [diff] [blame] | 46 | DEBUG_CATEGORY(DRLL, "DRLL", "\033[1;31m", "") |
| 47 | DEBUG_CATEGORY(DCC, "DCC", "\033[1;32m", "") |
| 48 | DEBUG_CATEGORY(DNM, "DMM", "\033[1;33m", "") |
| 49 | DEBUG_CATEGORY(DRR, "DRR", "\033[1;34m", "") |
| 50 | DEBUG_CATEGORY(DRSL, "DRSSL","\033[1;35m", "") |
| 51 | DEBUG_CATEGORY(DNM, "DNM", "\033[1;36m", "") |
Daniel Willmann | 10d06f6 | 2008-12-28 21:38:25 +0000 | [diff] [blame] | 52 | DEBUG_CATEGORY(DSMS, "DSMS", "\033[1;37m", "") |
Harald Welte | d35b6a7 | 2008-12-29 04:06:41 +0000 | [diff] [blame] | 53 | DEBUG_CATEGORY(DPAG, "DPAG", "\033[1;38m", "") |
Harald Welte | b60fa59 | 2009-02-06 12:02:53 +0000 | [diff] [blame] | 54 | DEBUG_CATEGORY(DMI, "DMI", "", "") |
| 55 | DEBUG_CATEGORY(DMIB, "DMIB", "", "") |
Holger Freyther | d546e31 | 2008-12-27 12:03:07 +0000 | [diff] [blame] | 56 | }; |
| 57 | |
Holger Freyther | 7c03e4c | 2008-12-27 12:46:48 +0000 | [diff] [blame] | 58 | static int use_color = 1; |
| 59 | |
Holger Freyther | b332f61 | 2008-12-27 12:46:51 +0000 | [diff] [blame] | 60 | void debug_use_color(int color) |
| 61 | { |
| 62 | use_color = color; |
| 63 | } |
| 64 | |
Holger Freyther | d546e31 | 2008-12-27 12:03:07 +0000 | [diff] [blame] | 65 | /* |
| 66 | * Parse the category mask. |
| 67 | * category1:category2:category3 |
| 68 | */ |
Holger Freyther | 5ee72ee | 2008-12-27 12:46:49 +0000 | [diff] [blame] | 69 | void debug_parse_category_mask(const char *_mask) |
Holger Freyther | d546e31 | 2008-12-27 12:03:07 +0000 | [diff] [blame] | 70 | { |
| 71 | unsigned int new_mask = 0; |
| 72 | int i = 0; |
| 73 | char *mask = strdup(_mask); |
| 74 | char *category_token = NULL; |
| 75 | |
| 76 | category_token = strtok(mask, ":"); |
| 77 | do { |
| 78 | for (i = 0; i < ARRAY_SIZE(debug_info); ++i) { |
| 79 | if (strcasecmp(debug_info[i].name, category_token) == 0) |
| 80 | new_mask |= debug_info[i].number; |
| 81 | } |
Holger Freyther | ca362a6 | 2009-01-04 21:05:01 +0000 | [diff] [blame] | 82 | } while ((category_token = strtok(NULL, ":"))); |
Holger Freyther | d546e31 | 2008-12-27 12:03:07 +0000 | [diff] [blame] | 83 | |
| 84 | |
| 85 | free(mask); |
| 86 | debug_mask = new_mask; |
| 87 | } |
| 88 | |
Holger Freyther | 7c03e4c | 2008-12-27 12:46:48 +0000 | [diff] [blame] | 89 | const char* color(int subsys) |
| 90 | { |
| 91 | int i = 0; |
| 92 | |
| 93 | for (i = 0; use_color && i < ARRAY_SIZE(debug_info); ++i) { |
| 94 | if (debug_info[i].number == subsys) |
| 95 | return debug_info[i].color; |
| 96 | } |
| 97 | |
| 98 | return ""; |
| 99 | } |
| 100 | |
Harald Welte | 6ddd168 | 2009-02-06 12:38:29 +0000 | [diff] [blame] | 101 | void debugp(unsigned int subsys, char *file, int line, int cont, const char *format, ...) |
Holger Freyther | 32636e8 | 2008-12-27 11:07:15 +0000 | [diff] [blame] | 102 | { |
Holger Freyther | 32636e8 | 2008-12-27 11:07:15 +0000 | [diff] [blame] | 103 | va_list ap; |
Holger Freyther | 32636e8 | 2008-12-27 11:07:15 +0000 | [diff] [blame] | 104 | FILE *outfd = stderr; |
| 105 | |
| 106 | if (!(debug_mask & subsys)) |
| 107 | return; |
| 108 | |
| 109 | va_start(ap, format); |
| 110 | |
Harald Welte | 6ddd168 | 2009-02-06 12:38:29 +0000 | [diff] [blame] | 111 | fprintf(outfd, "%s", color(subsys)); |
| 112 | |
| 113 | if (!cont) { |
| 114 | char *timestr; |
| 115 | time_t tm; |
| 116 | tm = time(NULL); |
| 117 | timestr = ctime(&tm); |
| 118 | timestr[strlen(timestr)-1] = '\0'; |
| 119 | fprintf(outfd, "%s <%4.4x> %s:%d ", timestr, subsys, file, line); |
| 120 | } |
Holger Freyther | 32636e8 | 2008-12-27 11:07:15 +0000 | [diff] [blame] | 121 | vfprintf(outfd, format, ap); |
Holger Freyther | 7c03e4c | 2008-12-27 12:46:48 +0000 | [diff] [blame] | 122 | fprintf(outfd, "\033[0;m"); |
Holger Freyther | 32636e8 | 2008-12-27 11:07:15 +0000 | [diff] [blame] | 123 | |
| 124 | va_end(ap); |
| 125 | |
| 126 | fflush(outfd); |
| 127 | } |
| 128 | |
Holger Freyther | ca362a6 | 2009-01-04 21:05:01 +0000 | [diff] [blame] | 129 | void hexdump(unsigned char *buf, int len) |
| 130 | { |
| 131 | int i; |
| 132 | for (i = 0; i < len; i++) { |
| 133 | fprintf(stdout, "%02x ", buf[i]); |
| 134 | } |
| 135 | fprintf(stdout, "\n"); |
| 136 | } |
| 137 | |