source: svn/newcon3bcm2_21bu/dst/dhl/src/DHL_DBG.c @ 45

/**
        @file
                DHL_DBG.c

        @brief
                DHL Debug Module

        Copyright 2006~2010 Digital STREAM Technology, Inc.
        All Rights Reserved
*/


#include "DHL_OSAL.h"
#include "DHL_DBG.h"

#include "DHL_DBG_Priv.h"


//#include <stdio.h>
////#include <string.h>
//#include <ctype.h>


/*
        DHL µð¹ö±× ¸ðµâ À̸§ Á¤ÀÇ ·ê Âü°í:

        DHL ¸ðµâµéÀº ¸ðµÎ * ·Î ½ÃÀÛ.
        API´Â ´ë¹®ÀÚ, Platform ¹× ±âŸ´Â ¼Ò¹®ÀÚ »ç¿ë.

        µðÆúÆ® ·¹º§Àº 0À¸·Î ¼³Á¤ÇÑ´Ù. (0: ¿¡·¯ ¸Þ½ÃÁö¸¸ Ãâ·Â)
        
        
*/

//DHL_MODULE("*DBG", 0);



#if COMMENT
____Config____(){}
#endif

/*
        ÀÌ ¸ðµâ ³»ºÎ¿¡¼­ »ç¿ëµÇ´Â °¢Á¾ configuration Á¤ÀÇ.
*/


/* #define SUPPORT_FAST_SWITCHING_OPTIMIZATION 1 */
/* #define FUNC_MONITOR_TIMER_ID TIMER_ID_FUNC_MONITOR */

#define max(a,b) (((a) > (b)) ? (a) : (b))
#define min(a,b) (((a) < (b)) ? (a) : (b))



#if COMMENT
____Types____(){}
#endif

/*
        ÀÌ ¸ðµâ ³»ºÎ¿¡¼­ »ç¿ëµÇ´Â structure ¹× enumerations.
*/



#if COMMENT
____Variables____(){}
#endif

/*
        global·Î Àû¿ëµÇ´Â variable Á¤ÀÇ.
        °¢ function º°·Î Ư¼öÇÑ ¿ëµµÀÇ variableÀº °¢ functionX block ¿¡¼­ Á¤ÀÇ °¡´É.
*/



#if COMMENT
____Group1____(){}
#endif

/*

*/
void DHL_DBG_GenerateAssert(BOOL cond, const char *msg, const char *file, unsigned line)
{
        if (!cond) 
        {
                int bForceExit = FALSE;
                
                DHL_OS_Printf("\n!! ASSERT failed on %s:%d\n", file, line);
                DHL_OS_Printf("%s\n", msg);
                
                while(!bForceExit);
        }
}



#if COMMENT
____Group2____(){}
#endif




#if COMMENT
____Debug____(){}
#endif



#if COMMENT
____MemDump____(){}
#endif

#define isprint(c)      (((c) >= 32) && ((c) < 127))

void DHL_DBG_MemDump3(void *buf0, int size, char *msg, UINT32 off, UINT32 flag)
{
        int i, k, skip, n;
        unsigned char *p;
        char line[100];
        UINT8 *buf = buf0;
        
        if ((flag & MEMDUMP_NOHDR) == 0)
                DHL_OS_Printf("  Dump '%s' %d(0x%x) bytes:\n", msg ? msg : "", size, size);

        if (size <= 0)
                return;
                
        if (flag & MEMDUMP_ALIGN)  // align print position by its address.
                skip = (UINT32) buf % 16;
        else skip = 0;  // do not align.

        p = (unsigned char *)buf - skip;
        size += skip;

        for (i=0; i<size; i+=16, p+=16)
        {
                line[0] = 0;
                
                n = min(16, size-i) - skip;  // number of bytes to print in this line.

                // dump p[0]~p[n-1] in one line (n bytes)
                sprintf(line, "  %08x: ", (int)(p + off));  // off is used to adjust displayed address.

                for (k=0; k<skip; k++) {  // skip..
                        strcat(line, "__ ");
                        if (k == 7) strcat(line, " "); // cafrii 030903
                }

                for (; k<n+skip; k++) {      // data : n
                        sprintf(line+strlen(line), "%02x ", p[k]);
                        if (k == 7) strcat(line, " ");
                }
                for (; k<16; k++) {   // fill remainings.
                        strcat(line, "__ ");
                        if (k == 7) strcat(line, " ");
                }

                strcat(line, " ");
                for (k=0; k<skip; k++)
                        strcat(line, ".");
                for (; k<n+skip; k++)
                        sprintf(line+strlen(line), "%c", isprint(p[k]) && p[k]!='%' ? p[k] : '.');
                                // cafrii 030710
                                // cafrii 060612 do not print % sign
                for (; k<16; k++) {
                        strcat(line, ".");
                }

                strcat(line, "\n");
                
                DHL_OS_Printf(line);
                skip = 0;
        }
}

void DHL_DBG_MemDump2(void *buf, int size, char *msg, UINT32 off)
{
        DHL_DBG_MemDump3(buf, size, msg, off, MEMDUMP_ALIGN);
}


void DHL_DBG_MemDump (void *buf, int size, char *msg)
{
        DHL_DBG_MemDump3(buf, size, msg, 0, MEMDUMP_ALIGN);
}


int DHL_DBG_MemCmp(const unsigned char *s1, const unsigned char *s2, int len)
{
        // return -1 if same.
        // if mismatch, return offset which 1st difference.
        int i;
        for (i=0; i<len; i++) {
                if (s1[i] != s2[i])
                        return i;
        }
        return -1;
}


#if NOT_NEEDED  // ¾Æ·¡ memedit°¡ Á¦°øµÇ´Ï, ÀÌ ÇÔ¼öµéÀº ÇÊ¿ä ¾øÀ» µí ÇÔ.
/*
        ÀÌ ÇÔ¼ö´Â µð¹ö±ë ¿ëµµ·Î µî·ÏÇÏ´Â ÇÔ¼öÀÌ°í API´Â ¾Æ´Ï´Ù.
*/
void DHL_DBG_MemWrite (UINT32 addr, UINT8 data)
{
        *(UINT8 *)addr = data;
        DHL_OS_Printf("0x%08x <- 0x%02x, verify %02x\n", addr, data, *(UINT8 *)addr);
}

void DHL_DBG_MemWrite2 (UINT32 addr, UINT16 data)
{
        if (addr & 1) return;
        *(UINT16 *)addr = data;
        DHL_OS_Printf("0x%08x <- 0x%04x, verify %04x\n", addr, data, *(UINT16 *)addr);
}

void DHL_DBG_MemWrite4 (UINT32 addr, UINT32 data)
{
        if (addr & 3) return;
        *(UINT32 *)addr = data;
        DHL_OS_Printf("0x%08x <- 0x%08x, verify %08x\n", addr, data, *(UINT32 *)addr);
}

#endif



#if COMMENT
____memedit____(){}
#endif

#include "DHL_OSAL_Priv.h"

/*
        
*/
#define h2d(c) (\
                ((c)>='0'&&(c)<='9') ? (c)-'0' : \
                ((c)>='a'&&(c)<='f') ? (c)-'a'+10 : \
                ((c)>='A'&&(c)<='F') ? (c)-'A'+10 : \
                -1)
static UINT32 read_hex(char *p)
{
        int i;
        UINT32 data = 0;
        
        // skip spaces
        while (*p == ' ' || *p == '\t') p++;
        
        for (i=0; *p && i<8; i++, p++) {
                int d = h2d(*p);
                if (d < 0) break;
                data = (data << 4) | d;
        }
        return data;
}

/*
        µð¹ö±ë Áß¿¡ ¸Þ¸ð¸®(·¹Áö½ºÅÍ)ÀÇ Æ¯Á¤ ¿µ¿ªÀ» ¼öÁ¤ÇÏ°íÀÚ ÇÏ´Â °æ¿ì¿¡ 
        »ç¿ëµÉ ¼ö ÀÖ´Â À¯Æ¿¸®Æ¼.

        Shell »ó¿¡¼­ ±×³É memedit ¶ó°í ÀÔ·ÂÇÏ¸é µÈ´Ù.
        À߸ø µÈ ¹øÁö¸¦ Àаųª ±â·ÏÇÒ °æ¿ì exceptionÀÌ ¹ß»ýÇÒ ¼ö ÀÖ´Ù.
*/
void memedit(UINT32 addr)
{
        char buf[80];
        int align = 1; // one of 1, 2, 4

        #define print DHL_OS_Printf

        if (addr == 0)
                addr = (UINT32)&buf; // ¾Æ¹« ÀÇ¹Ì ¾øÀ½. 0¹øÁö´Â »ç¿ëÀÚ°¡ À߸ø ÀÔ·ÂÇÑ °ÍÀ¸·Î ÃßÁ¤.
        
        // print usage
        print("memedit usage\n");
        print("  > w 12345678 : write data of cur addr to 0x12345678\n");
        print("  > m b0001000 : modify (goto) address b0001000\n");
        print("  > [ENTER_KEY] : go to next addr without modifying\n");
        print("  > a 2 : address align (1:byte, 2:16bit, 4:32bit)\n");
        print("  > x : exit\n");
        print("\n");

        while(1) {
                if(align == 4) {
                        addr &= ~3;
                        print("%08x:%08x > ", addr, *(UINT32 *)addr);
                }
                else if(align == 2) {
                        addr &= ~1;
                        print("%08x:%04x > ", addr, *(UINT16 *)addr);
                }
                else {
                        print("%08x:%02x > ", addr, *(UINT8 *)addr);
                }

                // get user input.
                dhl_os_get_line(buf, sizeof(buf), eDHL_OS_GLF_NORMAL);
                if(buf[0] == 0) {
                        addr += align;
                }
                else if (buf[1] != ' ' && buf[1] != 0) {
                        continue; // invalid command. all cmd has one character.
                }
                else if (buf[0] == 'm') {
                        UINT32 new_addr = read_hex(&buf[1]);
                        if (new_addr == 0) 
                                print("wrong addr\n");
                        else
                                addr = new_addr;
                }
                else if (buf[0] == 'w') {
                        UINT32 data = read_hex(&buf[1]);
                        print("write 0x%x..\n", data);
                        if (align == 4)
                                *(UINT32 *)addr = (UINT32)data;
                        else if (align == 2)
                                *(UINT16 *)addr = (UINT16)data;
                        else
                                *(UINT8 *)addr = (UINT8)data;
                }
                else if (buf[0] == 'a') {
                        align = read_hex(&buf[1]);
                        if (align != 4 && align != 2) 
                                align = 1;
                        print("acces unit: %d\n", align);
                }
                else if(buf[0] == 'x') {
                        break;
                }
        }
}




#if COMMENT
____Symbol____(){}
#endif


#if DHL_REGISTER_DEUBG_SYMBOLS

static DHL_SymbolTable _symbols[] =
{
        //DHL_FNC_SYM_ENTRY2("symlkup", dhl_dbg_lookup_symbols),
        //DHL_FNC_SYM_ENTRY2("which", dhl_dbg_lookup_symbols),
        //DHL_FNC_SYM_ENTRY2("i", OS_ShowInfo),

        DHL_FNC_SYM_ENTRY2("sml", (void *)DHL_DBG_SetModuleLevel),
        DHL_FNC_SYM_ENTRY2("pml", (void *)DHL_DBG_PrintModuleLevel),
        //DHL_FNC_SYM_ENTRY2("sdt", DHL_DBG_SetDbgKey),
        //DHL_FNC_SYM_ENTRY2("pdt", DHL_DBG_PrintDbgKey),
        
        //----- 
        //DHL_VAR_SYM_ENTRY(dmc_bRequestVideoWidthReduction),
        
};

#endif // DHL_REGISTER_DEUBG_SYMBOLS




#if COMMENT
____Init____(){}
#endif



void DHL_DBG_Init(void)
{
        //DHL_DBG_InitVendor();
#if DHL_USING_DEBUG_SHELL_SYMBOLS       
        dhl_dbg_init_symtab();
        //dhl_dbg_init();

        //BKNOTE: disable first boot. DHL_DBG_StartDbgShell();
        //DHL_DBG_InitHeapDebug();
#endif
#if DHL_REGISTER_DEUBG_SYMBOLS
        DHL_DBG_RegisterSymbols(_symbols, DHL_NUMSYMBOLS(_symbols));
#endif

}


/* end of file */