79 lines
1.4 KiB
C
79 lines
1.4 KiB
C
|
#ifndef __DEBUG_H__
|
||
|
|
#define __DEBUG_H__
|
||
|
|
|
||
|
|
#include <stdio.h>
|
||
|
|
|
||
|
|
#define DEBUG(enable, tagged, ...) \
|
||
|
|
do \
|
||
|
|
{ \
|
||
|
|
if (enable) \
|
||
|
|
{ \
|
||
|
|
if (tagged) \
|
||
|
|
fprintf(stderr, "[ %25s() ] ", __func__); \
|
||
|
|
fprintf(stderr, __VA_ARGS__); \
|
||
|
|
} \
|
||
|
|
} while( 0)
|
||
|
|
|
||
|
|
#define ERROR(...) DEBUG(1, 1, "ERROR:"__VA_ARGS__)
|
||
|
|
|
||
|
|
#define KASSERT(cond) \
|
||
|
|
{ \
|
||
|
|
if (!(cond)) \
|
||
|
|
{ \
|
||
|
|
ERROR("Failed assertion in %s:\n" \
|
||
|
|
"%s at %s\n" \
|
||
|
|
"line %d\n" \
|
||
|
|
"RA=%lx\n", \
|
||
|
|
__func__, \
|
||
|
|
#cond, \
|
||
|
|
__FILE__, \
|
||
|
|
__LINE__, \
|
||
|
|
(unsigned long)__builtin_return_address(0)); \
|
||
|
|
\
|
||
|
|
while (1) \
|
||
|
|
; \
|
||
|
|
} \
|
||
|
|
}
|
||
|
|
|
||
|
|
#define KPANIC(args, ...) \
|
||
|
|
{ \
|
||
|
|
ERROR(args, __VA_ARGS__); \
|
||
|
|
while (1) ; \
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void dump_mem(const void *mem, int count)
|
||
|
|
{
|
||
|
|
const unsigned char *p = mem;
|
||
|
|
int i = 0;
|
||
|
|
|
||
|
|
for(i = 0; i < count; i++)
|
||
|
|
{
|
||
|
|
if( i % 16 == 0)
|
||
|
|
DEBUG(1, 0, "\n");
|
||
|
|
|
||
|
|
DEBUG(1, 0, "%02x ", p[i]);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
/* help to trace back */
|
||
|
|
static inline void dump_stack(void)
|
||
|
|
{
|
||
|
|
unsigned long *stack;
|
||
|
|
unsigned long addr;
|
||
|
|
|
||
|
|
__asm__ __volatile__ ("\tori\t%0, $sp, #0\n" : "=r" (stack));
|
||
|
|
|
||
|
|
printf("Call Trace:\n");
|
||
|
|
addr = *stack;
|
||
|
|
while (addr)
|
||
|
|
{
|
||
|
|
addr = *stack++;
|
||
|
|
printf("[<%08lx>] ", addr);
|
||
|
|
}
|
||
|
|
printf("\n");
|
||
|
|
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
|
||
|
|
#endif /* __DEBUG_H__ */
|