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"


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_
};




void cw_dbg_msgelem_(int msg, int msgelem, const uint8_t *msgbuf,int len)
{
	if (!cw_dbg_is_level(DBG_CW_MSGELEM))
		return;
	/*	
	char buf[250];
	sprintf(buf,"Reading %s msgelem, type=%d (%d), len=%d",
		cw_msgtostr(msg),
		msgelem,
		cw_msgelemtostr(msg));
*/
	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,
        	        cw_msgelemtostr(msgelem),
			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,
        	        cw_msgelemtostr(msgelem),
			len);
	
		


}

//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 ...");