450 lines
13 KiB
C
450 lines
13 KiB
C
|
/*
|
|||
|
* 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>
|
|||
|
|
|||
|
#if (CONFIG_COMMANDS & CFG_CMD_BEDBUG)
|
|||
|
|
|||
|
#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[ CFG_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[])
|
|||
|
{
|
|||
|
DECLARE_GLOBAL_DATA_PTR;
|
|||
|
|
|||
|
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"
|
|||
|
);
|
|||
|
/* ====================================================================== */
|
|||
|
#endif /* CFG_CMD_BEDBUG */
|
|||
|
|
|||
|
|
|||
|
/*
|
|||
|
* 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.
|
|||
|
*/
|