[people/ms/u-boot.git] / common / cmd_bedbug.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>

DECLARE_GLOBAL_DATA_PTR;

#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    */
\f

/* ======================================================================
 * 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 */
\f


/* ======================================================================
 * 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 */
\f


/* ======================================================================
 * 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");
\f
/* ======================================================================
 * 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");
\f
/* ======================================================================
 * 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");
\f
/* ======================================================================
 * 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 */
\f


/* ======================================================================
 * 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 */
\f


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