| /* |
| * BedBug Functions |
| */ |
| |
| #include <common.h> |
| #include <command.h> |
| #include <linux/ctype.h> |
| #include <net.h> |
| #include <bedbug/type.h> |
| #include <bedbug/bedbug.h> |
| #include <bedbug/regs.h> |
| #include <bedbug/ppc.h> |
| |
| DECLARE_GLOBAL_DATA_PTR; |
| |
| #ifndef MAX |
| #define MAX(a,b) ((a) > (b) ? (a) : (b)) |
| #endif |
| |
| extern void show_regs __P ((struct pt_regs *)); |
| extern int run_command __P ((const char *, int)); |
| extern char console_buffer[]; |
| |
| ulong dis_last_addr = 0; /* Last address disassembled */ |
| ulong dis_last_len = 20; /* Default disassembler length */ |
| CPU_DEBUG_CTX bug_ctx; /* Bedbug context structure */ |
| |
| |
| /* ====================================================================== |
| * U-Boot's puts function does not append a newline, so the bedbug stuff |
| * will use this for the output of the dis/assembler. |
| * ====================================================================== */ |
| |
| int bedbug_puts (const char *str) |
| { |
| /* -------------------------------------------------- */ |
| |
| printf ("%s\r\n", str); |
| return 0; |
| } /* bedbug_puts */ |
| |
| |
| |
| /* ====================================================================== |
| * Initialize the bug_ctx structure used by the bedbug debugger. This is |
| * specific to the CPU since each has different debug registers and |
| * settings. |
| * ====================================================================== */ |
| |
| void bedbug_init (void) |
| { |
| /* -------------------------------------------------- */ |
| |
| #if defined(CONFIG_4xx) |
| void bedbug405_init (void); |
| |
| bedbug405_init (); |
| #elif defined(CONFIG_8xx) |
| void bedbug860_init (void); |
| |
| bedbug860_init (); |
| #endif |
| |
| #if defined(CONFIG_MPC824X) || defined(CONFIG_MPC8260) |
| /* Processors that are 603e core based */ |
| void bedbug603e_init (void); |
| |
| bedbug603e_init (); |
| #endif |
| |
| return; |
| } /* bedbug_init */ |
| |
| |
| |
| /* ====================================================================== |
| * Entry point from the interpreter to the disassembler. Repeated calls |
| * will resume from the last disassembled address. |
| * ====================================================================== */ |
| int do_bedbug_dis (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[]) |
| { |
| ulong addr; /* Address to start disassembly from */ |
| ulong len; /* # of instructions to disassemble */ |
| |
| /* -------------------------------------------------- */ |
| |
| /* Setup to go from the last address if none is given */ |
| addr = dis_last_addr; |
| len = dis_last_len; |
| |
| if (argc < 2) { |
| printf ("Usage:\n%s\n", cmdtp->usage); |
| return 1; |
| } |
| |
| if ((flag & CMD_FLAG_REPEAT) == 0) { |
| /* New command */ |
| addr = simple_strtoul (argv[1], NULL, 16); |
| |
| /* If an extra param is given then it is the length */ |
| if (argc > 2) |
| len = simple_strtoul (argv[2], NULL, 16); |
| } |
| |
| /* Run the disassembler */ |
| disppc ((unsigned char *) addr, 0, len, bedbug_puts, F_RADHEX); |
| |
| dis_last_addr = addr + (len * 4); |
| dis_last_len = len; |
| return 0; |
| } /* do_bedbug_dis */ |
| |
| U_BOOT_CMD (ds, 3, 1, do_bedbug_dis, |
| "ds - disassemble memory\n", |
| "ds <address> [# instructions]\n"); |
| |
| /* ====================================================================== |
| * Entry point from the interpreter to the assembler. Assembles |
| * instructions in consecutive memory locations until a '.' (period) is |
| * entered on a line by itself. |
| * ====================================================================== */ |
| int do_bedbug_asm (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[]) |
| { |
| long mem_addr; /* Address to assemble into */ |
| unsigned long instr; /* Machine code for text */ |
| char prompt[15]; /* Prompt string for user input */ |
| int asm_err; /* Error code from the assembler */ |
| |
| /* -------------------------------------------------- */ |
| int rcode = 0; |
| |
| if (argc < 2) { |
| printf ("Usage:\n%s\n", cmdtp->usage); |
| return 1; |
| } |
| |
| printf ("\nEnter '.' when done\n"); |
| mem_addr = simple_strtoul (argv[1], NULL, 16); |
| |
| while (1) { |
| putc ('\n'); |
| disppc ((unsigned char *) mem_addr, 0, 1, bedbug_puts, |
| F_RADHEX); |
| |
| sprintf (prompt, "%08lx: ", mem_addr); |
| readline (prompt); |
| |
| if (console_buffer[0] && strcmp (console_buffer, ".")) { |
| if ((instr = |
| asmppc (mem_addr, console_buffer, |
| &asm_err)) != 0) { |
| *(unsigned long *) mem_addr = instr; |
| mem_addr += 4; |
| } else { |
| printf ("*** Error: %s ***\n", |
| asm_error_str (asm_err)); |
| rcode = 1; |
| } |
| } else { |
| break; |
| } |
| } |
| return rcode; |
| } /* do_bedbug_asm */ |
| |
| U_BOOT_CMD (as, 2, 0, do_bedbug_asm, |
| "as - assemble memory\n", "as <address>\n"); |
| |
| /* ====================================================================== |
| * Used to set a break point from the interpreter. Simply calls into the |
| * CPU-specific break point set routine. |
| * ====================================================================== */ |
| |
| int do_bedbug_break (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[]) |
| { |
| /* -------------------------------------------------- */ |
| if (bug_ctx.do_break) |
| (*bug_ctx.do_break) (cmdtp, flag, argc, argv); |
| return 0; |
| |
| } /* do_bedbug_break */ |
| |
| U_BOOT_CMD (break, 3, 0, do_bedbug_break, |
| "break - set or clear a breakpoint\n", |
| " - Set or clear a breakpoint\n" |
| "break <address> - Break at an address\n" |
| "break off <bp#> - Disable breakpoint.\n" |
| "break show - List breakpoints.\n"); |
| |
| /* ====================================================================== |
| * Called from the debug interrupt routine. Simply calls the CPU-specific |
| * breakpoint handling routine. |
| * ====================================================================== */ |
| |
| void do_bedbug_breakpoint (struct pt_regs *regs) |
| { |
| /* -------------------------------------------------- */ |
| |
| if (bug_ctx.break_isr) |
| (*bug_ctx.break_isr) (regs); |
| |
| return; |
| } /* do_bedbug_breakpoint */ |
| |
| |
| |
| /* ====================================================================== |
| * Called from the CPU-specific breakpoint handling routine. Enter a |
| * mini main loop until the stopped flag is cleared from the breakpoint |
| * context. |
| * |
| * This handles the parts of the debugger that are common to all CPU's. |
| * ====================================================================== */ |
| |
| void bedbug_main_loop (unsigned long addr, struct pt_regs *regs) |
| { |
| int len; /* Length of command line */ |
| int flag; /* Command flags */ |
| int rc = 0; /* Result from run_command */ |
| char prompt_str[20]; /* Prompt string */ |
| static char lastcommand[CONFIG_SYS_CBSIZE] = { 0 }; /* previous command */ |
| /* -------------------------------------------------- */ |
| |
| if (bug_ctx.clear) |
| (*bug_ctx.clear) (bug_ctx.current_bp); |
| |
| printf ("Breakpoint %d: ", bug_ctx.current_bp); |
| disppc ((unsigned char *) addr, 0, 1, bedbug_puts, F_RADHEX); |
| |
| bug_ctx.stopped = 1; |
| bug_ctx.regs = regs; |
| |
| sprintf (prompt_str, "BEDBUG.%d =>", bug_ctx.current_bp); |
| |
| /* A miniature main loop */ |
| while (bug_ctx.stopped) { |
| len = readline (prompt_str); |
| |
| flag = 0; /* assume no special flags for now */ |
| |
| if (len > 0) |
| strcpy (lastcommand, console_buffer); |
| else if (len == 0) |
| flag |= CMD_FLAG_REPEAT; |
| |
| if (len == -1) |
| printf ("<INTERRUPT>\n"); |
| else |
| rc = run_command (lastcommand, flag); |
| |
| if (rc <= 0) { |
| /* invalid command or not repeatable, forget it */ |
| lastcommand[0] = 0; |
| } |
| } |
| |
| bug_ctx.regs = NULL; |
| bug_ctx.current_bp = 0; |
| |
| return; |
| } /* bedbug_main_loop */ |
| |
| |
| |
| /* ====================================================================== |
| * Interpreter command to continue from a breakpoint. Just clears the |
| * stopped flag in the context so that the breakpoint routine will |
| * return. |
| * ====================================================================== */ |
| int do_bedbug_continue (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[]) |
| { |
| /* -------------------------------------------------- */ |
| |
| if (!bug_ctx.stopped) { |
| printf ("Not at a breakpoint\n"); |
| return 1; |
| } |
| |
| bug_ctx.stopped = 0; |
| return 0; |
| } /* do_bedbug_continue */ |
| |
| U_BOOT_CMD (continue, 1, 0, do_bedbug_continue, |
| "continue- continue from a breakpoint\n", |
| " - continue from a breakpoint.\n"); |
| |
| /* ====================================================================== |
| * Interpreter command to continue to the next instruction, stepping into |
| * subroutines. Works by calling the find_next_addr() routine to compute |
| * the address passes control to the CPU-specific set breakpoint routine |
| * for the current breakpoint number. |
| * ====================================================================== */ |
| int do_bedbug_step (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[]) |
| { |
| unsigned long addr; /* Address to stop at */ |
| |
| /* -------------------------------------------------- */ |
| |
| if (!bug_ctx.stopped) { |
| printf ("Not at a breakpoint\n"); |
| return 1; |
| } |
| |
| if (!find_next_address ((unsigned char *) &addr, FALSE, bug_ctx.regs)) |
| return 1; |
| |
| if (bug_ctx.set) |
| (*bug_ctx.set) (bug_ctx.current_bp, addr); |
| |
| bug_ctx.stopped = 0; |
| return 0; |
| } /* do_bedbug_step */ |
| |
| U_BOOT_CMD (step, 1, 1, do_bedbug_step, |
| "step - single step execution.\n", |
| " - single step execution.\n"); |
| |
| /* ====================================================================== |
| * Interpreter command to continue to the next instruction, stepping over |
| * subroutines. Works by calling the find_next_addr() routine to compute |
| * the address passes control to the CPU-specific set breakpoint routine |
| * for the current breakpoint number. |
| * ====================================================================== */ |
| int do_bedbug_next (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[]) |
| { |
| unsigned long addr; /* Address to stop at */ |
| |
| /* -------------------------------------------------- */ |
| |
| if (!bug_ctx.stopped) { |
| printf ("Not at a breakpoint\n"); |
| return 1; |
| } |
| |
| if (!find_next_address ((unsigned char *) &addr, TRUE, bug_ctx.regs)) |
| return 1; |
| |
| if (bug_ctx.set) |
| (*bug_ctx.set) (bug_ctx.current_bp, addr); |
| |
| bug_ctx.stopped = 0; |
| return 0; |
| } /* do_bedbug_next */ |
| |
| U_BOOT_CMD (next, 1, 1, do_bedbug_next, |
| "next - single step execution, stepping over subroutines.\n", |
| " - single step execution, stepping over subroutines.\n"); |
| |
| /* ====================================================================== |
| * Interpreter command to print the current stack. This assumes an EABI |
| * architecture, so it starts with GPR R1 and works back up the stack. |
| * ====================================================================== */ |
| int do_bedbug_stack (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[]) |
| { |
| unsigned long sp; /* Stack pointer */ |
| unsigned long func; /* LR from stack */ |
| int depth; /* Stack iteration level */ |
| int skip = 1; /* Flag to skip the first entry */ |
| unsigned long top; /* Top of memory address */ |
| |
| /* -------------------------------------------------- */ |
| |
| if (!bug_ctx.stopped) { |
| printf ("Not at a breakpoint\n"); |
| return 1; |
| } |
| |
| top = gd->bd->bi_memstart + gd->bd->bi_memsize; |
| depth = 0; |
| |
| printf ("Depth PC\n"); |
| printf ("----- --------\n"); |
| printf ("%5d %08lx\n", depth++, bug_ctx.regs->nip); |
| |
| sp = bug_ctx.regs->gpr[1]; |
| func = *(unsigned long *) (sp + 4); |
| |
| while ((func < top) && (sp < top)) { |
| if (!skip) |
| printf ("%5d %08lx\n", depth++, func); |
| else |
| --skip; |
| |
| sp = *(unsigned long *) sp; |
| func = *(unsigned long *) (sp + 4); |
| } |
| return 0; |
| } /* do_bedbug_stack */ |
| |
| U_BOOT_CMD (where, 1, 1, do_bedbug_stack, |
| "where - Print the running stack.\n", |
| " - Print the running stack.\n"); |
| |
| /* ====================================================================== |
| * Interpreter command to dump the registers. Calls the CPU-specific |
| * show registers routine. |
| * ====================================================================== */ |
| int do_bedbug_rdump (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[]) |
| { |
| /* -------------------------------------------------- */ |
| |
| if (!bug_ctx.stopped) { |
| printf ("Not at a breakpoint\n"); |
| return 1; |
| } |
| |
| show_regs (bug_ctx.regs); |
| return 0; |
| } /* do_bedbug_rdump */ |
| |
| U_BOOT_CMD (rdump, 1, 1, do_bedbug_rdump, |
| "rdump - Show registers.\n", " - Show registers.\n"); |
| /* ====================================================================== */ |
| |
| |
| /* |
| * Copyright (c) 2001 William L. Pitts |
| * All rights reserved. |
| * |
| * Redistribution and use in source and binary forms are freely |
| * permitted provided that the above copyright notice and this |
| * paragraph and the following disclaimer are duplicated in all |
| * such forms. |
| * |
| * This software is provided "AS IS" and without any express or |
| * implied warranties, including, without limitation, the implied |
| * warranties of merchantability and fitness for a particular |
| * purpose. |
| */ |