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", "") |
Holger Freyther | 3770b76 | 2009-06-02 02:35:12 +0000 | [diff] [blame] | 48 | DEBUG_CATEGORY(DMM, "DMM", "\033[1;33m", "") |
Holger Freyther | 7c03e4c | 2008-12-27 12:46:48 +0000 | [diff] [blame] | 49 | DEBUG_CATEGORY(DRR, "DRR", "\033[1;34m", "") |
Harald Welte | c1d2aae | 2009-05-23 06:43:35 +0000 | [diff] [blame] | 50 | DEBUG_CATEGORY(DRSL, "DRSL", "\033[1;35m", "") |
Holger Freyther | 7c03e4c | 2008-12-27 12:46:48 +0000 | [diff] [blame] | 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 | c125a68 | 2009-05-23 06:42:38 +0000 | [diff] [blame] | 54 | DEBUG_CATEGORY(DMNCC, "DMNCC","\033[1;39m", "") |
Harald Welte | edb3778 | 2009-05-01 14:59:07 +0000 | [diff] [blame] | 55 | DEBUG_CATEGORY(DINP, "DINP", "", "") |
Harald Welte | b60fa59 | 2009-02-06 12:02:53 +0000 | [diff] [blame] | 56 | DEBUG_CATEGORY(DMI, "DMI", "", "") |
| 57 | DEBUG_CATEGORY(DMIB, "DMIB", "", "") |
Harald Welte | ba59baf | 2009-02-23 00:04:04 +0000 | [diff] [blame] | 58 | DEBUG_CATEGORY(DMUX, "DMUX", "", "") |
Holger Freyther | d546e31 | 2008-12-27 12:03:07 +0000 | [diff] [blame] | 59 | }; |
| 60 | |
Holger Freyther | 7c03e4c | 2008-12-27 12:46:48 +0000 | [diff] [blame] | 61 | static int use_color = 1; |
| 62 | |
Holger Freyther | b332f61 | 2008-12-27 12:46:51 +0000 | [diff] [blame] | 63 | void debug_use_color(int color) |
| 64 | { |
| 65 | use_color = color; |
| 66 | } |
| 67 | |
Holger Freyther | d546e31 | 2008-12-27 12:03:07 +0000 | [diff] [blame] | 68 | /* |
| 69 | * Parse the category mask. |
| 70 | * category1:category2:category3 |
| 71 | */ |
Holger Freyther | 5ee72ee | 2008-12-27 12:46:49 +0000 | [diff] [blame] | 72 | void debug_parse_category_mask(const char *_mask) |
Holger Freyther | d546e31 | 2008-12-27 12:03:07 +0000 | [diff] [blame] | 73 | { |
| 74 | unsigned int new_mask = 0; |
| 75 | int i = 0; |
| 76 | char *mask = strdup(_mask); |
| 77 | char *category_token = NULL; |
| 78 | |
| 79 | category_token = strtok(mask, ":"); |
| 80 | do { |
| 81 | for (i = 0; i < ARRAY_SIZE(debug_info); ++i) { |
| 82 | if (strcasecmp(debug_info[i].name, category_token) == 0) |
| 83 | new_mask |= debug_info[i].number; |
| 84 | } |
Holger Freyther | ca362a6 | 2009-01-04 21:05:01 +0000 | [diff] [blame] | 85 | } while ((category_token = strtok(NULL, ":"))); |
Holger Freyther | d546e31 | 2008-12-27 12:03:07 +0000 | [diff] [blame] | 86 | |
| 87 | |
| 88 | free(mask); |
| 89 | debug_mask = new_mask; |
| 90 | } |
| 91 | |
Holger Freyther | 7c03e4c | 2008-12-27 12:46:48 +0000 | [diff] [blame] | 92 | const char* color(int subsys) |
| 93 | { |
| 94 | int i = 0; |
| 95 | |
| 96 | for (i = 0; use_color && i < ARRAY_SIZE(debug_info); ++i) { |
| 97 | if (debug_info[i].number == subsys) |
| 98 | return debug_info[i].color; |
| 99 | } |
| 100 | |
| 101 | return ""; |
| 102 | } |
| 103 | |
Harald Welte | 6ddd168 | 2009-02-06 12:38:29 +0000 | [diff] [blame] | 104 | 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] | 105 | { |
Holger Freyther | 32636e8 | 2008-12-27 11:07:15 +0000 | [diff] [blame] | 106 | va_list ap; |
Holger Freyther | 32636e8 | 2008-12-27 11:07:15 +0000 | [diff] [blame] | 107 | FILE *outfd = stderr; |
| 108 | |
| 109 | if (!(debug_mask & subsys)) |
| 110 | return; |
| 111 | |
| 112 | va_start(ap, format); |
| 113 | |
Harald Welte | 6ddd168 | 2009-02-06 12:38:29 +0000 | [diff] [blame] | 114 | fprintf(outfd, "%s", color(subsys)); |
| 115 | |
| 116 | if (!cont) { |
| 117 | char *timestr; |
| 118 | time_t tm; |
| 119 | tm = time(NULL); |
| 120 | timestr = ctime(&tm); |
| 121 | timestr[strlen(timestr)-1] = '\0'; |
| 122 | fprintf(outfd, "%s <%4.4x> %s:%d ", timestr, subsys, file, line); |
| 123 | } |
Holger Freyther | 32636e8 | 2008-12-27 11:07:15 +0000 | [diff] [blame] | 124 | vfprintf(outfd, format, ap); |
Holger Freyther | 7c03e4c | 2008-12-27 12:46:48 +0000 | [diff] [blame] | 125 | fprintf(outfd, "\033[0;m"); |
Holger Freyther | 32636e8 | 2008-12-27 11:07:15 +0000 | [diff] [blame] | 126 | |
| 127 | va_end(ap); |
| 128 | |
| 129 | fflush(outfd); |
| 130 | } |
| 131 | |
Harald Welte | 3cc4bf5 | 2009-02-28 13:08:01 +0000 | [diff] [blame] | 132 | static char hexd_buff[4096]; |
| 133 | |
| 134 | char *hexdump(unsigned char *buf, int len) |
Holger Freyther | ca362a6 | 2009-01-04 21:05:01 +0000 | [diff] [blame] | 135 | { |
| 136 | int i; |
Harald Welte | 3cc4bf5 | 2009-02-28 13:08:01 +0000 | [diff] [blame] | 137 | char *cur = hexd_buff; |
| 138 | |
| 139 | hexd_buff[0] = 0; |
Holger Freyther | ca362a6 | 2009-01-04 21:05:01 +0000 | [diff] [blame] | 140 | for (i = 0; i < len; i++) { |
Harald Welte | 3cc4bf5 | 2009-02-28 13:08:01 +0000 | [diff] [blame] | 141 | int len_remain = sizeof(hexd_buff) - (cur - hexd_buff); |
| 142 | int rc = snprintf(cur, len_remain, "%02x ", buf[i]); |
| 143 | if (rc <= 0) |
| 144 | break; |
| 145 | cur += rc; |
Holger Freyther | ca362a6 | 2009-01-04 21:05:01 +0000 | [diff] [blame] | 146 | } |
Harald Welte | 3cc4bf5 | 2009-02-28 13:08:01 +0000 | [diff] [blame] | 147 | hexd_buff[sizeof(hexd_buff)-1] = 0; |
| 148 | return hexd_buff; |
Holger Freyther | ca362a6 | 2009-01-04 21:05:01 +0000 | [diff] [blame] | 149 | } |
| 150 | |