interrupts_m.c 1.8 KB

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