traps.c 1.6 KB

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