entry-arcv2.S 5.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253
  1. /*
  2. * ARCv2 ISA based core Low Level Intr/Traps/Exceptions(non-TLB) Handling
  3. *
  4. * Copyright (C) 2013 Synopsys, Inc. (www.synopsys.com)
  5. *
  6. * This program is free software; you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License version 2 as
  8. * published by the Free Software Foundation.
  9. */
  10. #include <linux/linkage.h> /* ARC_{EXTRY,EXIT} */
  11. #include <asm/entry.h> /* SAVE_ALL_{INT1,INT2,TRAP...} */
  12. #include <asm/errno.h>
  13. #include <asm/arcregs.h>
  14. #include <asm/irqflags.h>
  15. .cpu HS
  16. #define VECTOR .word
  17. ;############################ Vector Table #################################
  18. .section .vector,"a",@progbits
  19. .align 4
  20. # Initial 16 slots are Exception Vectors
  21. VECTOR res_service ; Reset Vector
  22. VECTOR mem_service ; Mem exception
  23. VECTOR instr_service ; Instrn Error
  24. VECTOR EV_MachineCheck ; Fatal Machine check
  25. VECTOR EV_TLBMissI ; Intruction TLB miss
  26. VECTOR EV_TLBMissD ; Data TLB miss
  27. VECTOR EV_TLBProtV ; Protection Violation
  28. VECTOR EV_PrivilegeV ; Privilege Violation
  29. VECTOR EV_SWI ; Software Breakpoint
  30. VECTOR EV_Trap ; Trap exception
  31. VECTOR EV_Extension ; Extn Instruction Exception
  32. VECTOR EV_DivZero ; Divide by Zero
  33. VECTOR EV_DCError ; Data Cache Error
  34. VECTOR EV_Misaligned ; Misaligned Data Access
  35. VECTOR reserved ; Reserved slots
  36. VECTOR reserved ; Reserved slots
  37. # Begin Interrupt Vectors
  38. VECTOR handle_interrupt ; (16) Timer0
  39. VECTOR handle_interrupt ; unused (Timer1)
  40. VECTOR handle_interrupt ; unused (WDT)
  41. VECTOR handle_interrupt ; (19) ICI (inter core interrupt)
  42. VECTOR handle_interrupt
  43. VECTOR handle_interrupt
  44. VECTOR handle_interrupt
  45. VECTOR handle_interrupt ; (23) End of fixed IRQs
  46. .rept CONFIG_ARC_NUMBER_OF_INTERRUPTS - 8
  47. VECTOR handle_interrupt
  48. .endr
  49. .section .text, "ax",@progbits
  50. reserved:
  51. flag 1 ; Unexpected event, halt
  52. ;##################### Interrupt Handling ##############################
  53. ENTRY(handle_interrupt)
  54. INTERRUPT_PROLOGUE irq
  55. clri ; To make status32.IE agree with CPU internal state
  56. lr r0, [ICAUSE]
  57. mov blink, ret_from_exception
  58. b.d arch_do_IRQ
  59. mov r1, sp
  60. END(handle_interrupt)
  61. ;################### Non TLB Exception Handling #############################
  62. ENTRY(EV_SWI)
  63. flag 1
  64. END(EV_SWI)
  65. ENTRY(EV_DivZero)
  66. flag 1
  67. END(EV_DivZero)
  68. ENTRY(EV_DCError)
  69. flag 1
  70. END(EV_DCError)
  71. ; ---------------------------------------------
  72. ; Memory Error Exception Handler
  73. ; - Unlike ARCompact, handles Bus errors for both User/Kernel mode,
  74. ; Instruction fetch or Data access, under a single Exception Vector
  75. ; ---------------------------------------------
  76. ENTRY(mem_service)
  77. EXCEPTION_PROLOGUE
  78. lr r0, [efa]
  79. mov r1, sp
  80. FAKE_RET_FROM_EXCPN
  81. bl do_memory_error
  82. b ret_from_exception
  83. END(mem_service)
  84. ENTRY(EV_Misaligned)
  85. EXCEPTION_PROLOGUE
  86. lr r0, [efa] ; Faulting Data address
  87. mov r1, sp
  88. FAKE_RET_FROM_EXCPN
  89. SAVE_CALLEE_SAVED_USER
  90. mov r2, sp ; callee_regs
  91. bl do_misaligned_access
  92. ; TBD: optimize - do this only if a callee reg was involved
  93. ; either a dst of emulated LD/ST or src with address-writeback
  94. RESTORE_CALLEE_SAVED_USER
  95. b ret_from_exception
  96. END(EV_Misaligned)
  97. ; ---------------------------------------------
  98. ; Protection Violation Exception Handler
  99. ; ---------------------------------------------
  100. ENTRY(EV_TLBProtV)
  101. EXCEPTION_PROLOGUE
  102. lr r0, [efa] ; Faulting Data address
  103. mov r1, sp ; pt_regs
  104. FAKE_RET_FROM_EXCPN
  105. mov blink, ret_from_exception
  106. b do_page_fault
  107. END(EV_TLBProtV)
  108. ; From Linux standpoint Slow Path I/D TLB Miss is same a ProtV as they
  109. ; need to call do_page_fault().
  110. ; ECR in pt_regs provides whether access was R/W/X
  111. .global call_do_page_fault
  112. .set call_do_page_fault, EV_TLBProtV
  113. ;############# Common Handlers for ARCompact and ARCv2 ##############
  114. #include "entry.S"
  115. ;############# Return from Intr/Excp/Trap (ARCv2 ISA Specifics) ##############
  116. ;
  117. ; Restore the saved sys context (common exit-path for EXCPN/IRQ/Trap)
  118. ; IRQ shd definitely not happen between now and rtie
  119. ; All 2 entry points to here already disable interrupts
  120. .Lrestore_regs:
  121. ld r0, [sp, PT_status32] ; U/K mode at time of entry
  122. lr r10, [AUX_IRQ_ACT]
  123. bmsk r11, r10, 15 ; AUX_IRQ_ACT.ACTIVE
  124. breq r11, 0, .Lexcept_ret ; No intr active, ret from Exception
  125. ;####### Return from Intr #######
  126. debug_marker_l1:
  127. bbit1.nt r0, STATUS_DE_BIT, .Lintr_ret_to_delay_slot
  128. .Lisr_ret_fast_path:
  129. ; Handle special case #1: (Entry via Exception, Return via IRQ)
  130. ;
  131. ; Exception in U mode, preempted in kernel, Intr taken (K mode), orig
  132. ; task now returning to U mode (riding the Intr)
  133. ; AUX_IRQ_ACTIVE won't have U bit set (since intr in K mode), hence SP
  134. ; won't be switched to correct U mode value (from AUX_SP)
  135. ; So force AUX_IRQ_ACT.U for such a case
  136. btst r0, STATUS_U_BIT ; Z flag set if K (Z clear for U)
  137. bset.nz r11, r11, AUX_IRQ_ACT_BIT_U ; NZ means U
  138. sr r11, [AUX_IRQ_ACT]
  139. INTERRUPT_EPILOGUE irq
  140. rtie
  141. ;####### Return from Exception / pure kernel mode #######
  142. .Lexcept_ret: ; Expects r0 has PT_status32
  143. debug_marker_syscall:
  144. EXCEPTION_EPILOGUE
  145. rtie
  146. ;####### Return from Intr to insn in delay slot #######
  147. ; Handle special case #2: (Entry via Exception in Delay Slot, Return via IRQ)
  148. ;
  149. ; Intr returning to a Delay Slot (DS) insn
  150. ; (since IRQ NOT allowed in DS in ARCv2, this can only happen if orig
  151. ; entry was via Exception in DS which got preempted in kernel).
  152. ;
  153. ; IRQ RTIE won't reliably restore DE bit and/or BTA, needs handling
  154. .Lintr_ret_to_delay_slot:
  155. debug_marker_ds:
  156. ld r2, [@intr_to_DE_cnt]
  157. add r2, r2, 1
  158. st r2, [@intr_to_DE_cnt]
  159. ld r2, [sp, PT_ret]
  160. ld r3, [sp, PT_status32]
  161. bic r0, r3, STATUS_U_MASK|STATUS_DE_MASK|STATUS_IE_MASK|STATUS_L_MASK
  162. st r0, [sp, PT_status32]
  163. mov r1, .Lintr_ret_to_delay_slot_2
  164. st r1, [sp, PT_ret]
  165. st r2, [sp, 0]
  166. st r3, [sp, 4]
  167. b .Lisr_ret_fast_path
  168. .Lintr_ret_to_delay_slot_2:
  169. sub sp, sp, SZ_PT_REGS
  170. st r9, [sp, -4]
  171. ld r9, [sp, 0]
  172. sr r9, [eret]
  173. ld r9, [sp, 4]
  174. sr r9, [erstatus]
  175. ld r9, [sp, 8]
  176. sr r9, [erbta]
  177. ld r9, [sp, -4]
  178. add sp, sp, SZ_PT_REGS
  179. rtie
  180. END(ret_from_exception)