开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > 嵌入式Linux > 查看源码
rtrap.S
资源名称：SBC-2410X_kernel.tar.gz　[点击查看]
上传用户：lgb322
上传日期：2013-02-24
资源大小：30529k
文件大小：9k
源码类别：

嵌入式Linux

开发平台：

Unix_Linux

rtrap.S：源码内容
  1. /* $Id: rtrap.S,v 1.57.2.1 2001/12/24 04:32:33 davem Exp $
  2.  * rtrap.S: Preparing for return from trap on Sparc V9.
  3.  *
  4.  * Copyright (C) 1997,1998 Jakub Jelinek (jj@sunsite.mff.cuni.cz)
  5.  * Copyright (C) 1997 David S. Miller (davem@caip.rutgers.edu)
  6.  */
  8. #include <asm/asi.h>
  9. #include <asm/pstate.h>
  10. #include <asm/ptrace.h>
  11. #include <asm/spitfire.h>
  12. #include <asm/head.h>
  13. #include <asm/visasm.h>
  14. #include <asm/processor.h>
  16. #define PTREGS_OFF (STACK_BIAS + REGWIN_SZ)
  17. #define RTRAP_PSTATE (PSTATE_RMO|PSTATE_PEF|PSTATE_PRIV|PSTATE_IE)
  18. #define RTRAP_PSTATE_IRQOFF (PSTATE_RMO|PSTATE_PEF|PSTATE_PRIV)
  19. #define RTRAP_PSTATE_AG_IRQOFF (PSTATE_RMO|PSTATE_PEF|PSTATE_PRIV|PSTATE_AG)
  21. /* Register %l6 keeps track of whether we are returning
  22.  * from a system call or not.  It is cleared if we call
  23.  * do_signal, and it must not be otherwise modified until
  24.  * we fully commit to returning to userspace.
  25.  */
  27. .text
  28. .align 32
  29. __handle_softirq:
  30. call do_softirq
  31.  nop
  32. ba,a,pt %xcc, __handle_softirq_continue
  33.  nop
  34. __handle_preemption:
  35. call schedule
  36.  wrpr %g0, RTRAP_PSTATE, %pstate
  37. ba,pt %xcc, __handle_preemption_continue
  38.  wrpr %g0, RTRAP_PSTATE_IRQOFF, %pstate
  40. __handle_user_windows:
  41. call fault_in_user_windows
  42.  wrpr %g0, RTRAP_PSTATE, %pstate
  43. wrpr %g0, RTRAP_PSTATE_IRQOFF, %pstate
  44. /* Redo sched+sig checks */
  45. ldx [%g6 + AOFF_task_need_resched], %l0
  46. brz,pt %l0, 1f
  47.  nop
  48. call schedule
  50.  wrpr %g0, RTRAP_PSTATE, %pstate
  51. wrpr %g0, RTRAP_PSTATE_IRQOFF, %pstate
  52. 1: lduw [%g6 + AOFF_task_sigpending], %l0
  53. brz,pt %l0, __handle_user_windows_continue
  54.  nop
  55. clr %o0
  56. mov %l5, %o2
  57. mov %l6, %o3
  59. add %sp, STACK_BIAS + REGWIN_SZ, %o1
  60. call do_signal
  61.  wrpr %g0, RTRAP_PSTATE, %pstate
  62. wrpr %g0, RTRAP_PSTATE_IRQOFF, %pstate
  63. clr %l6
  64. /* Signal delivery can modify pt_regs tstate, so we must
  65.  * reload it.
  66.  */
  67. ldx [%sp + PTREGS_OFF + PT_V9_TSTATE], %l1
  68. sethi %hi(0xf << 20), %l4
  69. and %l1, %l4, %l4
  71. ba,pt %xcc, __handle_user_windows_continue
  72.  andn %l1, %l4, %l1
  73. __handle_perfctrs:
  74. call update_perfctrs
  75.  wrpr %g0, RTRAP_PSTATE, %pstate
  76. wrpr %g0, RTRAP_PSTATE_IRQOFF, %pstate
  77. ldub [%g6 + AOFF_task_thread + AOFF_thread_w_saved], %o2
  78. brz,pt %o2, 1f
  79.  nop
  81. /* Redo userwin+sched+sig checks */
  82. call fault_in_user_windows
  83.  wrpr %g0, RTRAP_PSTATE, %pstate
  84. wrpr %g0, RTRAP_PSTATE_IRQOFF, %pstate
  85. 1: ldx [%g6 + AOFF_task_need_resched], %l0
  86. brz,pt %l0, 1f
  87.  nop
  88. call schedule
  89.  wrpr %g0, RTRAP_PSTATE, %pstate
  91. wrpr %g0, RTRAP_PSTATE_IRQOFF, %pstate
  92. 1: lduw [%g6 + AOFF_task_sigpending], %l0
  93. brz,pt %l0, __handle_perfctrs_continue
  94.  sethi %hi(TSTATE_PEF), %o0
  95. clr %o0
  96. mov %l5, %o2
  97. mov %l6, %o3
  98. add %sp, STACK_BIAS + REGWIN_SZ, %o1
  100. call do_signal
  101.  wrpr %g0, RTRAP_PSTATE, %pstate
  102. wrpr %g0, RTRAP_PSTATE_IRQOFF, %pstate
  103. clr %l6
  104. /* Signal delivery can modify pt_regs tstate, so we must
  105.  * reload it.
  106.  */
  107. ldx [%sp + PTREGS_OFF + PT_V9_TSTATE], %l1
  108. sethi %hi(0xf << 20), %l4
  109. and %l1, %l4, %l4
  110. andn %l1, %l4, %l1
  112. ba,pt %xcc, __handle_perfctrs_continue
  113.  sethi %hi(TSTATE_PEF), %o0
  114. __handle_userfpu:
  115. rd %fprs, %l5
  116. andcc %l5, FPRS_FEF, %g0
  117. sethi %hi(TSTATE_PEF), %o0
  118. be,a,pn %icc, __handle_userfpu_continue
  119.  andn %l1, %o0, %l1
  120. ba,a,pt %xcc, __handle_userfpu_continue
  122. __handle_signal:
  123. clr %o0
  124. mov %l5, %o2
  125. mov %l6, %o3
  126. add %sp, STACK_BIAS + REGWIN_SZ, %o1
  127. call do_signal
  128.  wrpr %g0, RTRAP_PSTATE, %pstate
  129. wrpr %g0, RTRAP_PSTATE_IRQOFF, %pstate
  130. clr %l6
  132. /* Signal delivery can modify pt_regs tstate, so we must
  133.  * reload it.
  134.  */
  135. ldx [%sp + PTREGS_OFF + PT_V9_TSTATE], %l1
  136. sethi %hi(0xf << 20), %l4
  137. and %l1, %l4, %l4
  138. ba,pt %xcc, __handle_signal_continue
  139.  andn %l1, %l4, %l1
  141. .align 64
  142. .globl rtrap_clr_l6, rtrap, irqsz_patchme
  143. rtrap_clr_l6: clr %l6
  144. rtrap: lduw [%g6 + AOFF_task_processor], %l0
  145. sethi %hi(irq_stat), %l2 ! &softirq_active
  146. or %l2, %lo(irq_stat), %l2 ! &softirq_active
  147. irqsz_patchme: sllx %l0, 0, %l0
  148. lduw [%l2 + %l0], %l1 ! softirq_pending
  149. cmp %l1, 0
  151. bne,pn %icc, __handle_softirq
  152.  ldx [%sp + PTREGS_OFF + PT_V9_TSTATE], %l1
  153. __handle_softirq_continue:
  154. sethi %hi(0xf << 20), %l4
  155. andcc %l1, TSTATE_PRIV, %l3
  156. and %l1, %l4, %l4
  157. bne,pn %icc, to_kernel
  158.  andn %l1, %l4, %l1
  160. /* We must hold IRQs off and atomically test schedule+signal
  161.  * state, then hold them off all the way back to userspace.
  162.  * If we are returning to kernel, none of this matters.
  163.  *
  164.  * If we do not do this, there is a window where we would do
  165.  * the tests, later the signal/resched event arrives but we do
  166.  * not process it since we are still in kernel mode.  It would
  167.  * take until the next local IRQ before the signal/resched
  168.  * event would be handled.
  169.  *
  170.  * This also means that if we have to deal with performance
  171.  * counters or user windows, we have to redo all of these
  172.  * sched+signal checks with IRQs disabled.
  173.  */
  174. to_user: wrpr %g0, RTRAP_PSTATE_IRQOFF, %pstate
  175. __handle_preemption_continue:
  176. ldx [%g6 + AOFF_task_need_resched], %l0
  177. brnz,pn %l0, __handle_preemption
  178.  lduw [%g6 + AOFF_task_sigpending], %l0
  179. brnz,pn %l0, __handle_signal
  180.  nop
  181. __handle_signal_continue:
  182. ldub [%g6 + AOFF_task_thread + AOFF_thread_w_saved], %o2
  183. brnz,pn %o2, __handle_user_windows
  184.  nop
  185. __handle_user_windows_continue:
  186. ldub [%g6 + AOFF_task_thread + AOFF_thread_flags], %l5
  187. andcc %l5, SPARC_FLAG_PERFCTR, %g0
  188. sethi %hi(TSTATE_PEF), %o0
  189. bne,pn %xcc, __handle_perfctrs
  190. __handle_perfctrs_continue:
  191.  andcc %l1, %o0, %g0
  193. /* This fpdepth clear is neccessary for non-syscall rtraps only */
  194. bne,pn %xcc, __handle_userfpu
  195.  stb %g0, [%g6 + AOFF_task_thread + AOFF_thread_fpdepth]
  196. __handle_userfpu_continue:
  198. rt_continue: ldx [%sp + PTREGS_OFF + PT_V9_G1], %g1
  199. ldx [%sp + PTREGS_OFF + PT_V9_G2], %g2
  201. ldx [%sp + PTREGS_OFF + PT_V9_G3], %g3
  202. ldx [%sp + PTREGS_OFF + PT_V9_G4], %g4
  203. ldx [%sp + PTREGS_OFF + PT_V9_G5], %g5
  204. ldx [%sp + PTREGS_OFF + PT_V9_G6], %g6
  205. ldx [%sp + PTREGS_OFF + PT_V9_G7], %g7
  206. wrpr %g0, RTRAP_PSTATE_AG_IRQOFF, %pstate
  207. ldx [%sp + PTREGS_OFF + PT_V9_I0], %i0
  208. ldx [%sp + PTREGS_OFF + PT_V9_I1], %i1
  210. ldx [%sp + PTREGS_OFF + PT_V9_I2], %i2
  211. ldx [%sp + PTREGS_OFF + PT_V9_I3], %i3
  212. ldx [%sp + PTREGS_OFF + PT_V9_I4], %i4
  213. ldx [%sp + PTREGS_OFF + PT_V9_I5], %i5
  214. ldx [%sp + PTREGS_OFF + PT_V9_I6], %i6
  215. ldx [%sp + PTREGS_OFF + PT_V9_I7], %i7
  216. ldx [%sp + PTREGS_OFF + PT_V9_TPC], %l2
  217. ldx [%sp + PTREGS_OFF + PT_V9_TNPC], %o2
  219. ld [%sp + PTREGS_OFF + PT_V9_Y], %o3
  220. wr %o3, %g0, %y
  221. srl %l4, 20, %l4
  222. wrpr %l4, 0x0, %pil
  223. wrpr %g0, 0x1, %tl
  224. wrpr %l1, %g0, %tstate
  225. wrpr %l2, %g0, %tpc
  226. wrpr %o2, %g0, %tnpc
  228. brnz,pn %l3, kern_rtt
  229.  mov PRIMARY_CONTEXT, %l7
  230. ldxa [%l7 + %l7] ASI_DMMU, %l0
  231. stxa %l0, [%l7] ASI_DMMU
  232. flush %g6
  233. rdpr %wstate, %l1
  234. rdpr %otherwin, %l2
  235. srl %l1, 3, %l1
  237. wrpr %l2, %g0, %canrestore
  238. wrpr %l1, %g0, %wstate
  239. wrpr %g0, %g0, %otherwin
  240. restore
  241. rdpr %canrestore, %g1
  242. wrpr %g1, 0x0, %cleanwin
  243. retry
  244. nop
  246. kern_rtt: restore
  247. retry
  248. to_kernel: ldub [%g6 + AOFF_task_thread + AOFF_thread_fpdepth], %l5
  249. brz,pt %l5, rt_continue
  250.  srl %l5, 1, %o0
  251. add %g6, AOFF_task_thread + AOFF_thread_fpsaved, %l6
  252. ldub [%l6 + %o0], %l2
  253. sub %l5, 2, %l5
  255. add %g6, AOFF_task_thread + AOFF_thread_gsr, %o1
  256. andcc %l2, (FPRS_FEF|FPRS_DU), %g0
  257. be,pt %icc, 2f
  258.  and %l2, FPRS_DL, %l6
  259. andcc %l2, FPRS_FEF, %g0
  260. be,pn %icc, 5f
  261.  sll %o0, 3, %o5
  262. rd %fprs, %g5
  264. wr %g5, FPRS_FEF, %fprs
  265. ldx [%o1 + %o5], %g5
  266. add %g6, AOFF_task_thread + AOFF_thread_xfsr, %o1
  267. membar #StoreLoad | #LoadLoad
  268. sll %o0, 8, %o2
  269. add %g6, AOFF_task_fpregs, %o3
  270. brz,pn %l6, 1f
  271.  add %g6, AOFF_task_fpregs+0x40, %o4
  273. ldda [%o3 + %o2] ASI_BLK_P, %f0
  274. ldda [%o4 + %o2] ASI_BLK_P, %f16
  275. 1: andcc %l2, FPRS_DU, %g0
  276. be,pn %icc, 1f
  277.  wr %g5, 0, %gsr
  278. add %o2, 0x80, %o2
  279. ldda [%o3 + %o2] ASI_BLK_P, %f32
  280. ldda [%o4 + %o2] ASI_BLK_P, %f48
  282. 1: membar #Sync
  283. ldx [%o1 + %o5], %fsr
  284. 2: stb %l5, [%g6 + AOFF_task_thread + AOFF_thread_fpdepth]
  285. ba,pt %xcc, rt_continue
  286.  nop
  287. 5: wr %g0, FPRS_FEF, %fprs
  288. membar #StoreLoad | #LoadLoad
  289. sll %o0, 8, %o2
  291. add %g6, AOFF_task_fpregs+0x80, %o3
  292. add %g6, AOFF_task_fpregs+0xc0, %o4
  293. ldda [%o3 + %o2] ASI_BLK_P, %f32
  294. ldda [%o4 + %o2] ASI_BLK_P, %f48
  295. membar #Sync
  296. wr %g0, FPRS_DU, %fprs
  297. ba,pt %xcc, rt_continue
  298.  stb %l5, [%g6 + AOFF_task_thread + AOFF_thread_fpdepth]
  300. #undef PTREGS_OFF