/* This file is part of libcapwap. libcapwap 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 3 of the License, or (at your option) any later version. libcapwap 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 Foobar. If not, see . */ /** * @file Debugging Functions * @brief Various debug functions. */ #include #include "mbag.h" #include "capwap.h" #include "dbg.h" #include "sock.h" #include "log.h" #include "strlist.h" #include "format.h" #include "capwap.h" #include "capwap_cisco.h" #include "lwapp_cisco.h" #include "cw.h" #include "message_set.h" /** *@addtogroup DBG *@{ */ /* * @defgroup DebugFunctions Debug Functions * @{ */ /* void (*cw_dbg_cb) (int level, const char *format, ...) = CW_LOG_DEFAULT_LOG; void (*cw_dbg_vcb) (int level, const char *fromat, va_list args) = CW_LOG_DEFAULT_VLOG; */ uint32_t cw_dbg_opt_display = 0; /** * Current debug level */ uint32_t cw_dbg_opt_level = 0; #define DBG_CLR_MAGENTA "\x1b[35m" #define DBG_CLR_MAGENTA_L "\x1b[95m" #define DBG_CLR_MAGENTA_B "\x1b[1;35m" #define DBG_CLR_MAGENTA_F "\x1b[2;35m" #define DBG_CLR_MAGENTA_I "\x1b[3;35m" #define DBG_CLR_BLUE "\x1b[34m" #define DBG_CLR_BLUE_B "\x1b[1;34m" #define DBG_CLR_BLUE_F "\x1b[2;34m" #define DBG_CLR_BLUE_I "\x1b[3;34m" #define DBG_CLR_YELLO "\x1b[33m" #define DBG_CLR_YELLO_I "\x1b[3;33m" #define DBG_CLR_CYAN "\x1b[36m" #define DBG_CLR_RED_I "\x1b[3;31m" static struct cw_strlist_elem color_on[] = { {DBG_PKT_IN, DBG_CLR_YELLO}, {DBG_PKT_OUT, DBG_CLR_YELLO_I}, {DBG_MSG_IN, DBG_CLR_BLUE}, {DBG_MSG_OUT, DBG_CLR_BLUE_I}, {DBG_ELEM, "\x1b[39m"}, {DBG_MSG_ERR, "\x1b[31m"}, {DBG_PKT_ERR, "\x1b[31m"}, {DBG_ELEM_ERR, "\x1b[31m"}, {DBG_SUBELEM, "\x1b[30m"}, {DBG_DTLS, DBG_CLR_MAGENTA_B}, {DBG_DTLS_DETAIL, DBG_CLR_MAGENTA}, {DBG_DTLS_BIO, DBG_CLR_MAGENTA_L}, {DBG_RFC, "\x1b[31m"}, {DBG_X, "\x1b[31m"}, {DBG_WARN, DBG_CLR_CYAN}, {DBG_MOD, "\x1b[91m"}, {CW_STR_STOP, ""} }; static struct cw_strlist_elem color_ontext[] = { {DBG_ELEM_DMP, "\x1b[30m"}, {CW_STR_STOP, ""} }; static struct cw_strlist_elem color_off[] = { {CW_STR_STOP, "\x1b[22;39m\x1b[23m"} }; static struct cw_strlist_elem prefix[] = { {DBG_INFO, " Info -"}, {DBG_PKT_IN, " Pkt IN -"}, {DBG_PKT_OUT, " Pkt Out -"}, {DBG_MSG_IN, " Msg IN -"}, {DBG_MSG_OUT, " Msg Out -"}, {DBG_ELEM, " Msg Element -"}, {DBG_MSG_ERR, " Msg Error -"}, {DBG_PKT_ERR, " Pkt Error -"}, {DBG_ELEM_ERR, " Elem Error -"}, {DBG_RFC, " RFC -"}, {DBG_SUBELEM, " Sub-Element - "}, {DBG_DTLS, " DTLS - "}, {DBG_DTLS_DETAIL, " DTLS - "}, {DBG_WARN, " Warning - "}, {DBG_MOD, " Mod - "}, {DBG_X, "XXXXX - "}, {CW_STR_STOP, ""} }; static const char *get_dbg_color_on(int level) { if (!(cw_dbg_opt_display & DBG_DISP_COLORS)) return ""; return cw_strlist_get_str(color_on, level); } static const char *get_dbg_color_off(int level) { if (!(cw_dbg_opt_display & DBG_DISP_COLORS)) return ""; return cw_strlist_get_str(color_off, level); } static const char *get_dbg_prefix(int level) { return cw_strlist_get_str(prefix, level); } static const char *get_dbg_color_ontext(int level) { if (!(cw_dbg_opt_display & DBG_DISP_COLORS)) return ""; return cw_strlist_get_str(color_ontext, level); } /** * Put a list of missing mandatory message elements to debug output */ void cw_dbg_missing_mand(int level, struct conn *conn, cw_action_in_t ** ml, int n, cw_action_in_t * a) { /* // if (!cw_dbg_is_level(DBG_MSG_ERR) || n == 0) // return; */ char buffer[2000]; /* char *p = buffer; */ int i; /* char *delim = "";*/ if (!cw_dbg_is_level(level) || n == 0) return; /* // TODO XXXX */ for (i = 0; i < n; i++) { /* p += sprintf(p, "%s", delim); delim = ", "; p += sprintf(p, "%s", cw_strelemp(conn->actions, ml[i]->elem_id)); */ } cw_dbg(level, "Missing mandatory elements: [%s]", buffer); } /** * Display a packet on for debugger */ void cw_dbg_pkt(int level, struct conn *conn, uint8_t * packet, int len, struct sockaddr *from) { int hlen; char buf[1024]; if (!cw_dbg_is_level(level)) return; if (level == DBG_PKT_IN) cw_format_pkt_hdr(buf, 1, packet, len, from); else cw_format_pkt_hdr(buf, 0, packet, len, from); hlen = cw_get_hdr_msg_offset(packet); if (cw_dbg_is_level(DBG_PKT_DMP)) { /* char *dmp = cw_dbg_mkdmp_c(packet, len, hlen); */ char * dmp; dmp = cw_format_dump(packet,len,NULL); cw_dbg(level, "%s%s", buf, dmp); free(dmp); } else cw_dbg(level, "%s", buf); } void cw_dbg_pkt_nc(int level, struct netconn *nc, uint8_t * packet, int len, struct sockaddr *from) { /* if (!cw_dbg_is_level(level)) return; char buf[1024]; cw_format_pkt_hdr(buf, level, NULL, packet, len, from); int hlen = cw_get_hdr_msg_offset(packet); if (cw_dbg_is_level(DBG_PKT_DMP)) { char *dmp = cw_dbg_mkdmp_c(packet, len, hlen); cw_dbg(level, "%s%s", buf, dmp); free(dmp); } else cw_dbg(level, "%s", buf); */ } void cw_dbg_dmp(int level, const uint8_t * data, int len, const char *format, ...) { char *dmp; if (!cw_dbg_is_level(level)) return; dmp = cw_format_dump(data, len, NULL); cw_dbg(level, "%s%s", format, dmp); free(dmp); } void cw_dbg_msg(int level, struct conn *conn, uint8_t * packet, int len, struct sockaddr *from) { char sock_buf[SOCK_ADDR_BUFSIZE]; char buf[1024]; char *s; struct cw_MsgData search; struct cw_MsgData * message; const char * msname; uint8_t *msgptr; int msg_id; if (!cw_dbg_is_level(level)) return; s = buf; msgptr = cw_get_hdr_msg_ptr(packet); /* // int pplen = len - (msgptr-packet); */ msg_id = cw_get_msg_id(msgptr); search.type = msg_id; message = mavl_get_ptr(conn->msgset->messages,&search); if (!message) msname="Unknown"; else msname = message->name; s += sprintf(s, "%s Message (type=%d) ", msname /*cw_strmsg(msg_id)*/, msg_id); if (level == DBG_MSG_IN) s += sprintf(s, "from %s ", sock_addr2str(from,sock_buf)); else s += sprintf(s, "to %s ", sock_addr2str(from,sock_buf)); s += sprintf(s, ", Seqnum: %d ElemLen: %d", cw_get_msg_seqnum(msgptr), cw_get_msg_elems_len(msgptr)); /* //abort: */ cw_dbg(level, "%s", buf); } static int cw_format_vendor(char *dst, uint32_t vendor_id, int elem_id, const uint8_t * elem_data) { uint32_t lw_elem_id; switch (vendor_id) { case CW_VENDOR_ID_CISCO: { if (elem_id != CW_CISCO_SPAM_VENDOR_SPECIFIC) { return sprintf(dst, "%d - %s", elem_id, cw_cisco_id_to_str(elem_id)); } /* dive into LWAPP vendor specific decoding */ lw_elem_id = lw_get_word(elem_data + 4 + 6); return sprintf(dst, "%d/LWAPP Vendor: %d - %s", elem_id, lw_elem_id, lw_cisco_id_to_str(lw_elem_id)); break; } default: { return sprintf(dst, "%d", elem_id); } } return 0; } void cw_dbg_version_subelem(int level, const char *context, int subtype, uint32_t vendor_id, const uint8_t * vstr, int len) { char v[2048]; int n; if (!cw_dbg_is_level(level)) return; if (!vstr) return; n = cw_format_version(v, vstr, len); sprintf(v + n, ", Vendor Id: %d, %s", vendor_id, cw_strvendor(vendor_id)); cw_dbg(level, "%s: SubType %d, %s", context, subtype, v); } void cw_dbg(int level, const char *format, ...) { char fbuf[1024]; va_list args; if (!(cw_dbg_is_level(level))) return; sprintf(fbuf, "DBG:%s%s %s%s%s", get_dbg_color_on(level), get_dbg_prefix(level), get_dbg_color_ontext(level), format, get_dbg_color_off(level) ); va_start(args, format); /* cw_log_vcb(level, fbuf, args);*/ cw_log_console_writer.write(LOG_DEBUG,fbuf,args,&cw_log_console_writer); va_end(args); } /* //int cw_is_utf8(unsigned char *str, size_t len); */ int cw_format_item(char *dst, mbag_item_t * item) { *dst = 0; if (item->type == MBAG_BSTR16) { strncpy(dst, (char *) bstr16_data(item->u2.data), bstr16_len(item->u2.data)); *(dst + bstr16_len(item->u2.data)) = 0; return bstr16_len(item->u2.data); } return 0; } /* void dbg_istore_dmp(mbag_t s) { DEFINE_AVLITER(it,s); avliter_foreach(&it) { mbag_item_t *i = avliter_get(&it); char buffer[1000]; struct cw_str * strings = cw_item_strings; const char * in = cw_strlist_get_str(strings,i->id); cw_format_item(buffer,i); printf("Item ID %d-%s: %s\n",i->id,in,buffer); } } */ /**@}*/ /**@}*/