interrupts.c 3.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129
  1. /*
  2. * (C) Copyright 2002
  3. * Sysgo Real-Time Solutions, GmbH <www.elinos.com>
  4. * Alex Zuepke <azu@sysgo.de>
  5. *
  6. * Copyright (C) 2011 Andes Technology Corporation
  7. * Shawn Lin, Andes Technology Corporation <nobuhiro@andestech.com>
  8. * Macpaul Lin, Andes Technology Corporation <macpaul@andestech.com>
  9. *
  10. * See file CREDITS for list of people who contributed to this
  11. * project.
  12. *
  13. * This program is free software; you can redistribute it and/or
  14. * modify it under the terms of the GNU General Public License as
  15. * published by the Free Software Foundation; either version 2 of
  16. * the License, or (at your option) any later version.
  17. *
  18. * This program is distributed in the hope that it will be useful,
  19. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  20. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  21. * GNU General Public License for more details.
  22. *
  23. * You should have received a copy of the GNU General Public License
  24. * along with this program; if not, write to the Free Software
  25. * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  26. * MA 02111-1307 USA
  27. */
  28. #include <common.h>
  29. #include <asm/ptrace.h>
  30. #include <asm/system.h>
  31. #undef INTERRUPT_MODE
  32. static int int_flag;
  33. int irq_flags; /* needed by asm-nds32/system.h */
  34. int GIE_STATUS(void)
  35. {
  36. int ret;
  37. __asm__ __volatile__ (
  38. "mfsr $p0, $psw\n\t"
  39. "andi %0, %0, 0x1\n\t"
  40. : "=r" (ret)
  41. :
  42. : "memory"
  43. );
  44. return ret;
  45. }
  46. #ifdef CONFIG_USE_INTERRUPT
  47. /* enable interrupts */
  48. void enable_interrupts(void)
  49. {
  50. local_irq_restore(int_flag);
  51. }
  52. /*
  53. * disable interrupts
  54. * Return true if GIE is enabled before we disable it.
  55. */
  56. int disable_interrupts(void)
  57. {
  58. int gie_ori_status;
  59. gie_ori_status = GIE_STATUS();
  60. local_irq_save(int_flag);
  61. return gie_ori_status;
  62. }
  63. #endif
  64. void bad_mode(void)
  65. {
  66. panic("Resetting CPU ...\n");
  67. reset_cpu(0);
  68. }
  69. void show_regs(struct pt_regs *regs)
  70. {
  71. const char *processor_modes[] = {"USER", "SuperUser" , "HyperVisor"};
  72. printf("\n");
  73. printf("pc : [<%08lx>] sp: [<%08lx>]\n"
  74. "lp : %08lx gp : %08lx fp : %08lx\n",
  75. regs->ipc, regs->sp, regs->lp, regs->gp, regs->fp);
  76. printf("D1H: %08lx D1L: %08lx D0H: %08lx D0L: %08lx\n",
  77. regs->d1hi, regs->d1lo, regs->d0hi, regs->d0lo);
  78. printf("r27: %08lx r26: %08lx r25: %08lx r24: %08lx\n",
  79. regs->p1, regs->p0, regs->r[25], regs->r[24]);
  80. printf("r23: %08lx r22: %08lx r21: %08lx r20: %08lx\n",
  81. regs->r[23], regs->r[22], regs->r[21], regs->r[20]);
  82. printf("r19: %08lx r18: %08lx r17: %08lx r16: %08lx\n",
  83. regs->r[19], regs->r[18], regs->r[17], regs->r[16]);
  84. printf("r15: %08lx r14: %08lx r13: %08lx r12: %08lx\n",
  85. regs->r[15], regs->r[14], regs->r[13], regs->r[12]);
  86. printf("r11: %08lx r10: %08lx r9 : %08lx r8 : %08lx\n",
  87. regs->r[11], regs->r[10], regs->r[9], regs->r[8]);
  88. printf("r7 : %08lx r6 : %08lx r5 : %08lx r4 : %08lx\n",
  89. regs->r[7], regs->r[6], regs->r[5], regs->r[4]);
  90. printf("r3 : %08lx r2 : %08lx r1 : %08lx r0 : %08lx\n",
  91. regs->r[3], regs->r[2], regs->r[1], regs->r[0]);
  92. printf(" Interrupts %s Mode %s\n",
  93. interrupts_enabled(regs) ? "on" : "off",
  94. processor_modes[processor_mode(regs)]);
  95. }
  96. void do_interruption(struct pt_regs *pt_regs, int EVIC_num)
  97. {
  98. const char *interruption_type[] = {
  99. "Reset",
  100. "TLB Fill",
  101. "TLB Not Present",
  102. "TLB Misc",
  103. "VLPT Miss",
  104. "Cache Parity Error",
  105. "Debug",
  106. "General Exception",
  107. "External Interrupt"
  108. };
  109. printf("%s\n", interruption_type[EVIC_num]);
  110. show_regs(pt_regs);
  111. bad_mode();
  112. }