interrupts_m.c 1.8 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * (C) Copyright 2015
  4. * Kamil Lulko, <kamil.lulko@gmail.com>
  5. */
  6. #include <common.h>
  7. /*
  8. * Upon exception entry ARMv7-M processors automatically save stack
  9. * frames containing some registers. For simplicity initial
  10. * implementation uses only this auto-saved stack frame.
  11. * This does not contain complete register set dump,
  12. * only R0-R3, R12, LR, PC and xPSR are saved.
  13. */
  14. struct autosave_regs {
  15. long uregs[8];
  16. };
  17. #define ARM_XPSR uregs[7]
  18. #define ARM_PC uregs[6]
  19. #define ARM_LR uregs[5]
  20. #define ARM_R12 uregs[4]
  21. #define ARM_R3 uregs[3]
  22. #define ARM_R2 uregs[2]
  23. #define ARM_R1 uregs[1]
  24. #define ARM_R0 uregs[0]
  25. int interrupt_init(void)
  26. {
  27. return 0;
  28. }
  29. void enable_interrupts(void)
  30. {
  31. return;
  32. }
  33. int disable_interrupts(void)
  34. {
  35. return 0;
  36. }
  37. void dump_regs(struct autosave_regs *regs)
  38. {
  39. printf("pc : %08lx lr : %08lx xPSR : %08lx\n",
  40. regs->ARM_PC, regs->ARM_LR, regs->ARM_XPSR);
  41. printf("r12 : %08lx r3 : %08lx r2 : %08lx\n"
  42. "r1 : %08lx r0 : %08lx\n",
  43. regs->ARM_R12, regs->ARM_R3, regs->ARM_R2,
  44. regs->ARM_R1, regs->ARM_R0);
  45. }
  46. void bad_mode(void)
  47. {
  48. panic("Resetting CPU ...\n");
  49. reset_cpu(0);
  50. }
  51. void do_hard_fault(struct autosave_regs *autosave_regs)
  52. {
  53. printf("Hard fault\n");
  54. dump_regs(autosave_regs);
  55. bad_mode();
  56. }
  57. void do_mm_fault(struct autosave_regs *autosave_regs)
  58. {
  59. printf("Memory management fault\n");
  60. dump_regs(autosave_regs);
  61. bad_mode();
  62. }
  63. void do_bus_fault(struct autosave_regs *autosave_regs)
  64. {
  65. printf("Bus fault\n");
  66. dump_regs(autosave_regs);
  67. bad_mode();
  68. }
  69. void do_usage_fault(struct autosave_regs *autosave_regs)
  70. {
  71. printf("Usage fault\n");
  72. dump_regs(autosave_regs);
  73. bad_mode();
  74. }
  75. void do_invalid_entry(struct autosave_regs *autosave_regs)
  76. {
  77. printf("Exception\n");
  78. dump_regs(autosave_regs);
  79. bad_mode();
  80. }