traps.c 1.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960
  1. /*
  2. * (C) Copyright 2003
  3. * Josef Baumgartner <josef.baumgartner@telex.de>
  4. *
  5. * (C) Copyright 2000
  6. * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
  7. *
  8. * SPDX-License-Identifier: GPL-2.0+
  9. */
  10. #include <common.h>
  11. #include <watchdog.h>
  12. #include <command.h>
  13. #include <asm/processor.h>
  14. extern void _exc_handler(void);
  15. extern void _int_handler(void);
  16. static void show_frame(struct pt_regs *fp)
  17. {
  18. printf ("Vector Number: %d Format: %02x Fault Status: %01x\n\n", (fp->vector & 0x3fc) >> 2,
  19. fp->format, (fp->vector & 0x3) | ((fp->vector & 0xc00) >> 8));
  20. printf ("PC: %08lx SR: %08lx SP: %08lx\n", fp->pc, (long) fp->sr, (long) fp);
  21. printf ("D0: %08lx D1: %08lx D2: %08lx D3: %08lx\n",
  22. fp->d0, fp->d1, fp->d2, fp->d3);
  23. printf ("D4: %08lx D5: %08lx D6: %08lx D7: %08lx\n",
  24. fp->d4, fp->d5, fp->d6, fp->d7);
  25. printf ("A0: %08lx A1: %08lx A2: %08lx A3: %08lx\n",
  26. fp->a0, fp->a1, fp->a2, fp->a3);
  27. printf ("A4: %08lx A5: %08lx A6: %08lx\n",
  28. fp->a4, fp->a5, fp->a6);
  29. }
  30. void exc_handler(struct pt_regs *fp) {
  31. printf("\n\n*** Unexpected exception ***\n");
  32. show_frame (fp);
  33. printf("\n*** Please Reset Board! ***\n");
  34. for(;;);
  35. }
  36. void trap_init(ulong value) {
  37. unsigned long *vec = (ulong *)value;
  38. int i;
  39. for(i = 2; i < 25; i++) {
  40. vec[i] = (unsigned long)_exc_handler;
  41. }
  42. for(i = 25; i < 32; i++) {
  43. vec[i] = (unsigned long)_int_handler;
  44. }
  45. for(i = 32; i < 64; i++) {
  46. vec[i] = (unsigned long)_exc_handler;
  47. }
  48. for(i = 64; i < 256; i++) {
  49. vec[i] = (unsigned long)_int_handler;
  50. }
  51. setvbr(value); /* set vector base register to new table */
  52. }