entry.S 9.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361
  1. /*
  2. * Common Low Level Interrupts/Traps/Exceptions(non-TLB) Handling for ARC
  3. * (included from entry-<isa>.S
  4. *
  5. * Copyright (C) 2014-15 Synopsys, Inc. (www.synopsys.com)
  6. * Copyright (C) 2004, 2007-2010, 2011-2012 Synopsys, Inc. (www.synopsys.com)
  7. *
  8. * This program is free software; you can redistribute it and/or modify
  9. * it under the terms of the GNU General Public License version 2 as
  10. * published by the Free Software Foundation.
  11. */
  12. /*------------------------------------------------------------------
  13. * Function ABI
  14. *------------------------------------------------------------------
  15. *
  16. * Arguments r0 - r7
  17. * Caller Saved Registers r0 - r12
  18. * Callee Saved Registers r13- r25
  19. * Global Pointer (gp) r26
  20. * Frame Pointer (fp) r27
  21. * Stack Pointer (sp) r28
  22. * Branch link register (blink) r31
  23. *------------------------------------------------------------------
  24. */
  25. ;################### Special Sys Call Wrappers ##########################
  26. ENTRY(sys_clone_wrapper)
  27. SAVE_CALLEE_SAVED_USER
  28. bl @sys_clone
  29. DISCARD_CALLEE_SAVED_USER
  30. GET_CURR_THR_INFO_FLAGS r10
  31. btst r10, TIF_SYSCALL_TRACE
  32. bnz tracesys_exit
  33. b .Lret_from_system_call
  34. END(sys_clone_wrapper)
  35. ENTRY(ret_from_fork)
  36. ; when the forked child comes here from the __switch_to function
  37. ; r0 has the last task pointer.
  38. ; put last task in scheduler queue
  39. jl @schedule_tail
  40. ld r9, [sp, PT_status32]
  41. brne r9, 0, 1f
  42. jl.d [r14] ; kernel thread entry point
  43. mov r0, r13 ; (see PF_KTHREAD block in copy_thread)
  44. 1:
  45. ; Return to user space
  46. ; 1. Any forked task (Reach here via BRne above)
  47. ; 2. First ever init task (Reach here via return from JL above)
  48. ; This is the historic "kernel_execve" use-case, to return to init
  49. ; user mode, in a round about way since that is always done from
  50. ; a kernel thread which is executed via JL above but always returns
  51. ; out whenever kernel_execve (now inline do_fork()) is involved
  52. b ret_from_exception
  53. END(ret_from_fork)
  54. ;################### Non TLB Exception Handling #############################
  55. ; ---------------------------------------------
  56. ; Instruction Error Exception Handler
  57. ; ---------------------------------------------
  58. ENTRY(instr_service)
  59. EXCEPTION_PROLOGUE
  60. lr r0, [efa]
  61. mov r1, sp
  62. FAKE_RET_FROM_EXCPN
  63. bl do_insterror_or_kprobe
  64. b ret_from_exception
  65. END(instr_service)
  66. ; ---------------------------------------------
  67. ; Machine Check Exception Handler
  68. ; ---------------------------------------------
  69. ENTRY(EV_MachineCheck)
  70. EXCEPTION_PROLOGUE
  71. lr r2, [ecr]
  72. lr r0, [efa]
  73. mov r1, sp
  74. lsr r3, r2, 8
  75. bmsk r3, r3, 7
  76. brne r3, ECR_C_MCHK_DUP_TLB, 1f
  77. bl do_tlb_overlap_fault
  78. b ret_from_exception
  79. 1:
  80. ; DEAD END: can't do much, display Regs and HALT
  81. SAVE_CALLEE_SAVED_USER
  82. GET_CURR_TASK_FIELD_PTR TASK_THREAD, r10
  83. st sp, [r10, THREAD_CALLEE_REG]
  84. j do_machine_check_fault
  85. END(EV_MachineCheck)
  86. ; ---------------------------------------------
  87. ; Privilege Violation Exception Handler
  88. ; ---------------------------------------------
  89. ENTRY(EV_PrivilegeV)
  90. EXCEPTION_PROLOGUE
  91. lr r0, [efa]
  92. mov r1, sp
  93. FAKE_RET_FROM_EXCPN
  94. bl do_privilege_fault
  95. b ret_from_exception
  96. END(EV_PrivilegeV)
  97. ; ---------------------------------------------
  98. ; Extension Instruction Exception Handler
  99. ; ---------------------------------------------
  100. ENTRY(EV_Extension)
  101. EXCEPTION_PROLOGUE
  102. lr r0, [efa]
  103. mov r1, sp
  104. FAKE_RET_FROM_EXCPN
  105. bl do_extension_fault
  106. b ret_from_exception
  107. END(EV_Extension)
  108. ;################ Trap Handling (Syscall, Breakpoint) ##################
  109. ; ---------------------------------------------
  110. ; syscall Tracing
  111. ; ---------------------------------------------
  112. tracesys:
  113. ; save EFA in case tracer wants the PC of traced task
  114. ; using ERET won't work since next-PC has already committed
  115. lr r12, [efa]
  116. GET_CURR_TASK_FIELD_PTR TASK_THREAD, r11
  117. st r12, [r11, THREAD_FAULT_ADDR] ; thread.fault_address
  118. ; PRE Sys Call Ptrace hook
  119. mov r0, sp ; pt_regs needed
  120. bl @syscall_trace_entry
  121. ; Tracing code now returns the syscall num (orig or modif)
  122. mov r8, r0
  123. ; Do the Sys Call as we normally would.
  124. ; Validate the Sys Call number
  125. cmp r8, NR_syscalls
  126. mov.hi r0, -ENOSYS
  127. bhi tracesys_exit
  128. ; Restore the sys-call args. Mere invocation of the hook abv could have
  129. ; clobbered them (since they are in scratch regs). The tracer could also
  130. ; have deliberately changed the syscall args: r0-r7
  131. ld r0, [sp, PT_r0]
  132. ld r1, [sp, PT_r1]
  133. ld r2, [sp, PT_r2]
  134. ld r3, [sp, PT_r3]
  135. ld r4, [sp, PT_r4]
  136. ld r5, [sp, PT_r5]
  137. ld r6, [sp, PT_r6]
  138. ld r7, [sp, PT_r7]
  139. ld.as r9, [sys_call_table, r8]
  140. jl [r9] ; Entry into Sys Call Handler
  141. tracesys_exit:
  142. st r0, [sp, PT_r0] ; sys call return value in pt_regs
  143. ;POST Sys Call Ptrace Hook
  144. bl @syscall_trace_exit
  145. b ret_from_exception ; NOT ret_from_system_call at is saves r0 which
  146. ; we'd done before calling post hook above
  147. ; ---------------------------------------------
  148. ; Breakpoint TRAP
  149. ; ---------------------------------------------
  150. trap_with_param:
  151. ; stop_pc info by gdb needs this info
  152. lr r0, [efa]
  153. mov r1, sp
  154. ; Now that we have read EFA, it is safe to do "fake" rtie
  155. ; and get out of CPU exception mode
  156. FAKE_RET_FROM_EXCPN
  157. ; Save callee regs in case gdb wants to have a look
  158. ; SP will grow up by size of CALLEE Reg-File
  159. ; NOTE: clobbers r12
  160. SAVE_CALLEE_SAVED_USER
  161. ; save location of saved Callee Regs @ thread_struct->pc
  162. GET_CURR_TASK_FIELD_PTR TASK_THREAD, r10
  163. st sp, [r10, THREAD_CALLEE_REG]
  164. ; Call the trap handler
  165. bl do_non_swi_trap
  166. ; unwind stack to discard Callee saved Regs
  167. DISCARD_CALLEE_SAVED_USER
  168. b ret_from_exception
  169. ; ---------------------------------------------
  170. ; syscall TRAP
  171. ; ABI: (r0-r7) upto 8 args, (r8) syscall number
  172. ; ---------------------------------------------
  173. ENTRY(EV_Trap)
  174. EXCEPTION_PROLOGUE
  175. ;============ TRAP 1 :breakpoints
  176. ; Check ECR for trap with arg (PROLOGUE ensures r9 has ECR)
  177. bmsk.f 0, r9, 7
  178. bnz trap_with_param
  179. ;============ TRAP (no param): syscall top level
  180. ; First return from Exception to pure K mode (Exception/IRQs renabled)
  181. FAKE_RET_FROM_EXCPN
  182. ; If syscall tracing ongoing, invoke pre-post-hooks
  183. GET_CURR_THR_INFO_FLAGS r10
  184. btst r10, TIF_SYSCALL_TRACE
  185. bnz tracesys ; this never comes back
  186. ;============ Normal syscall case
  187. ; syscall num shd not exceed the total system calls avail
  188. cmp r8, NR_syscalls
  189. mov.hi r0, -ENOSYS
  190. bhi .Lret_from_system_call
  191. ; Offset into the syscall_table and call handler
  192. ld.as r9,[sys_call_table, r8]
  193. jl [r9] ; Entry into Sys Call Handler
  194. .Lret_from_system_call:
  195. st r0, [sp, PT_r0] ; sys call return value in pt_regs
  196. ; fall through to ret_from_exception
  197. END(EV_Trap)
  198. ;############# Return from Intr/Excp/Trap (Linux Specifics) ##############
  199. ;
  200. ; If ret to user mode do we need to handle signals, schedule() et al.
  201. ENTRY(ret_from_exception)
  202. ; Pre-{IRQ,Trap,Exception} K/U mode from pt_regs->status32
  203. ld r8, [sp, PT_status32] ; returning to User/Kernel Mode
  204. bbit0 r8, STATUS_U_BIT, resume_kernel_mode
  205. ; Before returning to User mode check-for-and-complete any pending work
  206. ; such as rescheduling/signal-delivery etc.
  207. resume_user_mode_begin:
  208. ; Disable IRQs to ensures that chk for pending work itself is atomic
  209. ; (and we don't end up missing a NEED_RESCHED/SIGPENDING due to an
  210. ; interim IRQ).
  211. IRQ_DISABLE r10
  212. ; Fast Path return to user mode if no pending work
  213. GET_CURR_THR_INFO_FLAGS r9
  214. and.f 0, r9, _TIF_WORK_MASK
  215. bz .Lrestore_regs
  216. ; --- (Slow Path #1) task preemption ---
  217. bbit0 r9, TIF_NEED_RESCHED, .Lchk_pend_signals
  218. mov blink, resume_user_mode_begin ; tail-call to U mode ret chks
  219. j @schedule ; BTST+Bnz causes relo error in link
  220. .Lchk_pend_signals:
  221. IRQ_ENABLE r10
  222. ; --- (Slow Path #2) pending signal ---
  223. mov r0, sp ; pt_regs for arg to do_signal()/do_notify_resume()
  224. GET_CURR_THR_INFO_FLAGS r9
  225. bbit0 r9, TIF_SIGPENDING, .Lchk_notify_resume
  226. ; Normal Trap/IRQ entry only saves Scratch (caller-saved) regs
  227. ; in pt_reg since the "C" ABI (kernel code) will automatically
  228. ; save/restore callee-saved regs.
  229. ;
  230. ; However, here we need to explicitly save callee regs because
  231. ; (i) If this signal causes coredump - full regfile needed
  232. ; (ii) If signal is SIGTRAP/SIGSTOP, task is being traced thus
  233. ; tracer might call PEEKUSR(CALLEE reg)
  234. ;
  235. ; NOTE: SP will grow up by size of CALLEE Reg-File
  236. SAVE_CALLEE_SAVED_USER ; clobbers r12
  237. ; save location of saved Callee Regs @ thread_struct->callee
  238. GET_CURR_TASK_FIELD_PTR TASK_THREAD, r10
  239. st sp, [r10, THREAD_CALLEE_REG]
  240. bl @do_signal
  241. ; Ideally we want to discard the Callee reg above, however if this was
  242. ; a tracing signal, tracer could have done a POKEUSR(CALLEE reg)
  243. RESTORE_CALLEE_SAVED_USER
  244. b resume_user_mode_begin ; loop back to start of U mode ret
  245. ; --- (Slow Path #3) notify_resume ---
  246. .Lchk_notify_resume:
  247. btst r9, TIF_NOTIFY_RESUME
  248. blnz @do_notify_resume
  249. b resume_user_mode_begin ; unconditionally back to U mode ret chks
  250. ; for single exit point from this block
  251. resume_kernel_mode:
  252. ; Disable Interrupts from this point on
  253. ; CONFIG_PREEMPT: This is a must for preempt_schedule_irq()
  254. ; !CONFIG_PREEMPT: To ensure restore_regs is intr safe
  255. IRQ_DISABLE r9
  256. #ifdef CONFIG_PREEMPT
  257. ; Can't preempt if preemption disabled
  258. GET_CURR_THR_INFO_FROM_SP r10
  259. ld r8, [r10, THREAD_INFO_PREEMPT_COUNT]
  260. brne r8, 0, .Lrestore_regs
  261. ; check if this task's NEED_RESCHED flag set
  262. ld r9, [r10, THREAD_INFO_FLAGS]
  263. bbit0 r9, TIF_NEED_RESCHED, .Lrestore_regs
  264. ; Invoke PREEMPTION
  265. jl preempt_schedule_irq
  266. ; preempt_schedule_irq() always returns with IRQ disabled
  267. #endif
  268. b .Lrestore_regs
  269. ##### DONT ADD CODE HERE - .Lrestore_regs actually follows in entry-<isa>.S