2 * Copyright (c) 2013 Qualcomm Atheros, Inc.
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted (subject to the limitations in the
7 * disclaimer below) provided that the following conditions are met:
9 * * Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
12 * * Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the
17 * * Neither the name of Qualcomm Atheros nor the names of its
18 * contributors may be used to endorse or promote products derived
19 * from this software without specific prior written permission.
21 * NO EXPRESS OR IMPLIED LICENSES TO ANY PARTY'S PATENT RIGHTS ARE
22 * GRANTED BY THIS LICENSE. THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT
23 * HOLDERS AND CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED
24 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
25 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
26 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
27 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
28 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
29 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
30 * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
31 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
32 * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
33 * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
36 #include "athos_api.h"
38 #if defined(PROJECT_K2)
39 #if SYSTEM_MODULE_SFLASH
40 #include "sflash_api.h"
42 #endif /* #if defined(PROJECT_K2) */
44 #if defined(SYSTEM_MODULE_DBG)
46 /* Function prototypes */
47 int db_help_cmd(char *, char*, char*, char*);
48 int db_ldr_cmd(char*, char*, char*, char*);
49 int db_str_cmd(char*, char*, char*, char*);
50 int db_dump_memory(char* cmd, char* param1, char* param2, char* param3);
51 int db_info_cmd(char*, char*, char*, char*);
52 int db_cmd_dbg(char*, char*, char*, char*);
53 int db_usb_cmd(char*, char*, char*, char*);
54 int db_intr_cmd(char*, char*, char*, char*);
55 int db_patch_cmd(char*, char*, char*, char*);
57 int db_cmd_memtest(char* cmd, char* param1, char* param2, char* param3);
58 int db_cmd_dmips(char* cmd, char* param1, char* param2, char* param3);
59 int db_cmd_starthtc(char* cmd, char* param1, char* param2, char* param3);
61 int db_eeprom_cmd(char* cmd, char* param1, char* param2, char* param3);
62 int db_wdt_cmd(char* cmd, char* param1, char* param2, char* param3);
64 #if defined(PROJECT_K2)
65 #if SYSTEM_MODULE_SFLASH
66 int db_cmd_sferase(char* cmd, char* param1, char* param2, char* param3);
67 int db_cmd_sfpg(char* cmd, char* param1, char* param2, char* param3);
68 int db_cmd_sfru(char* cmd, char* param1, char* param2, char* param3);
69 int db_cmd_sfrm(char* cmd, char* param1, char* param2, char* param3);
70 int db_cmd_sfrdsr(char* cmd, char* param1, char* param2, char* param3);
72 #endif /* #if defined(PROJECT_K2) */
73 int db_cmd_memcmp(char* cmd, char* param1, char* param2, char* param3);
74 int db_cmd_memdump(char* cmd, char* param1, char* param2, char* param3);
76 int db_clock_cmd(char* cmd, char* param1, char* param2, char* param3);
78 uint16_t db_get_cmd_line(uint8_t ch, char *cmd_line, uint16_t* i);
79 int db_formalize_command(char*, char*);
80 int db_ascii_to_hex(char*, unsigned long*);
81 int db_hex_to_ascii(unsigned long, char*);
82 void zfDebugTask(void);
84 int db_info_intr(char* cmd, char* param1, char* param2, char* param3);
86 extern u32_t this_is_global_variables;
88 /* Console debug command table */
89 const struct DB_COMMAND_STRUCT command_table[] =
91 {"HELP", ", List all debug commands", db_help_cmd},
92 {"?", ", Equal to HELP comamnd", db_help_cmd},
94 /* Basic load/store/dump command */
95 {"LDR", "<Hex addr>, Load word", db_ldr_cmd},
96 {"LDRH", "<Hex addr>, Load half word", db_ldr_cmd},
97 {"LDRB", "<Hex addr>, Load byte", db_ldr_cmd},
98 {"STR", "<Hex addr> <Hex value>, Store word", db_str_cmd},
99 {"STRH", "<Hex addr> <Hex value>, Store half word", db_str_cmd},
100 {"STRB", "<Hex addr> <Hex value>, Store byte", db_str_cmd},
101 {"DUMP", "<Hex addr>, Dump memory", db_dump_memory},
102 {"INFO", ", Print debug information", db_info_cmd},
103 {"USB", ", usb releated command", db_usb_cmd},
104 {"INTR", ", intr releated command", db_intr_cmd},
105 {"PATCH", ", patch function releated command", db_patch_cmd},
106 {"DBG", ", mute all print msg", db_cmd_dbg},
107 {"CLOCK", ", change the clock...", db_clock_cmd},
108 {"MEMTEST", "<Hex addr> <Number of bytes> test memory", db_cmd_memtest},
109 {"HTCR", "Issue HTC ready to host", db_cmd_starthtc},
110 {"EEP", ", eeprom r/w debug command", db_eeprom_cmd},
111 {"WDT", ", wdt debug command", db_wdt_cmd},
112 #if defined(PROJECT_K2)
113 #if SYSTEM_MODULE_SFLASH
114 {"SFE", ", S<Hex>/B<Hex>/C, SPI Flash chip erase", db_cmd_sferase},
115 {"SFPG", "<Hex addr> <Hex len> <Hex buf>, SPI Flash program", db_cmd_sfpg},
116 {"SFRU", "f/r <Hex addr> <Hex addr>, SPI Flash fast read/read to UART", db_cmd_sfru},
117 {"SFRM", "f/r <Hex addr> <Hex addr>, SPI Flash fast read/read to Memory 0x520000", db_cmd_sfrm},
118 {"SFRDSR", ", SPI Flash status register read", db_cmd_sfrdsr},
120 #endif /* #if defined(PROJECT_K2) */
121 {"MEMCMP", "<Hex addr> <Hex addr> <Hex len>, memory comparison", db_cmd_memcmp},
122 {"MEMDMP", "<Hex addr> <Hex addr>, memory dump", db_cmd_memdump},
124 /* {Command, Help description, function} */
127 char cmd_buffer[COMMAND_BUFFER_SIZE][DB_MAX_COMMAND_LENGTH]; /* Backup previous command */
130 char raw_cmd[DB_MAX_COMMAND_LENGTH];
131 char cmd_str[DB_MAX_COMMAND_LENGTH*4];
136 //////////////////////////////////////////////////
137 #define MAX_REG_NUM 16
139 typedef struct reg_elem {
141 unsigned char mode; // byte, half-word word
142 unsigned long reg_addr;
145 t_reg_elem reg_buffer[MAX_REG_NUM];
147 //////////////////////////////////////////////////
149 void zfDebugInit(void)
154 while ((zm_get_char(&ch)) != 0)
159 cmd_buf_full = FALSE;
164 void zfDebugTask(void)
169 if ((zm_get_char(&ch)) == 0)
174 if (db_get_cmd_line(ch, raw_cmd, &gvLen) == 0)
179 if (db_formalize_command(raw_cmd, cmd_str))
184 cmd_not_found = TRUE;
185 while(command_table[i].cmd_func)
187 if (!strcmp(command_table[i].cmd_str, cmd_str))
189 cmd_not_found = FALSE;
190 command_table[i].cmd_func(cmd_str,
191 cmd_str+DB_MAX_COMMAND_LENGTH,
192 cmd_str+DB_MAX_COMMAND_LENGTH*2,
193 cmd_str+DB_MAX_COMMAND_LENGTH*3);
200 A_PRINTF("Error, HELP for command list.\n\r");
209 uint16_t db_get_cmd_line(uint8_t ch, char *cmd_line, uint16_t* i)
215 case '\\' : /* Last command */
217 if (pressed_time >= COMMAND_BUFFER_SIZE)
221 cmd_buf_loc = cmd_buf_ptr - pressed_time;
224 if (cmd_buf_full == TRUE)
226 cmd_buf_loc += COMMAND_BUFFER_SIZE;
234 if (A_STRLEN(cmd_buffer[cmd_buf_loc]) != 0)
236 A_STRCPY(cmd_line, cmd_buffer[cmd_buf_loc]);
237 *i = A_STRLEN(cmd_buffer[cmd_buf_loc]);
239 A_PRINTF("%s", cmd_line);
242 case 13 : /* Return */
248 //Filter duplicated string in command history
249 if (strcmp(cmd_buffer[(cmd_buf_ptr==0)?(COMMAND_BUFFER_SIZE-1):(cmd_buf_ptr-1)], cmd_line) != 0)
251 A_STRCPY(cmd_buffer[cmd_buf_ptr++], cmd_line);
254 if (cmd_buf_ptr >= COMMAND_BUFFER_SIZE)
260 case '\b' : /* Backspace */
271 if ((ch >= ' ') && (ch <= '~'))
274 if (*i < DB_MAX_COMMAND_LENGTH-2)
276 if ((ch >= 0x11) && (ch <= 0x7e))
278 //if ((buf <= 'z') && (buf >= 'a'))
294 } /* end of switch */
300 int db_formalize_command(char* raw_str, char* cmd_str)
309 /* Remove preceeding spaces */
310 while (raw_str[i++] == ' '){}
313 /* Copy command string */
315 while(raw_str[i] && (raw_str[i] != ' '))
319 if ((raw_str[i] <= 'z') && (raw_str[i] >= 'a'))
321 raw_str[i] -= 'a' - 'A';
323 cmd_str[k*DB_MAX_COMMAND_LENGTH + j++] = raw_str[i++];
327 cmd_str[k*DB_MAX_COMMAND_LENGTH + j++] = raw_str[i++];
330 cmd_str[k*DB_MAX_COMMAND_LENGTH + j] = 0;
332 return (int)A_STRLEN(cmd_str);
335 int db_ascii_to_hex(char* num_str, unsigned long* hex_num)
342 if ((num_str[i] >= '0') && (num_str[i] <= '9'))
345 *hex_num += (num_str[i] - '0');
347 else if ((num_str[i] >= 'A') && (num_str[i] <= 'F'))
350 *hex_num += (num_str[i] - 'A' + 10);
352 else if ((num_str[i] >= 'a') && (num_str[i] <= 'f'))
355 *hex_num += (num_str[i] - 'a' + 10);
366 int db_ascii_to_int(char* num_str, unsigned long* int_num)
373 if ((num_str[i] >= '0') && (num_str[i] <= '9'))
376 *int_num += (num_str[i] - '0');
387 int db_hex_to_ascii(unsigned long hex_num, char* num_str)
390 unsigned long four_bits;
394 four_bits = (hex_num >> i*4) & 0xf;
397 num_str[7-i] = four_bits + '0';
401 num_str[7-i] = four_bits - 10 + 'A';
408 int db_help_cmd(char* cmd, char* param1, char* param2, char* param3)
414 A_PRINTF("%s %s\n", ATH_DEBUGGER_VERSION_STR, ATH_COMMAND_LIST_STR);
416 while (command_table[i].cmd_func)
418 A_PRINTF("%s\t%s\n\r", command_table[i].cmd_str,
419 command_table[i].help_str);
425 int db_ldr_cmd(char* cmd, char* param1, char* param2, char* param3)
432 if (db_ascii_to_hex(param1, &addr) != -1)
436 A_PRINTF("Error! bad address 0x%08x.\n\r",
437 (unsigned long)addr);
440 if (strcmp(cmd, "LDR") == 0)
443 //val = *(unsigned long *)addr;
445 val = HAL_WORD_REG_READ(addr);
447 else if (strcmp(cmd, "LDRH") == 0)
450 val = HAL_HALF_WORD_REG_READ(addr);
452 else if (strcmp(cmd, "LDRB") == 0)
456 db_hex_to_ascii(val, val_str);
457 db_hex_to_ascii(addr, addr_str);
459 A_PRINTF("%s : %s\n\r", addr_str, val_str);
464 A_PRINTF("Error! Incorrect format.\n\r");
470 int db_str_cmd(char* cmd, char* param1, char* param2, char* param3)
477 if ((A_STRLEN(param2) > 0) &&
478 (db_ascii_to_hex(param1, &addr) != -1) &&
479 (db_ascii_to_hex(param2, &val) != -1))
481 if (strcmp(cmd, "STR") == 0)
484 //HAL_WORD_REG_WRITE(addr, val);
485 HAL_WORD_REG_WRITE(addr, val);
486 //*(volatile unsigned long *)(addr & 0xfffffffc) = (unsigned long)val;
489 else if (strcmp(cmd, "STRH") == 0)
492 //*(volatile unsigned short *)(addr & 0xfffffffe) = (unsigned short)val;
493 HAL_HALF_WORD_REG_WRITE(addr, val);
495 else if (strcmp(cmd, "STRB") == 0)
497 if( addr & 0x00f00000 )
498 HAL_BYTE_REG_WRITE(addr, val);
500 HAL_BYTE_REG_WRITE(addr^3, val);
501 //*(volatile unsigned char *)addr = (unsigned char)val;
504 db_hex_to_ascii(val, val_str);
505 db_hex_to_ascii(addr, addr_str);
507 A_PRINTF("%s : %s\n\r", addr_str, val_str);
512 A_PRINTF("Error! Incorrect format.\n\r");
518 // macro extension the address to dump the memory
519 #define FOUR_BYTE_HEX_DUMP(addr) (" %02x %02x %02x %02x", \
520 *(uint8_t*)((addr)+3), *(uint8_t*)((addr)+2), \
521 *(uint8_t*)((addr)+1), *(uint8_t*)((addr)))
524 int db_dump_memory(char* cmd, char* param1, char* param2, char* param3)
527 unsigned long length;
528 unsigned long ptrAddr;
531 if (db_ascii_to_hex(param1, &addr) != -1 &&
532 (db_ascii_to_int(param2, &length) != -1))
534 // if no length, default is 128 bytes to dump
539 A_PRINTF("length: %d\n\r", length);
541 A_PRINTF(" 15 14 13 12 11 10 09 08 07 06 05 04 03 02 01 00\n\r");
542 A_PRINTF("------------------------------------------------------------\n\r");
543 for (i=0; i<length/16; i++)
545 //zfUartSendHex((unsigned long)addr);
546 A_PRINTF("%08x: ", (unsigned long)addr);
548 ptrAddr = (unsigned long *)addr;
550 // dump from MSB to LSB
551 A_PRINTF FOUR_BYTE_HEX_DUMP(ptrAddr+12);
552 A_PRINTF FOUR_BYTE_HEX_DUMP(ptrAddr+8);
554 A_PRINTF FOUR_BYTE_HEX_DUMP(ptrAddr+4);
555 A_PRINTF FOUR_BYTE_HEX_DUMP(ptrAddr);
560 // the rest of the byte to dump
561 if( (length %16)!=0 )
563 A_PRINTF("%08x: ", (unsigned long)addr);
565 // make the space, since we dump MSB first
566 for(i=0; i<(16-(length %16)); i++)
569 // if less than 8 bytes, add 2 more space for " -"
570 if( (length%16) < 8 )
573 for(i=0; i<length%16; i++)
576 A_PRINTF(" %02x", *(uint8_t*)((addr+(length%16)-1)-i));
578 if((16-(length%16))+i==7)
588 LOCAL void dbg_timer_func(A_HANDLE alarm, void *data)
590 A_PRINTF("this is a timer alarm function 0x%08x\n\r", xthal_get_ccount());
593 int db_patch_cmd(char* cmd, char* param1, char* param2, char* param3)
601 int db_intr_cmd(char* cmd, char* param1, char* param2, char* param3)
603 #if SYSTEM_MODULE_INTR
604 uint32_t pending_intrs;
606 if(strcmp(param1, "read") == 0 )
609 /* Update snapshot of pending interrupts */
611 pending_intrs = A_INTR_GET_INTRPENDING();
613 A_PRINTF("intr mask [0x%08x]\n\r", xthal_get_intenable());
614 A_PRINTF("intr on [0x%08x]\n\r", pending_intrs);
617 else if (strcmp(param1, "timer") == 0 )
621 if (strcmp(param2, "on") == 0 )
623 /* TODO: this part is probably dead. */
624 pending_intrs = A_INTR_GET_INTRENABLE()|CMNOS_IMASK_XTTIMER;
625 A_INTR_SET_INTRENABLE(pending_intrs);
626 A_PRINTF("- intr [0x%08x]\n\r", pending_intrs);
628 else if ( strcmp(param2, "off") == 0 )
630 pending_intrs = A_INTR_GET_INTRENABLE()&(~CMNOS_IMASK_XTTIMER);
631 A_INTR_SET_INTRENABLE(pending_intrs);
632 A_PRINTF("- intr [0x%08x]\n\r", pending_intrs);
635 else if( db_ascii_to_hex(param2, &data)==0 )
637 if( data>=0 && data <=10 )
642 A_PRINTF("==>set cb to %d seconds \n\r", delay);
648 A_PRINTF("\tintr read - read the interrenable status\n\r");
649 A_PRINTF("\tintr timer on/off/tick - timer attach on/off/ticks\n\r");
653 #endif //#if SYSTEM_MODULE_INTR
657 uint32_t usb_swap_flag = 0; //default
658 uint32_t usb_swap_flag_changed = 0;
659 int db_usb_cmd(char* cmd, char* param1, char* param2, char* param3)
661 A_PRINTF("THIS IS USB COMMAND\n\r");
663 if( strcmp(param1, "que") == 0 )
665 HIFusb_DescTraceDump();
669 A_PRINTF("\tusb que - dump descriptor queue\n\r");
670 A_PRINTF("\tusb fw on/off - enable/disable write fw download to ram\n\r");
676 static void clk_change(uint32_t clk, uint32_t ratio, uint32_t baud)
678 uint32_t clk_sel = 0;
701 HAL_WORD_REG_WRITE(0x50040, (0x300|clk_sel|(ratio>>1)<<12));
702 A_UART_HWINIT((clk*1000*1000)/ratio, baud);
706 int db_clock_cmd(char* cmd, char* param1, char* param2, char* param3)
709 uint32_t baud = 19200;
712 if( db_ascii_to_int(param1, &clk) != -1 )
714 A_PRINTF("changing clock to %d\n", clk);
715 clk_change(clk, ratio, baud);
719 int db_info_cmd(char* cmd, char* param1, char* param2, char* param3)
723 if(strcmp(param1, "ram") == 0 )
727 #if 0 /* TODO: SYSTEM_MODULE_SYS_MONITOR depends on _ROM_ or _RAM_ which
729 else if(strcmp(param1, "cpu") == 0)
730 zfPrintCpuUtilization();
733 HIFusb_DescTraceDump();
744 register uint32_t data1;
745 if( db_ascii_to_hex(param1, &data1)==0 )
747 __asm__ __volatile__ (
749 : "=a" (ccount1) : : "memory"
751 data = *(volatile uint32_t *)(data1);
752 __asm__ __volatile__ (
754 : "=a" (ccount2) : : "memory"
756 A_PRINTF("\n\rread 0x%08x (0x%08x) use %d clocks\n\r", data1, data, ccount2-ccount1);
759 __asm__ __volatile__ (
761 : "=a" (ccount1) : : "memory"
763 data = *(volatile uint32_t *)(data1);
764 __asm__ __volatile__ (
766 : "=a" (ccount2) : : "memory"
768 A_PRINTF("\n\rread 0x%08x (0x%08x) use %d clocks\n\r", data1, data, ccount2-ccount1);
771 __asm__ __volatile__ (
773 : "=a" (ccount1) : : "memory"
775 data = *(volatile uint32_t *)(data2);
776 __asm__ __volatile__ (
778 : "=a" (ccount2) : : "memory"
780 A_PRINTF("read 0x%08x (0x%08x) use %d clocks\n\r", data2, data, ccount2-ccount1);
783 __asm__ __volatile__ (
785 : "=a" (ccount1) : : "memory"
787 data = *(volatile uint32_t *)(data3);
788 __asm__ __volatile__ (
790 : "=a" (ccount2) : : "memory"
792 A_PRINTF("read 0x%08x (0x%08x) use %d clocks\n\r", data3, data, ccount2-ccount1);
799 int db_cmd_dbg(char* cmd, char* param1, char* param2, char* param3)
803 int db_cmd_dmips(char* cmd, char* param1, char* param2, char* param3)
808 int db_cmd_starthtc(char* cmd, char* param1, char* param2, char* param3)
810 extern htc_handle_t htc_handle;
811 HTC_Ready(htc_handle);
814 int db_cmd_memtest(char* cmd, char* param1, char* param2, char* param3)
823 #define WRITE_USB_DESC(pDesc, Offset) \
825 uint16_t *pSrc = 0; \
826 uint16_t mSize = 0; \
827 pSrc = (uint16_t *)(pDesc); \
828 mSize = (*pSrc&0xff)/2; \
829 A_PRINTF("0x%04x, 0x%04x, 0x%08x\n", Offset, mSize, pSrc); \
830 A_EEP_WRITE(Offset, mSize, pSrc); \
831 A_DELAY_USECS(500); \
834 #define READ_USB_DESC(pDesc, Offset, Size) \
838 pDst = (uint16_t *)pDesc; \
839 A_EEP_READ(Offset, 1, &mSize); \
840 mSize = mSize &0xff; \
844 A_PRINTF("0x%04x, 0x%04x, 0x%08x\n", Offset, mSize, pDst); \
845 A_EEP_READ(Offset, mSize, pDst); \
846 A_DELAY_USECS(500); \
850 ////////////////////////////////////////////////////////////////////////////////////////////////
852 extern uint16_t UsbDeviceDescriptor[];
853 extern uint16_t String00Descriptor[];
854 extern uint16_t String10Descriptor[];
855 extern uint16_t String20Descriptor[];
856 extern uint16_t String30Descriptor[];
858 int db_eeprom_cmd(char* cmd, char* param1, char* param2, char* param3)
863 int db_wdt_cmd(char* cmd, char* param1, char* param2, char* param3)
865 if ( strcmp(param1, "rst") == 0 )
867 A_PRINTF(" reseting.....................\n\n\r");
870 else if( strcmp(param1, "on") == 0 )
874 else if (strcmp(param1, "off") == 0 )
878 else if ( strcmp(param1, "boot") == 0 )
880 if (ENUM_WDT_BOOT == A_WDT_LASTBOOT() )
881 A_PRINTF("LAST BOOT IS %s", "wdt");
883 A_PRINTF("LAST BOOT IS %s", "normal boot");
885 else if (strcmp(param1, "loop") == 0 )
888 uint32_t time_offset;
889 A_PRINTF(" doing the wdt reseting................\n\n\r");
891 if( db_ascii_to_hex(param2, &time_offset)!=0 )
893 if( time_offset < 0 || time_offset >0xffffffff )
894 time_offset = 0xffffff;
896 A_PRINTF(" doing the wdt reseting (wdt tick: 0x%08x................\n\n\r", time_offset);
897 wdt_cmd.cmd = WDT_TIMEOUT;
898 wdt_cmd.timeout = time_offset;
903 else if (strcmp(param1, "noloop") == 0 )
906 uint32_t time_offset;
907 A_PRINTF(" doing the wdt reseting................\n\n\r");
909 if( db_ascii_to_hex(param3, &time_offset)!=0 )
911 if( time_offset < 0 || time_offset >0xffffffff )
912 time_offset = 0xffffff;
914 A_PRINTF(" doing the wdt reseting (wdt tick: 0x%08x................\n\n\r", time_offset);
916 wdt_cmd.cmd = WDT_TIMEOUT;
917 wdt_cmd.timeout = time_offset;
921 else if( strcmp(param1, "event") == 0 )
923 uint32_t event= 0x00123400;
924 #define USB_BYTE_REG_WRITE(addr, val) HAL_BYTE_REG_WRITE(USB_CTRL_BASE_ADDRESS|(uint8_t)(addr^3), (val))
925 #define USB_BYTE_REG_READ(addr) HAL_BYTE_REG_READ(USB_CTRL_BASE_ADDRESS|(uint8_t)(addr^3))
927 #define USB_WORD_REG_WRITE(addr, val) HAL_WORD_REG_WRITE(USB_CTRL_BASE_ADDRESS|(uint32_t)(addr), (val))
928 #define USB_WORD_REG_READ(addr) HAL_WORD_REG_READ(USB_CTRL_BASE_ADDRESS|(uint32_t)(addr))
931 USB_BYTE_REG_WRITE(0x17, USB_BYTE_REG_READ(0x17)|0xc0);
933 //ZM_CBUS_FIFO_SIZE_REG = 0xf;
934 USB_WORD_REG_WRITE(0x100, 0x0f);
936 //ZM_EP3_DATA_REG = event;
937 USB_WORD_REG_WRITE(0xF8, event);
940 USB_BYTE_REG_WRITE(0xAE, USB_BYTE_REG_READ(0xAE)|0x08);
943 USB_BYTE_REG_WRITE(0x17, USB_BYTE_REG_READ(0x17)&0xbf);
947 #if defined(PROJECT_K2)
948 #if SYSTEM_MODULE_SFLASH
949 /* Serial Flash -> Chip Erase, Sector Erase, Block Erase */
950 int db_cmd_sferase(char* cmd, char* param1, char* param2, char* param3)
954 if (strcmp(param1, "s") == 0)
956 if (db_ascii_to_hex(param2, &addr) != -1 && addr < SPI_FLASH_MAX_SIZE)
958 /* Sector size is 4K (0x1000) */
959 A_PRINTF("Sector addr : 0x%08X\n\r", addr - addr%0x1000);
960 A_SFLASH_ERASE(ZM_SFLASH_SECTOR_ERASE, addr);
966 A_PRINTF("Error! Incorrect format.\n\r");
970 else if (strcmp(param2, "b") == 0)
972 if (db_ascii_to_hex(param2, &addr) != -1 && addr < SPI_FLASH_MAX_SIZE)
974 /* Sector size is 64K (0x10000) */
975 A_PRINTF("Block addr : 0x%08X\n\r", addr - addr%0x10000);
976 A_SFLASH_ERASE(ZM_SFLASH_BLOCK_ERASE, addr);
982 A_PRINTF("Error! Incorrect format.\n\r");
986 else if (strcmp(param1, "c") == 0)
988 A_SFLASH_ERASE(ZM_SFLASH_CHIP_ERASE, addr);
995 A_PRINTF("Error! Unknown command.\n\r");
1000 /* Serial Flash -> Program */
1001 int db_cmd_sfpg(char* cmd, char* param1, char* param2, char* param3)
1003 unsigned long addr, len, buf;
1005 if (db_ascii_to_hex(param1, &addr) != -1 &&
1006 db_ascii_to_hex(param2, &len) != -1 &&
1007 db_ascii_to_hex(param3, &buf) != -1 &&
1008 ((addr+len) <= SPI_FLASH_MAX_SIZE) &&
1009 addr%4 == 0 && len%4 == 0 && buf%4 == 0 &&
1010 ((buf >=0x500000 && buf < 0x528000) || (buf >=0x4e0000 && buf < 0x4e6000)) )
1012 A_SFLASH_PROG(addr, len, (A_UINT8 *)buf);
1019 A_PRINTF("Error! Incorrect format.\n\r");
1024 /* Serial Flash -> Read, Fast Read to UART */
1025 int db_cmd_sfru(char* cmd, char* param1, char* param2, char* param3)
1028 unsigned long addr1, addr2, t_addr;
1031 if (strcmp(param1, "r") == 0)
1033 else if (strcmp(param1, "f") == 0)
1037 A_PRINTF("Error! Unknown command.\n\r");
1041 if (db_ascii_to_hex(param2, &addr1) != -1 &&
1042 db_ascii_to_hex(param3, &addr2) != -1 &&
1043 addr1 < addr2 && addr1 < SPI_FLASH_MAX_SIZE &&
1044 addr2 < SPI_FLASH_MAX_SIZE && addr1%4 == 0)
1046 A_PRINTF("addr data data data data data data data data\n\r");
1047 A_PRINTF("====== ======== ======== ======== ======== ======== ======== ======== ========");
1049 for (i = 0, t_addr = addr1; t_addr < addr2; i++, t_addr += 4)
1052 A_PRINTF("\n\r%06X ", t_addr);
1054 A_SFLASH_READ(fast, t_addr, 4, (A_UINT8 *)&val);
1055 A_PRINTF("%08X ", val);
1063 A_PRINTF("Error! Incorrect format.\n\r");
1068 /* Serial Flash -> Read, Fast Read to Memory */
1069 int db_cmd_sfrm(char* cmd, char* param1, char* param2, char* param3)
1072 unsigned long addr1, addr2, t_addr;
1074 A_UINT8 *buf = (A_UINT8 *)0x520000;
1076 if (strcmp(param1, "r") == 0)
1078 else if (strcmp(param1, "f") == 0)
1082 A_PRINTF("Error! Unknown command.\n\r");
1086 if (db_ascii_to_hex(param2, &addr1) != -1 &&
1087 db_ascii_to_hex(param3, &addr2) != -1 &&
1088 addr1 < addr2 && addr1 < SPI_FLASH_MAX_SIZE &&
1089 addr2 < SPI_FLASH_MAX_SIZE && addr1%4 == 0)
1091 for (i = 0, t_addr = addr1; t_addr < addr2; i++, t_addr += 4)
1093 A_SFLASH_READ(fast, t_addr, 4, buf + i*4);
1101 A_PRINTF("Error! Incorrect format.\n\r");
1106 /* Serial Flash -> Read Status Register */
1107 int db_cmd_sfrdsr(char* cmd, char* param1, char* param2, char* param3)
1109 A_PRINTF("0x%02X\n\r", A_SFLASH_RDSR());
1113 #endif /* #if defined(PROJECT_K2) */
1115 /* Memory Comparison */
1116 int db_cmd_memcmp(char* cmd, char* param1, char* param2, char* param3)
1118 unsigned long addr1, addr2, len;
1119 A_UINT8 *buf1, *buf2;
1121 if (db_ascii_to_hex(param1, &addr1) != -1 &&
1122 db_ascii_to_hex(param2, &addr2) != -1 &&
1123 db_ascii_to_hex(param3, &len) != -1 &&
1124 addr1 != addr2 && addr1%4 == 0 && addr2%4 == 0 && len%4 == 0)
1126 buf1 = (A_UINT8 *)addr1;
1127 buf2 = (A_UINT8 *)addr2; ;
1129 A_PRINTF("memcmp(buf1, buf2, len) = %d\n\r", A_MEMCMP(buf1, buf2, len));
1134 A_PRINTF("Error! Incorrect format.\n\r");
1140 int db_cmd_memdump(char* cmd, char* param1, char* param2, char* param3)
1143 unsigned long addr1, addr2, t_addr;
1146 if (db_ascii_to_hex(param1, &addr1) != -1 && db_ascii_to_hex(param2, &addr2) != -1 && addr1 < addr2 && addr1%4 == 0)
1148 A_PRINTF("addr data data data data data data data data\n\r");
1149 A_PRINTF("====== ======== ======== ======== ======== ======== ======== ======== ========");
1151 for (i = 0, t_addr = addr1; t_addr < addr2; i++, t_addr += 4)
1154 A_PRINTF("\n\r%06X ", t_addr);
1156 val = (A_UINT32 *)t_addr;
1157 A_PRINTF("%08X ", *val);
1165 A_PRINTF("Error! Incorrect format.\n\r");
1169 void cmnos_dbg_module_install(struct dbg_api *apis)
1171 apis->_dbg_init = zfDebugInit;
1172 apis->_dbg_task = zfDebugTask;
1175 #endif /* SYSTEM_MODULE_DBG */