Merge: Add support for AMCC 440SPe CPU based eval board (Yucca).
[platform/kernel/u-boot.git] / common / cmd_bedbug.c
1 /*
2  * BedBug Functions
3  */
4
5 #include <common.h>
6 #include <command.h>
7 #include <linux/ctype.h>
8 #include <net.h>
9 #include <bedbug/type.h>
10 #include <bedbug/bedbug.h>
11 #include <bedbug/regs.h>
12 #include <bedbug/ppc.h>
13
14 DECLARE_GLOBAL_DATA_PTR;
15
16 #if (CONFIG_COMMANDS & CFG_CMD_BEDBUG)
17
18 #ifndef MAX
19 #define MAX(a,b) ((a) > (b) ? (a) : (b))
20 #endif
21
22 extern void show_regs __P ((struct pt_regs *));
23 extern int run_command __P ((const char *, int));
24 extern char console_buffer[];
25
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    */
29 \f
30
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
36 int bedbug_puts (const char *str)
37 {
38         /* -------------------------------------------------- */
39
40         printf ("%s\r\n", str);
41         return 0;
42 }                               /* bedbug_puts */
43 \f
44
45
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
52 void bedbug_init (void)
53 {
54         /* -------------------------------------------------- */
55
56 #if defined(CONFIG_4xx)
57         void bedbug405_init (void);
58
59         bedbug405_init ();
60 #elif defined(CONFIG_8xx)
61         void bedbug860_init (void);
62
63         bedbug860_init ();
64 #endif
65
66 #if defined(CONFIG_MPC824X) || defined(CONFIG_MPC8260)
67         /* Processors that are 603e core based */
68         void bedbug603e_init (void);
69
70         bedbug603e_init ();
71 #endif
72
73         return;
74 }                               /* bedbug_init */
75 \f
76
77
78 /* ======================================================================
79  * Entry point from the interpreter to the disassembler.  Repeated calls
80  * will resume from the last disassembled address.
81  * ====================================================================== */
82 int do_bedbug_dis (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
83 {
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");
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  * ====================================================================== */
124 int do_bedbug_asm (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
125 {
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");
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
176 int do_bedbug_break (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
177 {
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");
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 {
199         /* -------------------------------------------------- */
200
201         if (bug_ctx.break_isr)
202                 (*bug_ctx.break_isr) (regs);
203
204         return;
205 }                               /* do_bedbug_breakpoint */
206 \f
207
208
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
217 void bedbug_main_loop (unsigned long addr, struct pt_regs *regs)
218 {
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         /* -------------------------------------------------- */
225
226         if (bug_ctx.clear)
227                 (*bug_ctx.clear) (bug_ctx.current_bp);
228
229         printf ("Breakpoint %d: ", bug_ctx.current_bp);
230         disppc ((unsigned char *) addr, 0, 1, bedbug_puts, F_RADHEX);
231
232         bug_ctx.stopped = 1;
233         bug_ctx.regs = regs;
234
235         sprintf (prompt_str, "BEDBUG.%d =>", bug_ctx.current_bp);
236
237         /* A miniature main loop */
238         while (bug_ctx.stopped) {
239                 len = readline (prompt_str);
240
241                 flag = 0;       /* assume no special flags for now */
242
243                 if (len > 0)
244                         strcpy (lastcommand, console_buffer);
245                 else if (len == 0)
246                         flag |= CMD_FLAG_REPEAT;
247
248                 if (len == -1)
249                         printf ("<INTERRUPT>\n");
250                 else
251                         rc = run_command (lastcommand, flag);
252
253                 if (rc <= 0) {
254                         /* invalid command or not repeatable, forget it */
255                         lastcommand[0] = 0;
256                 }
257         }
258
259         bug_ctx.regs = NULL;
260         bug_ctx.current_bp = 0;
261
262         return;
263 }                               /* bedbug_main_loop */
264 \f
265
266
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  * ====================================================================== */
272 int do_bedbug_continue (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
273 {
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");
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  * ====================================================================== */
295 int do_bedbug_step (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
296 {
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");
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  * ====================================================================== */
326 int do_bedbug_next (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
327 {
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");
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  * ====================================================================== */
355 int do_bedbug_stack (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
356 {
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");
395 \f
396 /* ======================================================================
397  * Interpreter command to dump the registers.  Calls the CPU-specific
398  * show registers routine.
399  * ====================================================================== */
400 int do_bedbug_rdump (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
401 {
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");
415 /* ====================================================================== */
416 #endif /* CFG_CMD_BEDBUG */
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  */