/*
|
*********************************************************************************************************
|
* AR100 System
|
* AR100 Software System Develop Kits
|
* Debugger Module
|
*
|
* (c) Copyright 2012-2016, Sunny China
|
* All Rights Reserved
|
*
|
* File : debugger.c
|
* By : Sunny
|
* Version : v1.0
|
* Date : 2012-5-3
|
* Descript: debugger module.
|
* Update : date auther ver notes
|
* 2012-5-3 17:16:47 Sunny 1.0 Create this file.
|
*********************************************************************************************************
|
*/
|
|
#include "debugger_i.h"
|
|
u32 debug_level = 3;
|
volatile unsigned int print_timeflg = 1;
|
#define DEBUG_BUFFER_SIZE (128) /* debug buffer size */
|
/*
|
*********************************************************************************************************
|
* INITIALIZE DEBUGGER
|
*
|
* Description: initialize debugger.
|
*
|
* Arguments : none.
|
*
|
* Returns : OK if initialize debugger succeeded, others if failed.
|
*********************************************************************************************************
|
*/
|
s32 debugger_init(void)
|
{
|
/* initialize serial module */
|
//uart_init();
|
#ifdef CFG_SHELL_USED
|
extern s32 getcmd(void *parg);
|
install_isr(INTC_R_UART_IRQ, getcmd, NULL);
|
interrupt_enable(INTC_R_UART_IRQ);
|
#endif
|
|
return OK;
|
}
|
|
/*
|
*********************************************************************************************************
|
* EXIT DEBUGGER
|
*
|
* Description: exit debugger.
|
*
|
* Arguments : none.
|
*
|
* Returns : OK if exit debugger succeeded, others if failed.
|
*********************************************************************************************************
|
*/
|
s32 debugger_exit(void)
|
{
|
return OK;
|
}
|
|
/*
|
*********************************************************************************************************
|
* PUT A CHARSET
|
*
|
* Description: put out a charset.
|
*
|
* Arguments : ch : the charset which we want to put out.
|
*
|
* Returns : OK if put out charset succeeded, others if failed.
|
*********************************************************************************************************
|
*/
|
s32 debugger_putc(char ch)
|
{
|
uart_putc(ch);
|
|
return OK;
|
}
|
|
/*
|
*********************************************************************************************************
|
* GET A CHARSET
|
*
|
* Description: get a charset.
|
*
|
* Arguments : none.
|
*
|
* Returns : the charset we read from uart.
|
*********************************************************************************************************
|
*/
|
u32 debugger_get(char *buf)
|
{
|
return uart_get(buf);
|
}
|
|
/*
|
*********************************************************************************************************
|
* PUT A STRING
|
*
|
* Description: put out a string.
|
*
|
* Arguments : string : the string which we want to put out.
|
*
|
* Returns : OK if put out string succeeded, others if failed.
|
*********************************************************************************************************
|
*/
|
s32 debugger_puts(char *string)
|
{
|
uart_puts(string);
|
|
return OK;
|
}
|
|
/*
|
*********************************************************************************************************
|
* FORMATTED PRINTF
|
*
|
* Description: print out a formatted string, similar to ANSI-C function printf().
|
* This function can support and only support the following conversion specifiers:
|
* %d signed decimal integer.
|
* %u unsigned decimal integer.
|
* %x unsigned hexadecimal integer, using hex digits 0x.
|
* %c single character.
|
* %s character string.
|
*
|
* Arguments : format : format control.
|
* ... : arguments.
|
*
|
* Returns : the number of characters printed out.
|
*
|
* Note : the usage refer to ANSI-C function printf().
|
*********************************************************************************************************
|
*/
|
char debugger_buffer[DEBUG_BUFFER_SIZE];
|
s32 debugger_printf(u32 level, const char *format, ...)
|
{
|
va_list args;
|
char string[16]; /* align by cpu word */
|
char *pdest;
|
char *psrc;
|
s32 align;
|
s32 len = 0;
|
s32 cpsr;
|
|
if (level & (0xf0 >> (debug_level + 1))) {
|
cpsr = cpu_disable_int();
|
/* dump current timestemp */
|
if (print_timeflg)
|
print_current_time();
|
pdest = debugger_buffer;
|
va_start(args, format);
|
while (*format) {
|
if (*format == '%') {
|
++format;
|
if (('0' < (*format)) && ((*format) <= '9')) {
|
/* we just suport wide from 1 to 9. */
|
align = *format - '0';
|
++format;
|
} else {
|
align = 0;
|
}
|
|
switch (*format) {
|
case 'd':
|
{
|
/* int */
|
itoa(va_arg(args, int), string, 10);
|
len = strlen(string);
|
len += print_align(string, len, align);
|
strcpy(pdest, string);
|
pdest += len;
|
break;
|
}
|
case 'x':
|
case 'p':
|
{
|
/* hex */
|
utoa(va_arg(args, unsigned long), string, 16);
|
len = strlen(string);
|
len += print_align(string, len, align);
|
strcpy(pdest, string);
|
pdest += len;
|
break;
|
}
|
case 'u':
|
{
|
/* unsigned int */
|
utoa(va_arg(args, unsigned long), string, 10);
|
len = strlen(string);
|
len += print_align(string, len, align);
|
strcpy(pdest, string);
|
pdest += len;
|
break;
|
}
|
case 'c':
|
{
|
/* charset, aligned by cpu word */
|
*pdest = (char)va_arg(args, int);
|
break;
|
}
|
case 's':
|
{
|
/* string */
|
psrc = va_arg(args, char *);
|
strcpy(pdest, psrc);
|
pdest += strlen(psrc);
|
break;
|
}
|
default:
|
{
|
/* no-conversion */
|
*pdest++ = '%';
|
*pdest++ = *format;
|
}
|
}
|
} else {
|
*pdest++ = *format;
|
}
|
/* parse next token */
|
++format;
|
}
|
va_end(args);
|
|
if (*(pdest - 1) == '\n')
|
print_timeflg = 1;
|
else
|
print_timeflg = 0;
|
/* must end with '\0' */
|
*pdest = '\0';
|
pdest++;
|
debugger_puts(debugger_buffer);
|
cpu_enable_int(cpsr);
|
|
return (pdest - debugger_buffer);
|
}
|
return OK;
|
}
|
|
static s32 print_align(char *string, s32 len, s32 align)
|
{
|
/*
|
* fill with space ' ' when align request,
|
* the max align length is 16 byte.
|
*/
|
char fill_ch[] = " ";
|
if (len < align) {
|
/* fill at right */
|
strncat(string, fill_ch, align - len);
|
return align - len;
|
}
|
/* not fill anything */
|
return 0;
|
}
|
|
/*
|
*********************************************************************************************************
|
* print current time
|
*
|
* Description: print current time.
|
*
|
* Arguments : none.
|
*
|
* Returns : OK if print current time succeeded, others if failed.
|
*********************************************************************************************************
|
*/
|
static s32 print_current_time(void)
|
{
|
char time[12];
|
u32 millisec;
|
u32 sec;
|
u32 div;
|
u32 i;
|
|
/* convert current ticks to millisecond. */
|
millisec = current_time_tick() * (1000 / TICK_PER_SEC);
|
|
/*
|
* time print format : [secs.ms] s,
|
* example : [0001.00] s.
|
*/
|
time[0] = '[';
|
time[5] = '.';
|
time[8] = ']';
|
time[9] = ' ';
|
time[10] = '\0';
|
|
/* second */
|
sec = millisec / 1000;
|
sec = sec % 10000;
|
div = 1000;
|
for (i = 1; i <= 4; i++) {
|
time[i] = ((u8)(sec / div)) + '0';
|
sec = sec % div;
|
div = div / 10;
|
}
|
/* millisecond */
|
millisec = millisec % 1000;
|
div = 100;
|
for (i = 6; i <= 7; i++) {
|
time[i] = ((u8)(millisec / div)) + '0';
|
millisec = millisec % div;
|
div = div / 10;
|
}
|
/* dump time buffer */
|
debugger_puts(time);
|
|
return OK;
|
}
|
|
/*
|
*********************************************************************************************************
|
* SET DEBUG LEVEL
|
*
|
* Description: set debug level.
|
*
|
* Arguments : para level.
|
*
|
* Returns : OK if set the debug level succeeded.
|
*********************************************************************************************************
|
*/
|
s32 set_debug_level(u32 level)
|
{
|
LOG("debug_mask from %d to %d\n", debug_level, level);
|
debug_level = level;
|
|
return OK;
|
}
|
