debug.c

一个Windows下的Linux专用虚拟机

/*
 * This source code is a part of coLinux source package.
 *
 * Dan Aloni <[e-mail]>, 2003 (c)
 *
 * The code is licensed under the GPL. See the COPYING file at
 * the root directory.
 */

#include "common.h"
#include "debug.h"

#include <colinux/common/libc.h>
#include <colinux/os/timer.h>
#include <stdarg.h>

CO_TRACE_STOP;

void co_trace_ent_name(void *ptr, const char *name)
{
	static int reenter = 0;
	
	if (reenter)
		return;

	reenter++;
	
	co_debug("TRACE: [%p] %s", ptr, name);

	reenter--;
}

static inline co_debug_tlv_t *tlv_add_const_string(co_debug_type_t type, const char *str, co_debug_tlv_t *sub_tlv)
{
	sub_tlv->type = type;
	sub_tlv->length = co_strlen(str) + 1;
	co_memcpy(sub_tlv->value, str, sub_tlv->length);
	return (co_debug_tlv_t *)&sub_tlv->value[sub_tlv->length];
}

static inline co_debug_tlv_t *tlv_add_timestamp(co_debug_tlv_t *sub_tlv)
{
	sub_tlv->type = CO_DEBUG_TYPE_TIMESTAMP;
	sub_tlv->length = sizeof(co_timestamp_t);
	{
		co_timestamp_t *ts = (co_timestamp_t *)&sub_tlv->value;
		co_os_get_timestamp(ts);
	}
	return (co_debug_tlv_t *)&sub_tlv->value[sub_tlv->length];
}

static inline co_debug_tlv_t *tlv_add_unsigned_long(co_debug_type_t type, unsigned long data, co_debug_tlv_t *sub_tlv)
{
	sub_tlv->type = type;
	sub_tlv->length = sizeof(data);
 	*((typeof(data) *)sub_tlv->value) = data;
	return (co_debug_tlv_t *)&sub_tlv->value[sub_tlv->length];
}

static inline co_debug_tlv_t *tlv_add_char(co_debug_type_t type, unsigned long data, co_debug_tlv_t *sub_tlv)
{
	sub_tlv->type = type;
	sub_tlv->length = sizeof(data);
 	*((typeof(data) *)sub_tlv->value) = data;
	return (co_debug_tlv_t *)&sub_tlv->value[sub_tlv->length];
}

int co_debug_local_index = 0;
#define X(facility, static_level, default_dynamic_level) .facility##_level=default_dynamic_level,
co_debug_levels_t co_global_debug_levels = {
	CO_DEBUG_LIST
};
#undef X

void co_debug_(const char *module, co_debug_facility_t facility, int level, 
	       const char *filename, int line, const char *func,
	       const char *fmt, ...)
{
	long packet_size = 0;

	packet_size += sizeof(co_debug_type_t) + co_strlen(module) + 1;
	packet_size += sizeof(co_debug_type_t) + co_strlen(filename) + 1;
	packet_size += sizeof(co_debug_type_t) + co_strlen(func) + 1;
	packet_size += sizeof(co_debug_type_t) + sizeof(co_timestamp_t);
	packet_size += sizeof(co_debug_type_t) + sizeof(unsigned long);
	packet_size += sizeof(co_debug_type_t) + sizeof(unsigned long);
	packet_size += sizeof(co_debug_type_t) + sizeof(unsigned char);
	packet_size += sizeof(co_debug_type_t) + sizeof(unsigned char);
	packet_size += sizeof(co_debug_type_t) + 120;

	{
	char buffer[packet_size];
	co_debug_tlv_t *sub_tlv = (co_debug_tlv_t *)buffer;
	va_list ap;

	sub_tlv = tlv_add_const_string(CO_DEBUG_TYPE_MODULE, module, sub_tlv);
	sub_tlv = tlv_add_const_string(CO_DEBUG_TYPE_FILE, filename, sub_tlv);
	sub_tlv = tlv_add_timestamp(sub_tlv);
	sub_tlv = tlv_add_unsigned_long(CO_DEBUG_TYPE_LOCAL_INDEX, ++co_debug_local_index, sub_tlv);
	sub_tlv = tlv_add_char(CO_DEBUG_TYPE_FACILITY, facility, sub_tlv);
	sub_tlv = tlv_add_const_string(CO_DEBUG_TYPE_FUNC, func, sub_tlv);
	sub_tlv = tlv_add_unsigned_long(CO_DEBUG_TYPE_LINE, line, sub_tlv);
	sub_tlv = tlv_add_char(CO_DEBUG_TYPE_LEVEL, level, sub_tlv);

	sub_tlv->type = CO_DEBUG_TYPE_STRING;

	va_start(ap, fmt);
	co_vsnprintf(sub_tlv->value, sizeof(buffer) - (sub_tlv->value - (char *)buffer) - 1, fmt, ap);
	va_end(ap);
	sub_tlv->length = co_strlen(sub_tlv->value) + 1;

	co_debug_level_system(module, facility, level, filename, line, func, sub_tlv->value);
	co_debug_buf(buffer, (&sub_tlv->value[sub_tlv->length]) - buffer);
	}
}

CO_TRACE_CONTINUE;