[J-u-boot.git] / cmd / bedbug.c

/*
 * BedBug Functions
 */

#include <common.h>
#include <cli.h>
#include <command.h>
#include <console.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;

extern void show_regs __P ((struct pt_regs *));
extern int run_command __P ((const char *, int));

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 * const 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)
		return CMD_RET_USAGE;

	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,
	    "disassemble memory",
	    "ds <address> [# instructions]");

/* ======================================================================
 * 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 * const 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)
		return CMD_RET_USAGE;

	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);
		cli_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,
	    "assemble memory", "as <address>");

/* ======================================================================
 * 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 * const 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,
	    "set or clear a breakpoint",
	    " - Set or clear a breakpoint\n"
	    "break <address> - Break at an address\n"
	    "break off <bp#> - Disable breakpoint.\n"
	    "break show      - List breakpoints.");

/* ======================================================================
 * 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 = cli_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_repeatable(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 * const 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 from a breakpoint",
	    "");

/* ======================================================================
 * 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 * const 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,
	    "single step execution.",
	    "");

/* ======================================================================
 * 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 * const 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,
	    "single step execution, stepping over subroutines.",
	    "");

/* ======================================================================
 * 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 * const 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,
	    "Print the running stack.",
	    "");

/* ======================================================================
 * 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 * const 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,
	    "Show registers.", "");
/* ====================================================================== */


/*
 * 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.
 */
Commit	Line	Data
47d1a6e1 WD	1	/*
	2	* BedBug Functions
	3	*/
	4
	5	#include <common.h>
18d66533	6	#include <cli.h>
47d1a6e1	7	#include <command.h>
24b852a7	8	#include <console.h>
47d1a6e1 WD	9	#include <linux/ctype.h>
47d1a6e1 WD	10	#include <net.h>
8bde7f77	11	#include <bedbug/type.h>
47d1a6e1 WD	12	#include <bedbug/bedbug.h>
	13	#include <bedbug/regs.h>
	14	#include <bedbug/ppc.h>
47d1a6e1	15
d87080b7 WD	16	DECLARE_GLOBAL_DATA_PTR;
d87080b7 WD	17
d87080b7 WD	18	extern void show_regs __P ((struct pt_regs *));
d87080b7 WD	19	extern int run_command __P ((const char *, int));
47d1a6e1	20
d87080b7 WD	21	ulong dis_last_addr = 0; /* Last address disassembled */
	22	ulong dis_last_len = 20; /* Default disassembler length */
	23	CPU_DEBUG_CTX bug_ctx; /* Bedbug context structure */
e1bf824d	24
d87080b7	25
47d1a6e1 WD	26	/* ======================================================================
	27	* U-Boot's puts function does not append a newline, so the bedbug stuff
	28	* will use this for the output of the dis/assembler.
	29	* ====================================================================== */
	30
d87080b7	31	int bedbug_puts (const char *str)
47d1a6e1	32	{
d87080b7	33	/* -------------------------------------------------- */
47d1a6e1	34
d87080b7 WD	35	printf ("%s\r\n", str);
	36	return 0;
	37	} /* bedbug_puts */
e1bf824d	38
47d1a6e1 WD	39
47d1a6e1 WD	40
47d1a6e1 WD	41	/* ======================================================================
	42	* Initialize the bug_ctx structure used by the bedbug debugger. This is
	43	* specific to the CPU since each has different debug registers and
	44	* settings.
	45	* ====================================================================== */
	46
d87080b7	47	void bedbug_init (void)
47d1a6e1	48	{
d87080b7	49	/* -------------------------------------------------- */
47d1a6e1 WD	50
47d1a6e1 WD	51	#if defined(CONFIG_4xx)
d87080b7 WD	52	void bedbug405_init (void);
	53
	54	bedbug405_init ();
d126bfbd	55	#elif defined(CONFIG_8xx)
d87080b7 WD	56	void bedbug860_init (void);
	57
	58	bedbug860_init ();
47d1a6e1 WD	59	#endif
	60
	61	#if defined(CONFIG_MPC824X) \|\| defined(CONFIG_MPC8260)
d87080b7 WD	62	/* Processors that are 603e core based */
d87080b7 WD	63	void bedbug603e_init (void);
47d1a6e1	64
d87080b7	65	bedbug603e_init ();
47d1a6e1 WD	66	#endif
47d1a6e1 WD	67
d87080b7 WD	68	return;
d87080b7 WD	69	} /* bedbug_init */
e1bf824d	70
47d1a6e1 WD	71
47d1a6e1 WD	72
47d1a6e1 WD	73	/* ======================================================================
	74	* Entry point from the interpreter to the disassembler. Repeated calls
	75	* will resume from the last disassembled address.
	76	* ====================================================================== */
54841ab5	77	int do_bedbug_dis (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
47d1a6e1	78	{
d87080b7 WD	79	ulong addr; /* Address to start disassembly from */
	80	ulong len; /* # of instructions to disassemble */
	81
	82	/* -------------------------------------------------- */
	83
	84	/* Setup to go from the last address if none is given */
	85	addr = dis_last_addr;
	86	len = dis_last_len;
	87
47e26b1b	88	if (argc < 2)
4c12eeb8	89	return CMD_RET_USAGE;
d87080b7 WD	90
	91	if ((flag & CMD_FLAG_REPEAT) == 0) {
	92	/* New command */
	93	addr = simple_strtoul (argv[1], NULL, 16);
	94
	95	/* If an extra param is given then it is the length */
	96	if (argc > 2)
	97	len = simple_strtoul (argv[2], NULL, 16);
	98	}
	99
	100	/* Run the disassembler */
	101	disppc ((unsigned char *) addr, 0, len, bedbug_puts, F_RADHEX);
	102
	103	dis_last_addr = addr + (len * 4);
	104	dis_last_len = len;
	105	return 0;
	106	} /* do_bedbug_dis */
	107
	108	U_BOOT_CMD (ds, 3, 1, do_bedbug_dis,
2fb2604d	109	"disassemble memory",
a89c33db	110	"ds <address> [# instructions]");
e1bf824d	111
47d1a6e1 WD	112	/* ======================================================================
	113	* Entry point from the interpreter to the assembler. Assembles
	114	* instructions in consecutive memory locations until a '.' (period) is
	115	* entered on a line by itself.
	116	* ====================================================================== */
54841ab5	117	int do_bedbug_asm (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
47d1a6e1	118	{
d87080b7 WD	119	long mem_addr; /* Address to assemble into */
	120	unsigned long instr; /* Machine code for text */
	121	char prompt[15]; /* Prompt string for user input */
	122	int asm_err; /* Error code from the assembler */
	123
	124	/* -------------------------------------------------- */
	125	int rcode = 0;
	126
47e26b1b	127	if (argc < 2)
4c12eeb8	128	return CMD_RET_USAGE;
d87080b7 WD	129
	130	printf ("\nEnter '.' when done\n");
	131	mem_addr = simple_strtoul (argv[1], NULL, 16);
	132
	133	while (1) {
	134	putc ('\n');
	135	disppc ((unsigned char *) mem_addr, 0, 1, bedbug_puts,
	136	F_RADHEX);
	137
	138	sprintf (prompt, "%08lx: ", mem_addr);
e1bf824d	139	cli_readline(prompt);
d87080b7 WD	140
	141	if (console_buffer[0] && strcmp (console_buffer, ".")) {
	142	if ((instr =
	143	asmppc (mem_addr, console_buffer,
	144	&asm_err)) != 0) {
	145	(unsigned long ) mem_addr = instr;
	146	mem_addr += 4;
	147	} else {
	148	printf ("* Error: %s *\n",
	149	asm_error_str (asm_err));
	150	rcode = 1;
	151	}
	152	} else {
	153	break;
	154	}
	155	}
	156	return rcode;
	157	} /* do_bedbug_asm */
	158
	159	U_BOOT_CMD (as, 2, 0, do_bedbug_asm,
a89c33db	160	"assemble memory", "as <address>");
e1bf824d	161
47d1a6e1 WD	162	/* ======================================================================
	163	* Used to set a break point from the interpreter. Simply calls into the
	164	* CPU-specific break point set routine.
	165	* ====================================================================== */
	166
54841ab5	167	int do_bedbug_break (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
47d1a6e1	168	{
d87080b7 WD	169	/* -------------------------------------------------- */
	170	if (bug_ctx.do_break)
	171	(*bug_ctx.do_break) (cmdtp, flag, argc, argv);
	172	return 0;
	173
	174	} /* do_bedbug_break */
	175
	176	U_BOOT_CMD (break, 3, 0, do_bedbug_break,
2fb2604d	177	"set or clear a breakpoint",
d87080b7 WD	178	" - Set or clear a breakpoint\n"
	179	"break <address> - Break at an address\n"
	180	"break off <bp#> - Disable breakpoint.\n"
a89c33db	181	"break show - List breakpoints.");
e1bf824d	182
47d1a6e1 WD	183	/* ======================================================================
	184	* Called from the debug interrupt routine. Simply calls the CPU-specific
	185	* breakpoint handling routine.
	186	* ====================================================================== */
	187
	188	void do_bedbug_breakpoint (struct pt_regs *regs)
	189	{
d87080b7	190	/* -------------------------------------------------- */
47d1a6e1	191
d87080b7 WD	192	if (bug_ctx.break_isr)
d87080b7 WD	193	(*bug_ctx.break_isr) (regs);
47d1a6e1	194
d87080b7 WD	195	return;
d87080b7 WD	196	} /* do_bedbug_breakpoint */
e1bf824d	197
47d1a6e1 WD	198
47d1a6e1 WD	199
47d1a6e1 WD	200	/* ======================================================================
	201	* Called from the CPU-specific breakpoint handling routine. Enter a
	202	* mini main loop until the stopped flag is cleared from the breakpoint
	203	* context.
	204	*
	205	* This handles the parts of the debugger that are common to all CPU's.
	206	* ====================================================================== */
	207
d87080b7	208	void bedbug_main_loop (unsigned long addr, struct pt_regs *regs)
47d1a6e1	209	{
d87080b7 WD	210	int len; /* Length of command line */
	211	int flag; /* Command flags */
	212	int rc = 0; /* Result from run_command */
	213	char prompt_str[20]; /* Prompt string */
6d0f6bcf	214	static char lastcommand[CONFIG_SYS_CBSIZE] = { 0 }; /* previous command */
d87080b7	215	/* -------------------------------------------------- */
47d1a6e1	216
d87080b7 WD	217	if (bug_ctx.clear)
d87080b7 WD	218	(*bug_ctx.clear) (bug_ctx.current_bp);
47d1a6e1	219
d87080b7 WD	220	printf ("Breakpoint %d: ", bug_ctx.current_bp);
d87080b7 WD	221	disppc ((unsigned char *) addr, 0, 1, bedbug_puts, F_RADHEX);
47d1a6e1	222
d87080b7 WD	223	bug_ctx.stopped = 1;
d87080b7 WD	224	bug_ctx.regs = regs;
47d1a6e1	225
d87080b7	226	sprintf (prompt_str, "BEDBUG.%d =>", bug_ctx.current_bp);
47d1a6e1	227
d87080b7 WD	228	/* A miniature main loop */
d87080b7 WD	229	while (bug_ctx.stopped) {
e1bf824d	230	len = cli_readline(prompt_str);
47d1a6e1	231
d87080b7	232	flag = 0; /* assume no special flags for now */
47d1a6e1	233
d87080b7 WD	234	if (len > 0)
	235	strcpy (lastcommand, console_buffer);
	236	else if (len == 0)
	237	flag \|= CMD_FLAG_REPEAT;
47d1a6e1	238
d87080b7 WD	239	if (len == -1)
	240	printf ("<INTERRUPT>\n");
	241	else
52715f89	242	rc = run_command_repeatable(lastcommand, flag);
47d1a6e1	243
d87080b7 WD	244	if (rc <= 0) {
	245	/* invalid command or not repeatable, forget it */
	246	lastcommand[0] = 0;
	247	}
	248	}
47d1a6e1	249
d87080b7 WD	250	bug_ctx.regs = NULL;
d87080b7 WD	251	bug_ctx.current_bp = 0;
47d1a6e1	252
d87080b7 WD	253	return;
d87080b7 WD	254	} /* bedbug_main_loop */
e1bf824d	255
47d1a6e1 WD	256
47d1a6e1 WD	257
47d1a6e1 WD	258	/* ======================================================================
	259	* Interpreter command to continue from a breakpoint. Just clears the
	260	* stopped flag in the context so that the breakpoint routine will
	261	* return.
	262	* ====================================================================== */
54841ab5	263	int do_bedbug_continue (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
47d1a6e1	264	{
d87080b7 WD	265	/* -------------------------------------------------- */
	266
	267	if (!bug_ctx.stopped) {
	268	printf ("Not at a breakpoint\n");
	269	return 1;
	270	}
	271
	272	bug_ctx.stopped = 0;
	273	return 0;
	274	} /* do_bedbug_continue */
	275
	276	U_BOOT_CMD (continue, 1, 0, do_bedbug_continue,
2fb2604d	277	"continue from a breakpoint",
a89c33db	278	"");
e1bf824d	279
47d1a6e1 WD	280	/* ======================================================================
	281	* Interpreter command to continue to the next instruction, stepping into
	282	* subroutines. Works by calling the find_next_addr() routine to compute
	283	* the address passes control to the CPU-specific set breakpoint routine
	284	* for the current breakpoint number.
	285	* ====================================================================== */
54841ab5	286	int do_bedbug_step (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
47d1a6e1	287	{
d87080b7 WD	288	unsigned long addr; /* Address to stop at */
	289
	290	/* -------------------------------------------------- */
	291
	292	if (!bug_ctx.stopped) {
	293	printf ("Not at a breakpoint\n");
	294	return 1;
	295	}
	296
472d5460	297	if (!find_next_address((unsigned char *) &addr, false, bug_ctx.regs))
d87080b7 WD	298	return 1;
	299
	300	if (bug_ctx.set)
	301	(*bug_ctx.set) (bug_ctx.current_bp, addr);
	302
	303	bug_ctx.stopped = 0;
	304	return 0;
	305	} /* do_bedbug_step */
	306
	307	U_BOOT_CMD (step, 1, 1, do_bedbug_step,
2fb2604d	308	"single step execution.",
a89c33db	309	"");
e1bf824d	310
47d1a6e1 WD	311	/* ======================================================================
	312	* Interpreter command to continue to the next instruction, stepping over
	313	* subroutines. Works by calling the find_next_addr() routine to compute
	314	* the address passes control to the CPU-specific set breakpoint routine
	315	* for the current breakpoint number.
	316	* ====================================================================== */
54841ab5	317	int do_bedbug_next (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
47d1a6e1	318	{
d87080b7 WD	319	unsigned long addr; /* Address to stop at */
	320
	321	/* -------------------------------------------------- */
	322
	323	if (!bug_ctx.stopped) {
	324	printf ("Not at a breakpoint\n");
	325	return 1;
	326	}
	327
472d5460	328	if (!find_next_address((unsigned char *) &addr, true, bug_ctx.regs))
d87080b7 WD	329	return 1;
	330
	331	if (bug_ctx.set)
	332	(*bug_ctx.set) (bug_ctx.current_bp, addr);
	333
	334	bug_ctx.stopped = 0;
	335	return 0;
	336	} /* do_bedbug_next */
	337
	338	U_BOOT_CMD (next, 1, 1, do_bedbug_next,
2fb2604d	339	"single step execution, stepping over subroutines.",
a89c33db	340	"");
e1bf824d	341
47d1a6e1 WD	342	/* ======================================================================
	343	* Interpreter command to print the current stack. This assumes an EABI
	344	* architecture, so it starts with GPR R1 and works back up the stack.
	345	* ====================================================================== */
54841ab5	346	int do_bedbug_stack (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
47d1a6e1	347	{
d87080b7 WD	348	unsigned long sp; /* Stack pointer */
	349	unsigned long func; /* LR from stack */
	350	int depth; /* Stack iteration level */
	351	int skip = 1; /* Flag to skip the first entry */
	352	unsigned long top; /* Top of memory address */
	353
	354	/* -------------------------------------------------- */
	355
	356	if (!bug_ctx.stopped) {
	357	printf ("Not at a breakpoint\n");
	358	return 1;
	359	}
	360
	361	top = gd->bd->bi_memstart + gd->bd->bi_memsize;
	362	depth = 0;
	363
	364	printf ("Depth PC\n");
	365	printf ("----- --------\n");
	366	printf ("%5d %08lx\n", depth++, bug_ctx.regs->nip);
	367
	368	sp = bug_ctx.regs->gpr[1];
	369	func = (unsigned long ) (sp + 4);
	370
	371	while ((func < top) && (sp < top)) {
	372	if (!skip)
	373	printf ("%5d %08lx\n", depth++, func);
	374	else
	375	--skip;
	376
	377	sp = (unsigned long ) sp;
	378	func = (unsigned long ) (sp + 4);
	379	}
	380	return 0;
	381	} /* do_bedbug_stack */
	382
	383	U_BOOT_CMD (where, 1, 1, do_bedbug_stack,
2fb2604d	384	"Print the running stack.",
a89c33db	385	"");
e1bf824d	386
47d1a6e1 WD	387	/* ======================================================================
	388	* Interpreter command to dump the registers. Calls the CPU-specific
	389	* show registers routine.
	390	* ====================================================================== */
54841ab5	391	int do_bedbug_rdump (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
47d1a6e1	392	{
d87080b7 WD	393	/* -------------------------------------------------- */
	394
	395	if (!bug_ctx.stopped) {
	396	printf ("Not at a breakpoint\n");
	397	return 1;
	398	}
	399
	400	show_regs (bug_ctx.regs);
	401	return 0;
	402	} /* do_bedbug_rdump */
	403
	404	U_BOOT_CMD (rdump, 1, 1, do_bedbug_rdump,
a89c33db	405	"Show registers.", "");
47d1a6e1	406	/* ====================================================================== */
47d1a6e1 WD	407
	408
	409	/*
	410	* Copyright (c) 2001 William L. Pitts
	411	* All rights reserved.
	412	*
	413	* Redistribution and use in source and binary forms are freely
	414	* permitted provided that the above copyright notice and this
	415	* paragraph and the following disclaimer are duplicated in all
	416	* such forms.
	417	*
	418	* This software is provided "AS IS" and without any express or
	419	* implied warranties, including, without limitation, the implied
	420	* warranties of merchantability and fitness for a particular
	421	* purpose.
	422	*/