interrupts.c 2.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * (C) Copyright 2002
  4. * Sysgo Real-Time Solutions, GmbH <www.elinos.com>
  5. * Alex Zuepke <azu@sysgo.de>
  6. *
  7. * Copyright (C) 2011 Andes Technology Corporation
  8. * Shawn Lin, Andes Technology Corporation <nobuhiro@andestech.com>
  9. * Macpaul Lin, Andes Technology Corporation <macpaul@andestech.com>
  10. */
  11. #include <common.h>
  12. #include <cpu_func.h>
  13. #include <irq_func.h>
  14. #include <asm/ptrace.h>
  15. #include <asm/system.h>
  16. #undef INTERRUPT_MODE
  17. static int int_flag;
  18. int irq_flags; /* needed by asm-nds32/system.h */
  19. int GIE_STATUS(void)
  20. {
  21. int ret;
  22. __asm__ __volatile__ (
  23. "mfsr $p0, $psw\n\t"
  24. "andi %0, %0, 0x1\n\t"
  25. : "=r" (ret)
  26. :
  27. : "memory"
  28. );
  29. return ret;
  30. }
  31. #ifdef CONFIG_USE_INTERRUPT
  32. int interrupt_init(void)
  33. {
  34. return 0;
  35. }
  36. /* enable interrupts */
  37. void enable_interrupts(void)
  38. {
  39. local_irq_restore(int_flag);
  40. }
  41. /*
  42. * disable interrupts
  43. * Return true if GIE is enabled before we disable it.
  44. */
  45. int disable_interrupts(void)
  46. {
  47. int gie_ori_status;
  48. gie_ori_status = GIE_STATUS();
  49. local_irq_save(int_flag);
  50. return gie_ori_status;
  51. }
  52. #endif
  53. void bad_mode(void)
  54. {
  55. panic("Resetting CPU ...\n");
  56. reset_cpu(0);
  57. }
  58. void show_regs(struct pt_regs *regs)
  59. {
  60. const char *processor_modes[] = {"USER", "SuperUser" , "HyperVisor"};
  61. printf("\n");
  62. printf("pc : [<%08lx>] sp: [<%08lx>]\n"
  63. "lp : %08lx gp : %08lx fp : %08lx\n",
  64. regs->ipc, regs->sp, regs->lp, regs->gp, regs->fp);
  65. printf("D1H: %08lx D1L: %08lx D0H: %08lx D0L: %08lx\n",
  66. regs->d1hi, regs->d1lo, regs->d0hi, regs->d0lo);
  67. printf("r27: %08lx r26: %08lx r25: %08lx r24: %08lx\n",
  68. regs->p1, regs->p0, regs->r[25], regs->r[24]);
  69. printf("r23: %08lx r22: %08lx r21: %08lx r20: %08lx\n",
  70. regs->r[23], regs->r[22], regs->r[21], regs->r[20]);
  71. printf("r19: %08lx r18: %08lx r17: %08lx r16: %08lx\n",
  72. regs->r[19], regs->r[18], regs->r[17], regs->r[16]);
  73. printf("r15: %08lx r14: %08lx r13: %08lx r12: %08lx\n",
  74. regs->r[15], regs->r[14], regs->r[13], regs->r[12]);
  75. printf("r11: %08lx r10: %08lx r9 : %08lx r8 : %08lx\n",
  76. regs->r[11], regs->r[10], regs->r[9], regs->r[8]);
  77. printf("r7 : %08lx r6 : %08lx r5 : %08lx r4 : %08lx\n",
  78. regs->r[7], regs->r[6], regs->r[5], regs->r[4]);
  79. printf("r3 : %08lx r2 : %08lx r1 : %08lx r0 : %08lx\n",
  80. regs->r[3], regs->r[2], regs->r[1], regs->r[0]);
  81. printf(" Interrupts %s Mode %s\n",
  82. interrupts_enabled(regs) ? "on" : "off",
  83. processor_modes[processor_mode(regs)]);
  84. }
  85. void do_interruption(struct pt_regs *pt_regs, int EVIC_num)
  86. {
  87. const char *interruption_type[] = {
  88. "Reset",
  89. "TLB Fill",
  90. "TLB Not Present",
  91. "TLB Misc",
  92. "VLPT Miss",
  93. "Cache Parity Error",
  94. "Debug",
  95. "General Exception",
  96. "External Interrupt"
  97. };
  98. printf("%s\n", interruption_type[EVIC_num]);
  99. show_regs(pt_regs);
  100. bad_mode();
  101. }