irq.S 2.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114
  1. /*
  2. * (C) Copyright 2007 Michal Simek
  3. *
  4. * Michal SIMEK <monstr@monstr.eu>
  5. *
  6. * See file CREDITS for list of people who contributed to this
  7. * project.
  8. *
  9. * This program is free software; you can redistribute it and/or
  10. * modify it under the terms of the GNU General Public License as
  11. * published by the Free Software Foundation; either version 2 of
  12. * the License, or (at your option) any later version.
  13. *
  14. * This program is distributed in the hope that it will be useful,
  15. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  17. * GNU General Public License for more details.
  18. *
  19. * You should have received a copy of the GNU General Public License
  20. * along with this program; if not, write to the Free Software
  21. * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  22. * MA 02111-1307 USA
  23. */
  24. #include <config.h>
  25. #include <asm/asm.h>
  26. .text
  27. .global _interrupt_handler
  28. _interrupt_handler:
  29. swi r2, r1, -4
  30. swi r3, r1, -8
  31. swi r4, r1, -12
  32. swi r5, r1, -16
  33. swi r6, r1, -20
  34. swi r7, r1, -24
  35. swi r8, r1, -28
  36. swi r9, r1, -32
  37. swi r10, r1, -36
  38. swi r11, r1, -40
  39. swi r12, r1, -44
  40. swi r13, r1, -48
  41. swi r14, r1, -52
  42. swi r15, r1, -56
  43. swi r16, r1, -60
  44. swi r17, r1, -64
  45. swi r18, r1, -68
  46. swi r19, r1, -72
  47. swi r20, r1, -76
  48. swi r21, r1, -80
  49. swi r22, r1, -84
  50. swi r23, r1, -88
  51. swi r24, r1, -92
  52. swi r25, r1, -96
  53. swi r26, r1, -100
  54. swi r27, r1, -104
  55. swi r28, r1, -108
  56. swi r29, r1, -112
  57. swi r30, r1, -116
  58. swi r31, r1, -120
  59. addik r1, r1, -124
  60. brlid r15, interrupt_handler
  61. nop
  62. nop
  63. addik r1, r1, 124
  64. lwi r31, r1, -120
  65. lwi r30, r1, -116
  66. lwi r29, r1, -112
  67. lwi r28, r1, -108
  68. lwi r27, r1, -104
  69. lwi r26, r1, -100
  70. lwi r25, r1, -96
  71. lwi r24, r1, -92
  72. lwi r23, r1, -88
  73. lwi r22, r1, -84
  74. lwi r21, r1, -80
  75. lwi r20, r1, -76
  76. lwi r19, r1, -72
  77. lwi r18, r1, -68
  78. lwi r17, r1, -64
  79. lwi r16, r1, -60
  80. lwi r15, r1, -56
  81. lwi r14, r1, -52
  82. lwi r13, r1, -48
  83. lwi r12, r1, -44
  84. lwi r11, r1, -40
  85. lwi r10, r1, -36
  86. lwi r9, r1, -32
  87. lwi r8, r1, -28
  88. lwi r7, r1, -24
  89. lwi r6, r1, -20
  90. lwi r5, r1, -16
  91. lwi r4, r1, -12
  92. lwi r3, r1, -8
  93. lwi r2, r1, -4
  94. /* enable_interrupt */
  95. #ifdef XILINX_USE_MSR_INSTR
  96. msrset r0, 2
  97. #else
  98. /* FIXME unstable in stressed mode - two irqs */
  99. nop
  100. addi r1, r1, -4
  101. swi r12, r1, 0
  102. mfs r12, rmsr
  103. ori r12, r12, 2
  104. mts rmsr, r12
  105. lwi r12, r1, 0
  106. addi r1, r1, 4
  107. nop
  108. #endif
  109. bra r14
  110. nop
  111. nop
  112. .size _interrupt_handler,.-_interrupt_handler