actube/src/capwap/cw_log_debug.c

/*
    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 <http://www.gnu.org/licenses/>.

*/

#include <stdlib.h>
#include <stdarg.h>
#include <stdio.h>
#include <string.h>

#include "cw_log.h"
#include "capwap.h"
#include "cw_util.h"


static void cw_log_debug0_(const char *format, ...)
{
	if (cw_log_debug_level < 0)
		return;
	va_list args;
	va_start(args, format);
	cw_vlog_(LOG_DEBUG, format, args);
	va_end(args);
	closelog();
}

static void cw_log_debug1_(const char *format, ...)
{
	if (cw_log_debug_level < 1)
		return;

	va_list args;
	va_start(args, format);
	cw_vlog_(LOG_DEBUG, format, args);
	va_end(args);
	closelog();
}

static void cw_log_debug2_(const char *format, ...)
{
	if (cw_log_debug_level < 2)
		return;
	va_list args;
	va_start(args, format);
	cw_vlog_(LOG_DEBUG, format, args);
	va_end(args);
	closelog();
}

int cw_log_debug_dump_(int level, const uint8_t * data, int len,
		       const char *format, ...)
{
	int maxtlen = 2048;
	int i;
	int rowlen = CW_LOG_DUMP_ROW_LEN;
	int rows = len / rowlen;
	int tlen = 0;

	char *dst = malloc(len * 3 + (rows * 2) + 8 + maxtlen);
	if (!dst)
		return 0;

	if (format != NULL) {
		va_list args;
		va_start(args, format);
		tlen = vsnprintf(dst, maxtlen, format, args);
		va_end(args);
	}



	if (len % CW_LOG_DUMP_ROW_LEN)
		rows++;



	char *pdst = dst + tlen;
	sprintf(pdst, "\n\t");
	pdst += 2;

	for (i = 0; i < len; i++) {
		sprintf(pdst, "%02X ", data[i] & 0xff);
		pdst += 3;
		if ((i + 1) % rowlen == 0) {
			sprintf(pdst, "\n\t");
			pdst += 2;
		}

	}

	cw_log_debug_cbs[level] ("%s", dst);

	free(dst);
	return 1;

}

int cw_log_debug_level = 0;



int cw_dbg_opt_detail = 0;
int cw_dbg_opt_level = 0;


void cw_log_dbg_(int level, const char *file, int line, const char *format,
		 ...)
{
	if (!(level & cw_dbg_opt_level))
		return;

	char buf[2048];

	va_list args;
	va_start(args, format);
	vsprintf(buf, format, args);
	va_end(args);

	if (cw_dbg_opt_detail & DBG_DETAIL_LINE_NUMBERS)
		cw_log(LOG_DEBUG, "%s:%d: %s", file, line, buf);
	else
		cw_log(LOG_DEBUG, buf);
}



void cw_log_dbg_dmp_(int level, const char *file, int line,
		     const uint8_t * data, int len, const char *format,
		     ...)
{

	if (!(level & cw_dbg_opt_level))
		return;


	int maxtlen = 2048;
	int i;
	int rowlen = CW_LOG_DUMP_ROW_LEN;
	int rows = len / rowlen;
	int tlen = 0;

	int md;
	if (cw_dbg_opt_detail & DBG_DETAIL_ASC_DMP)
		md = 2;
	else
		md = 1;



	char *dst = malloc(md * (len * 3 + (rows * 2) + 8 + maxtlen));
	if (!dst)
		return;

	if (format != NULL) {
		va_list args;
		va_start(args, format);
		tlen = vsnprintf(dst, maxtlen, format, args);
		va_end(args);
	}



	if (len % CW_LOG_DUMP_ROW_LEN)
		rows++;



	char *pdst = dst + tlen;
	sprintf(pdst, "\n\t");
	pdst += 2;

	char asc_buffer[128];
	char *ascdst = asc_buffer;

	for (i = 0; i < len; i++) {
		sprintf(pdst, "%02X ", data[i] & 0xff);

		if (cw_dbg_opt_detail & DBG_DETAIL_ASC_DMP) {
			int c = data[i] & 0xff;
			if (c < 0x20 || c > 0x80)
				c = '.';
			*ascdst = c;
			ascdst++;
		}

		pdst += 3;
		if ((i + 1) % rowlen == 0) {
			int l;
			if (cw_dbg_opt_detail & DBG_DETAIL_ASC_DMP) {
				*ascdst = 0;
				l = sprintf(pdst, " | %s\n\t", asc_buffer);
				ascdst = asc_buffer;

			} else {
				l = sprintf(pdst, "\n\t");
			}
			pdst += l;
		}

	}

	if (cw_dbg_opt_detail & DBG_DETAIL_ASC_DMP) {
		*ascdst = 0;
		if (strlen(asc_buffer))
			pdst += sprintf(pdst, " | %s", asc_buffer);

	}

	if (cw_dbg_opt_detail & DBG_DETAIL_LINE_NUMBERS)
		cw_log(LOG_DEBUG, "%s:%d: %s", file, line, dst);
	else
		cw_log(LOG_DEBUG, dst);

	free(dst);
	return;

}






void (*cw_log_debug_cbs[]) (const char *fromat, ...) = {
cw_log_debug0_, cw_log_debug1_, cw_log_debug2_};



/**
 * print debug info for message elements
 */

void cw_dbg_msgelem_(int msg, int msgelem, const uint8_t * msgbuf, int len)
{
	if (!cw_dbg_is_level(DBG_CW_MSGELEM))
		return;

	const char *elemname;
	char vendorname[256];
	if (msgelem == CWMSGELEM_VENDOR_SPECIFIC_PAYLOAD) {
		int vendor = ntohl(*((uint32_t *) msgbuf));
		int type = ntohs(*((uint16_t *) (msgbuf + 4)));
		sprintf(vendorname, "%s/%s/%d",
			(char *) cw_msgelemtostr(msgelem),
			(char *) cw_ianavendoridtostr(vendor), type);
		elemname = vendorname;
	} else {
		elemname = cw_msgelemtostr(msgelem);
	}


	if (!cw_dbg_is_level(DBG_CW_MSGELEM_DMP))
		cw_dbg(DBG_CW_MSGELEM,
		       "Reading %s msgelem, type=%d (%s), len=%d",
		       cw_msgtostr(msg), msgelem, elemname, len);

	else
		cw_dbg_dmp(DBG_CW_MSGELEM, msgbuf, len,
			   "Reading %s msgelem, type=%d (%s), len=%d\n\t Dump ...",
			   cw_msgtostr(msg), msgelem, elemname, len);
}

void cw_dbg_missing_mand_elems_(struct conn *conn, int msgtype, int *mand)
{
	if (!cw_dbg_is_level(DBG_CW_RFC))
		return;

	if (cw_is_missing_mand_elems(mand)) {
		char str[512];
		cw_get_missing_mand_elems(str, mand);
		cw_dbg(DBG_CW_RFC, "Missing msgelems in %s: %s",
		       cw_msgtostr(msgtype), str);
	}
}

//cw_dbg(DBG_CW_MSGELEM,"Process discovery req msgelem, type=%d (%s), len=%d",type,cw_msgelemtostr(type),len);
//cw_dbg_dmp(DBG_CW_MSGELEM_DMP,msgelem,len,"Dump for msgelem ...");