entry64.S 31 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078
  1. /*
  2. * arch/s390/kernel/entry64.S
  3. * S390 low-level entry points.
  4. *
  5. * Copyright (C) IBM Corp. 1999,2006
  6. * Author(s): Martin Schwidefsky (schwidefsky@de.ibm.com),
  7. * Hartmut Penner (hp@de.ibm.com),
  8. * Denis Joseph Barrow (djbarrow@de.ibm.com,barrow_dj@yahoo.com),
  9. * Heiko Carstens <heiko.carstens@de.ibm.com>
  10. */
  11. #include <linux/sys.h>
  12. #include <linux/linkage.h>
  13. #include <linux/init.h>
  14. #include <asm/cache.h>
  15. #include <asm/lowcore.h>
  16. #include <asm/errno.h>
  17. #include <asm/ptrace.h>
  18. #include <asm/thread_info.h>
  19. #include <asm/asm-offsets.h>
  20. #include <asm/unistd.h>
  21. #include <asm/page.h>
  22. /*
  23. * Stack layout for the system_call stack entry.
  24. * The first few entries are identical to the user_regs_struct.
  25. */
  26. SP_PTREGS = STACK_FRAME_OVERHEAD
  27. SP_ARGS = STACK_FRAME_OVERHEAD + __PT_ARGS
  28. SP_PSW = STACK_FRAME_OVERHEAD + __PT_PSW
  29. SP_R0 = STACK_FRAME_OVERHEAD + __PT_GPRS
  30. SP_R1 = STACK_FRAME_OVERHEAD + __PT_GPRS + 8
  31. SP_R2 = STACK_FRAME_OVERHEAD + __PT_GPRS + 16
  32. SP_R3 = STACK_FRAME_OVERHEAD + __PT_GPRS + 24
  33. SP_R4 = STACK_FRAME_OVERHEAD + __PT_GPRS + 32
  34. SP_R5 = STACK_FRAME_OVERHEAD + __PT_GPRS + 40
  35. SP_R6 = STACK_FRAME_OVERHEAD + __PT_GPRS + 48
  36. SP_R7 = STACK_FRAME_OVERHEAD + __PT_GPRS + 56
  37. SP_R8 = STACK_FRAME_OVERHEAD + __PT_GPRS + 64
  38. SP_R9 = STACK_FRAME_OVERHEAD + __PT_GPRS + 72
  39. SP_R10 = STACK_FRAME_OVERHEAD + __PT_GPRS + 80
  40. SP_R11 = STACK_FRAME_OVERHEAD + __PT_GPRS + 88
  41. SP_R12 = STACK_FRAME_OVERHEAD + __PT_GPRS + 96
  42. SP_R13 = STACK_FRAME_OVERHEAD + __PT_GPRS + 104
  43. SP_R14 = STACK_FRAME_OVERHEAD + __PT_GPRS + 112
  44. SP_R15 = STACK_FRAME_OVERHEAD + __PT_GPRS + 120
  45. SP_ORIG_R2 = STACK_FRAME_OVERHEAD + __PT_ORIG_GPR2
  46. SP_ILC = STACK_FRAME_OVERHEAD + __PT_ILC
  47. SP_SVCNR = STACK_FRAME_OVERHEAD + __PT_SVCNR
  48. SP_SIZE = STACK_FRAME_OVERHEAD + __PT_SIZE
  49. STACK_SHIFT = PAGE_SHIFT + THREAD_ORDER
  50. STACK_SIZE = 1 << STACK_SHIFT
  51. _TIF_WORK_SVC = (_TIF_SIGPENDING | _TIF_NOTIFY_RESUME | _TIF_NEED_RESCHED | \
  52. _TIF_MCCK_PENDING | _TIF_RESTART_SVC | _TIF_SINGLE_STEP )
  53. _TIF_WORK_INT = (_TIF_SIGPENDING | _TIF_NOTIFY_RESUME | _TIF_NEED_RESCHED | \
  54. _TIF_MCCK_PENDING)
  55. _TIF_SYSCALL = (_TIF_SYSCALL_TRACE>>8 | _TIF_SYSCALL_AUDIT>>8 | \
  56. _TIF_SECCOMP>>8 | _TIF_SYSCALL_TRACEPOINT>>8)
  57. #define BASED(name) name-system_call(%r13)
  58. #ifdef CONFIG_TRACE_IRQFLAGS
  59. .macro TRACE_IRQS_ON
  60. basr %r2,%r0
  61. brasl %r14,trace_hardirqs_on_caller
  62. .endm
  63. .macro TRACE_IRQS_OFF
  64. basr %r2,%r0
  65. brasl %r14,trace_hardirqs_off_caller
  66. .endm
  67. .macro TRACE_IRQS_CHECK
  68. basr %r2,%r0
  69. tm SP_PSW(%r15),0x03 # irqs enabled?
  70. jz 0f
  71. brasl %r14,trace_hardirqs_on_caller
  72. j 1f
  73. 0: brasl %r14,trace_hardirqs_off_caller
  74. 1:
  75. .endm
  76. #else
  77. #define TRACE_IRQS_ON
  78. #define TRACE_IRQS_OFF
  79. #define TRACE_IRQS_CHECK
  80. #endif
  81. #ifdef CONFIG_LOCKDEP
  82. .macro LOCKDEP_SYS_EXIT
  83. tm SP_PSW+1(%r15),0x01 # returning to user ?
  84. jz 0f
  85. brasl %r14,lockdep_sys_exit
  86. 0:
  87. .endm
  88. #else
  89. #define LOCKDEP_SYS_EXIT
  90. #endif
  91. .macro UPDATE_VTIME lc_from,lc_to,lc_sum
  92. lg %r10,\lc_from
  93. slg %r10,\lc_to
  94. alg %r10,\lc_sum
  95. stg %r10,\lc_sum
  96. .endm
  97. /*
  98. * Register usage in interrupt handlers:
  99. * R9 - pointer to current task structure
  100. * R13 - pointer to literal pool
  101. * R14 - return register for function calls
  102. * R15 - kernel stack pointer
  103. */
  104. .macro SAVE_ALL_BASE savearea
  105. stmg %r12,%r15,\savearea
  106. larl %r13,system_call
  107. .endm
  108. .macro SAVE_ALL_SVC psworg,savearea
  109. la %r12,\psworg
  110. lg %r15,__LC_KERNEL_STACK # problem state -> load ksp
  111. .endm
  112. .macro SAVE_ALL_SYNC psworg,savearea
  113. la %r12,\psworg
  114. tm \psworg+1,0x01 # test problem state bit
  115. jz 2f # skip stack setup save
  116. lg %r15,__LC_KERNEL_STACK # problem state -> load ksp
  117. #ifdef CONFIG_CHECK_STACK
  118. j 3f
  119. 2: tml %r15,STACK_SIZE - CONFIG_STACK_GUARD
  120. jz stack_overflow
  121. 3:
  122. #endif
  123. 2:
  124. .endm
  125. .macro SAVE_ALL_ASYNC psworg,savearea
  126. la %r12,\psworg
  127. tm \psworg+1,0x01 # test problem state bit
  128. jnz 1f # from user -> load kernel stack
  129. clc \psworg+8(8),BASED(.Lcritical_end)
  130. jhe 0f
  131. clc \psworg+8(8),BASED(.Lcritical_start)
  132. jl 0f
  133. brasl %r14,cleanup_critical
  134. tm 1(%r12),0x01 # retest problem state after cleanup
  135. jnz 1f
  136. 0: lg %r14,__LC_ASYNC_STACK # are we already on the async. stack ?
  137. slgr %r14,%r15
  138. srag %r14,%r14,STACK_SHIFT
  139. jz 2f
  140. 1: lg %r15,__LC_ASYNC_STACK # load async stack
  141. #ifdef CONFIG_CHECK_STACK
  142. j 3f
  143. 2: tml %r15,STACK_SIZE - CONFIG_STACK_GUARD
  144. jz stack_overflow
  145. 3:
  146. #endif
  147. 2:
  148. .endm
  149. .macro CREATE_STACK_FRAME psworg,savearea
  150. aghi %r15,-SP_SIZE # make room for registers & psw
  151. mvc SP_PSW(16,%r15),0(%r12) # move user PSW to stack
  152. stg %r2,SP_ORIG_R2(%r15) # store original content of gpr 2
  153. icm %r12,3,__LC_SVC_ILC
  154. stmg %r0,%r11,SP_R0(%r15) # store gprs %r0-%r11 to kernel stack
  155. st %r12,SP_SVCNR(%r15)
  156. mvc SP_R12(32,%r15),\savearea # move %r12-%r15 to stack
  157. la %r12,0
  158. stg %r12,__SF_BACKCHAIN(%r15)
  159. .endm
  160. .macro RESTORE_ALL psworg,sync
  161. mvc \psworg(16),SP_PSW(%r15) # move user PSW to lowcore
  162. .if !\sync
  163. ni \psworg+1,0xfd # clear wait state bit
  164. .endif
  165. lg %r14,__LC_VDSO_PER_CPU
  166. lmg %r0,%r13,SP_R0(%r15) # load gprs 0-13 of user
  167. stpt __LC_EXIT_TIMER
  168. mvc __VDSO_ECTG_BASE(16,%r14),__LC_EXIT_TIMER
  169. lmg %r14,%r15,SP_R14(%r15) # load grps 14-15 of user
  170. lpswe \psworg # back to caller
  171. .endm
  172. /*
  173. * Scheduler resume function, called by switch_to
  174. * gpr2 = (task_struct *) prev
  175. * gpr3 = (task_struct *) next
  176. * Returns:
  177. * gpr2 = prev
  178. */
  179. .globl __switch_to
  180. __switch_to:
  181. tm __THREAD_per+4(%r3),0xe8 # is the new process using per ?
  182. jz __switch_to_noper # if not we're fine
  183. stctg %c9,%c11,__SF_EMPTY(%r15)# We are using per stuff
  184. clc __THREAD_per(24,%r3),__SF_EMPTY(%r15)
  185. je __switch_to_noper # we got away without bashing TLB's
  186. lctlg %c9,%c11,__THREAD_per(%r3) # Nope we didn't
  187. __switch_to_noper:
  188. lg %r4,__THREAD_info(%r2) # get thread_info of prev
  189. tm __TI_flags+7(%r4),_TIF_MCCK_PENDING # machine check pending?
  190. jz __switch_to_no_mcck
  191. ni __TI_flags+7(%r4),255-_TIF_MCCK_PENDING # clear flag in prev
  192. lg %r4,__THREAD_info(%r3) # get thread_info of next
  193. oi __TI_flags+7(%r4),_TIF_MCCK_PENDING # set it in next
  194. __switch_to_no_mcck:
  195. stmg %r6,%r15,__SF_GPRS(%r15)# store __switch_to registers of prev task
  196. stg %r15,__THREAD_ksp(%r2) # store kernel stack to prev->tss.ksp
  197. lg %r15,__THREAD_ksp(%r3) # load kernel stack from next->tss.ksp
  198. lmg %r6,%r15,__SF_GPRS(%r15)# load __switch_to registers of next task
  199. stg %r3,__LC_CURRENT # __LC_CURRENT = current task struct
  200. lctl %c4,%c4,__TASK_pid(%r3) # load pid to control reg. 4
  201. lg %r3,__THREAD_info(%r3) # load thread_info from task struct
  202. stg %r3,__LC_THREAD_INFO
  203. aghi %r3,STACK_SIZE
  204. stg %r3,__LC_KERNEL_STACK # __LC_KERNEL_STACK = new kernel stack
  205. br %r14
  206. __critical_start:
  207. /*
  208. * SVC interrupt handler routine. System calls are synchronous events and
  209. * are executed with interrupts enabled.
  210. */
  211. .globl system_call
  212. system_call:
  213. stpt __LC_SYNC_ENTER_TIMER
  214. sysc_saveall:
  215. SAVE_ALL_BASE __LC_SAVE_AREA
  216. SAVE_ALL_SVC __LC_SVC_OLD_PSW,__LC_SAVE_AREA
  217. CREATE_STACK_FRAME __LC_SVC_OLD_PSW,__LC_SAVE_AREA
  218. llgh %r7,__LC_SVC_INT_CODE # get svc number from lowcore
  219. sysc_vtime:
  220. UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
  221. sysc_stime:
  222. UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
  223. sysc_update:
  224. mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
  225. sysc_do_svc:
  226. lg %r9,__LC_THREAD_INFO # load pointer to thread_info struct
  227. ltgr %r7,%r7 # test for svc 0
  228. jnz sysc_nr_ok
  229. # svc 0: system call number in %r1
  230. cl %r1,BASED(.Lnr_syscalls)
  231. jnl sysc_nr_ok
  232. lgfr %r7,%r1 # clear high word in r1
  233. sysc_nr_ok:
  234. mvc SP_ARGS(8,%r15),SP_R7(%r15)
  235. sysc_do_restart:
  236. sth %r7,SP_SVCNR(%r15)
  237. sllg %r7,%r7,2 # svc number * 4
  238. larl %r10,sys_call_table
  239. #ifdef CONFIG_COMPAT
  240. tm __TI_flags+5(%r9),(_TIF_31BIT>>16) # running in 31 bit mode ?
  241. jno sysc_noemu
  242. larl %r10,sys_call_table_emu # use 31 bit emulation system calls
  243. sysc_noemu:
  244. #endif
  245. tm __TI_flags+6(%r9),_TIF_SYSCALL
  246. lgf %r8,0(%r7,%r10) # load address of system call routine
  247. jnz sysc_tracesys
  248. basr %r14,%r8 # call sys_xxxx
  249. stg %r2,SP_R2(%r15) # store return value (change R2 on stack)
  250. sysc_return:
  251. tm __TI_flags+7(%r9),_TIF_WORK_SVC
  252. jnz sysc_work # there is work to do (signals etc.)
  253. sysc_restore:
  254. #ifdef CONFIG_TRACE_IRQFLAGS
  255. larl %r1,sysc_restore_trace_psw
  256. lpswe 0(%r1)
  257. sysc_restore_trace:
  258. TRACE_IRQS_CHECK
  259. LOCKDEP_SYS_EXIT
  260. #endif
  261. sysc_leave:
  262. RESTORE_ALL __LC_RETURN_PSW,1
  263. sysc_done:
  264. #ifdef CONFIG_TRACE_IRQFLAGS
  265. .section .data,"aw",@progbits
  266. .align 8
  267. .globl sysc_restore_trace_psw
  268. sysc_restore_trace_psw:
  269. .quad 0, sysc_restore_trace
  270. .previous
  271. #endif
  272. #
  273. # recheck if there is more work to do
  274. #
  275. sysc_work_loop:
  276. tm __TI_flags+7(%r9),_TIF_WORK_SVC
  277. jz sysc_restore # there is no work to do
  278. #
  279. # One of the work bits is on. Find out which one.
  280. #
  281. sysc_work:
  282. tm SP_PSW+1(%r15),0x01 # returning to user ?
  283. jno sysc_restore
  284. tm __TI_flags+7(%r9),_TIF_MCCK_PENDING
  285. jo sysc_mcck_pending
  286. tm __TI_flags+7(%r9),_TIF_NEED_RESCHED
  287. jo sysc_reschedule
  288. tm __TI_flags+7(%r9),_TIF_SIGPENDING
  289. jnz sysc_sigpending
  290. tm __TI_flags+7(%r9),_TIF_NOTIFY_RESUME
  291. jnz sysc_notify_resume
  292. tm __TI_flags+7(%r9),_TIF_RESTART_SVC
  293. jo sysc_restart
  294. tm __TI_flags+7(%r9),_TIF_SINGLE_STEP
  295. jo sysc_singlestep
  296. j sysc_restore
  297. sysc_work_done:
  298. #
  299. # _TIF_NEED_RESCHED is set, call schedule
  300. #
  301. sysc_reschedule:
  302. larl %r14,sysc_work_loop
  303. jg schedule # return point is sysc_return
  304. #
  305. # _TIF_MCCK_PENDING is set, call handler
  306. #
  307. sysc_mcck_pending:
  308. larl %r14,sysc_work_loop
  309. jg s390_handle_mcck # TIF bit will be cleared by handler
  310. #
  311. # _TIF_SIGPENDING is set, call do_signal
  312. #
  313. sysc_sigpending:
  314. ni __TI_flags+7(%r9),255-_TIF_SINGLE_STEP # clear TIF_SINGLE_STEP
  315. la %r2,SP_PTREGS(%r15) # load pt_regs
  316. brasl %r14,do_signal # call do_signal
  317. tm __TI_flags+7(%r9),_TIF_RESTART_SVC
  318. jo sysc_restart
  319. tm __TI_flags+7(%r9),_TIF_SINGLE_STEP
  320. jo sysc_singlestep
  321. j sysc_work_loop
  322. #
  323. # _TIF_NOTIFY_RESUME is set, call do_notify_resume
  324. #
  325. sysc_notify_resume:
  326. la %r2,SP_PTREGS(%r15) # load pt_regs
  327. larl %r14,sysc_work_loop
  328. jg do_notify_resume # call do_notify_resume
  329. #
  330. # _TIF_RESTART_SVC is set, set up registers and restart svc
  331. #
  332. sysc_restart:
  333. ni __TI_flags+7(%r9),255-_TIF_RESTART_SVC # clear TIF_RESTART_SVC
  334. lg %r7,SP_R2(%r15) # load new svc number
  335. mvc SP_R2(8,%r15),SP_ORIG_R2(%r15) # restore first argument
  336. lmg %r2,%r6,SP_R2(%r15) # load svc arguments
  337. j sysc_do_restart # restart svc
  338. #
  339. # _TIF_SINGLE_STEP is set, call do_single_step
  340. #
  341. sysc_singlestep:
  342. ni __TI_flags+7(%r9),255-_TIF_SINGLE_STEP # clear TIF_SINGLE_STEP
  343. xc SP_SVCNR(2,%r15),SP_SVCNR(%r15) # clear svc number
  344. la %r2,SP_PTREGS(%r15) # address of register-save area
  345. larl %r14,sysc_return # load adr. of system return
  346. jg do_single_step # branch to do_sigtrap
  347. #
  348. # call tracehook_report_syscall_entry/tracehook_report_syscall_exit before
  349. # and after the system call
  350. #
  351. sysc_tracesys:
  352. la %r2,SP_PTREGS(%r15) # load pt_regs
  353. la %r3,0
  354. srl %r7,2
  355. stg %r7,SP_R2(%r15)
  356. brasl %r14,do_syscall_trace_enter
  357. lghi %r0,NR_syscalls
  358. clgr %r0,%r2
  359. jnh sysc_tracenogo
  360. sllg %r7,%r2,2 # svc number *4
  361. lgf %r8,0(%r7,%r10)
  362. sysc_tracego:
  363. lmg %r3,%r6,SP_R3(%r15)
  364. lg %r2,SP_ORIG_R2(%r15)
  365. basr %r14,%r8 # call sys_xxx
  366. stg %r2,SP_R2(%r15) # store return value
  367. sysc_tracenogo:
  368. tm __TI_flags+6(%r9),_TIF_SYSCALL
  369. jz sysc_return
  370. la %r2,SP_PTREGS(%r15) # load pt_regs
  371. larl %r14,sysc_return # return point is sysc_return
  372. jg do_syscall_trace_exit
  373. #
  374. # a new process exits the kernel with ret_from_fork
  375. #
  376. .globl ret_from_fork
  377. ret_from_fork:
  378. lg %r13,__LC_SVC_NEW_PSW+8
  379. lg %r9,__LC_THREAD_INFO # load pointer to thread_info struct
  380. tm SP_PSW+1(%r15),0x01 # forking a kernel thread ?
  381. jo 0f
  382. stg %r15,SP_R15(%r15) # store stack pointer for new kthread
  383. 0: brasl %r14,schedule_tail
  384. TRACE_IRQS_ON
  385. stosm 24(%r15),0x03 # reenable interrupts
  386. j sysc_tracenogo
  387. #
  388. # kernel_execve function needs to deal with pt_regs that is not
  389. # at the usual place
  390. #
  391. .globl kernel_execve
  392. kernel_execve:
  393. stmg %r12,%r15,96(%r15)
  394. lgr %r14,%r15
  395. aghi %r15,-SP_SIZE
  396. stg %r14,__SF_BACKCHAIN(%r15)
  397. la %r12,SP_PTREGS(%r15)
  398. xc 0(__PT_SIZE,%r12),0(%r12)
  399. lgr %r5,%r12
  400. brasl %r14,do_execve
  401. ltgfr %r2,%r2
  402. je 0f
  403. aghi %r15,SP_SIZE
  404. lmg %r12,%r15,96(%r15)
  405. br %r14
  406. # execve succeeded.
  407. 0: stnsm __SF_EMPTY(%r15),0xfc # disable interrupts
  408. lg %r15,__LC_KERNEL_STACK # load ksp
  409. aghi %r15,-SP_SIZE # make room for registers & psw
  410. lg %r13,__LC_SVC_NEW_PSW+8
  411. lg %r9,__LC_THREAD_INFO
  412. mvc SP_PTREGS(__PT_SIZE,%r15),0(%r12) # copy pt_regs
  413. xc __SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
  414. stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
  415. brasl %r14,execve_tail
  416. j sysc_return
  417. /*
  418. * Program check handler routine
  419. */
  420. .globl pgm_check_handler
  421. pgm_check_handler:
  422. /*
  423. * First we need to check for a special case:
  424. * Single stepping an instruction that disables the PER event mask will
  425. * cause a PER event AFTER the mask has been set. Example: SVC or LPSW.
  426. * For a single stepped SVC the program check handler gets control after
  427. * the SVC new PSW has been loaded. But we want to execute the SVC first and
  428. * then handle the PER event. Therefore we update the SVC old PSW to point
  429. * to the pgm_check_handler and branch to the SVC handler after we checked
  430. * if we have to load the kernel stack register.
  431. * For every other possible cause for PER event without the PER mask set
  432. * we just ignore the PER event (FIXME: is there anything we have to do
  433. * for LPSW?).
  434. */
  435. stpt __LC_SYNC_ENTER_TIMER
  436. SAVE_ALL_BASE __LC_SAVE_AREA
  437. tm __LC_PGM_INT_CODE+1,0x80 # check whether we got a per exception
  438. jnz pgm_per # got per exception -> special case
  439. SAVE_ALL_SYNC __LC_PGM_OLD_PSW,__LC_SAVE_AREA
  440. CREATE_STACK_FRAME __LC_PGM_OLD_PSW,__LC_SAVE_AREA
  441. tm SP_PSW+1(%r15),0x01 # interrupting from user ?
  442. jz pgm_no_vtime
  443. UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
  444. UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
  445. mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
  446. pgm_no_vtime:
  447. lg %r9,__LC_THREAD_INFO # load pointer to thread_info struct
  448. mvc SP_ARGS(8,%r15),__LC_LAST_BREAK
  449. TRACE_IRQS_OFF
  450. lgf %r3,__LC_PGM_ILC # load program interruption code
  451. lghi %r8,0x7f
  452. ngr %r8,%r3
  453. pgm_do_call:
  454. sll %r8,3
  455. larl %r1,pgm_check_table
  456. lg %r1,0(%r8,%r1) # load address of handler routine
  457. la %r2,SP_PTREGS(%r15) # address of register-save area
  458. larl %r14,sysc_return
  459. br %r1 # branch to interrupt-handler
  460. #
  461. # handle per exception
  462. #
  463. pgm_per:
  464. tm __LC_PGM_OLD_PSW,0x40 # test if per event recording is on
  465. jnz pgm_per_std # ok, normal per event from user space
  466. # ok its one of the special cases, now we need to find out which one
  467. clc __LC_PGM_OLD_PSW(16),__LC_SVC_NEW_PSW
  468. je pgm_svcper
  469. # no interesting special case, ignore PER event
  470. lmg %r12,%r15,__LC_SAVE_AREA
  471. lpswe __LC_PGM_OLD_PSW
  472. #
  473. # Normal per exception
  474. #
  475. pgm_per_std:
  476. SAVE_ALL_SYNC __LC_PGM_OLD_PSW,__LC_SAVE_AREA
  477. CREATE_STACK_FRAME __LC_PGM_OLD_PSW,__LC_SAVE_AREA
  478. tm SP_PSW+1(%r15),0x01 # interrupting from user ?
  479. jz pgm_no_vtime2
  480. UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
  481. UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
  482. mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
  483. pgm_no_vtime2:
  484. lg %r9,__LC_THREAD_INFO # load pointer to thread_info struct
  485. TRACE_IRQS_OFF
  486. lg %r1,__TI_task(%r9)
  487. tm SP_PSW+1(%r15),0x01 # kernel per event ?
  488. jz kernel_per
  489. mvc __THREAD_per+__PER_atmid(2,%r1),__LC_PER_ATMID
  490. mvc __THREAD_per+__PER_address(8,%r1),__LC_PER_ADDRESS
  491. mvc __THREAD_per+__PER_access_id(1,%r1),__LC_PER_ACCESS_ID
  492. oi __TI_flags+7(%r9),_TIF_SINGLE_STEP # set TIF_SINGLE_STEP
  493. lgf %r3,__LC_PGM_ILC # load program interruption code
  494. lghi %r8,0x7f
  495. ngr %r8,%r3 # clear per-event-bit and ilc
  496. je sysc_return
  497. j pgm_do_call
  498. #
  499. # it was a single stepped SVC that is causing all the trouble
  500. #
  501. pgm_svcper:
  502. SAVE_ALL_SYNC __LC_SVC_OLD_PSW,__LC_SAVE_AREA
  503. CREATE_STACK_FRAME __LC_SVC_OLD_PSW,__LC_SAVE_AREA
  504. UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
  505. UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
  506. mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
  507. llgh %r7,__LC_SVC_INT_CODE # get svc number from lowcore
  508. lg %r9,__LC_THREAD_INFO # load pointer to thread_info struct
  509. lg %r1,__TI_task(%r9)
  510. mvc __THREAD_per+__PER_atmid(2,%r1),__LC_PER_ATMID
  511. mvc __THREAD_per+__PER_address(8,%r1),__LC_PER_ADDRESS
  512. mvc __THREAD_per+__PER_access_id(1,%r1),__LC_PER_ACCESS_ID
  513. oi __TI_flags+7(%r9),_TIF_SINGLE_STEP # set TIF_SINGLE_STEP
  514. TRACE_IRQS_ON
  515. stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
  516. j sysc_do_svc
  517. #
  518. # per was called from kernel, must be kprobes
  519. #
  520. kernel_per:
  521. xc SP_SVCNR(2,%r15),SP_SVCNR(%r15) # clear svc number
  522. la %r2,SP_PTREGS(%r15) # address of register-save area
  523. larl %r14,sysc_restore # load adr. of system ret, no work
  524. jg do_single_step # branch to do_single_step
  525. /*
  526. * IO interrupt handler routine
  527. */
  528. .globl io_int_handler
  529. io_int_handler:
  530. stck __LC_INT_CLOCK
  531. stpt __LC_ASYNC_ENTER_TIMER
  532. SAVE_ALL_BASE __LC_SAVE_AREA+32
  533. SAVE_ALL_ASYNC __LC_IO_OLD_PSW,__LC_SAVE_AREA+32
  534. CREATE_STACK_FRAME __LC_IO_OLD_PSW,__LC_SAVE_AREA+32
  535. tm SP_PSW+1(%r15),0x01 # interrupting from user ?
  536. jz io_no_vtime
  537. UPDATE_VTIME __LC_EXIT_TIMER,__LC_ASYNC_ENTER_TIMER,__LC_USER_TIMER
  538. UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
  539. mvc __LC_LAST_UPDATE_TIMER(8),__LC_ASYNC_ENTER_TIMER
  540. io_no_vtime:
  541. lg %r9,__LC_THREAD_INFO # load pointer to thread_info struct
  542. TRACE_IRQS_OFF
  543. la %r2,SP_PTREGS(%r15) # address of register-save area
  544. brasl %r14,do_IRQ # call standard irq handler
  545. io_return:
  546. tm __TI_flags+7(%r9),_TIF_WORK_INT
  547. jnz io_work # there is work to do (signals etc.)
  548. io_restore:
  549. #ifdef CONFIG_TRACE_IRQFLAGS
  550. larl %r1,io_restore_trace_psw
  551. lpswe 0(%r1)
  552. io_restore_trace:
  553. TRACE_IRQS_CHECK
  554. LOCKDEP_SYS_EXIT
  555. #endif
  556. io_leave:
  557. RESTORE_ALL __LC_RETURN_PSW,0
  558. io_done:
  559. #ifdef CONFIG_TRACE_IRQFLAGS
  560. .section .data,"aw",@progbits
  561. .align 8
  562. .globl io_restore_trace_psw
  563. io_restore_trace_psw:
  564. .quad 0, io_restore_trace
  565. .previous
  566. #endif
  567. #
  568. # There is work todo, we need to check if we return to userspace, then
  569. # check, if we are in SIE, if yes leave it
  570. #
  571. io_work:
  572. tm SP_PSW+1(%r15),0x01 # returning to user ?
  573. #ifndef CONFIG_PREEMPT
  574. #if defined(CONFIG_KVM) || defined(CONFIG_KVM_MODULE)
  575. jnz io_work_user # yes -> no need to check for SIE
  576. la %r1, BASED(sie_opcode) # we return to kernel here
  577. lg %r2, SP_PSW+8(%r15)
  578. clc 0(2,%r1), 0(%r2) # is current instruction = SIE?
  579. jne io_restore # no-> return to kernel
  580. lg %r1, SP_PSW+8(%r15) # yes-> add 4 bytes to leave SIE
  581. aghi %r1, 4
  582. stg %r1, SP_PSW+8(%r15)
  583. j io_restore # return to kernel
  584. #else
  585. jno io_restore # no-> skip resched & signal
  586. #endif
  587. #else
  588. jnz io_work_user # yes -> do resched & signal
  589. #if defined(CONFIG_KVM) || defined(CONFIG_KVM_MODULE)
  590. la %r1, BASED(sie_opcode)
  591. lg %r2, SP_PSW+8(%r15)
  592. clc 0(2,%r1), 0(%r2) # is current instruction = SIE?
  593. jne 0f # no -> leave PSW alone
  594. lg %r1, SP_PSW+8(%r15) # yes-> add 4 bytes to leave SIE
  595. aghi %r1, 4
  596. stg %r1, SP_PSW+8(%r15)
  597. 0:
  598. #endif
  599. # check for preemptive scheduling
  600. icm %r0,15,__TI_precount(%r9)
  601. jnz io_restore # preemption is disabled
  602. # switch to kernel stack
  603. lg %r1,SP_R15(%r15)
  604. aghi %r1,-SP_SIZE
  605. mvc SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)
  606. xc __SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1) # clear back chain
  607. lgr %r15,%r1
  608. io_resume_loop:
  609. tm __TI_flags+7(%r9),_TIF_NEED_RESCHED
  610. jno io_restore
  611. larl %r14,io_resume_loop
  612. jg preempt_schedule_irq
  613. #endif
  614. io_work_user:
  615. lg %r1,__LC_KERNEL_STACK
  616. aghi %r1,-SP_SIZE
  617. mvc SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)
  618. xc __SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1) # clear back chain
  619. lgr %r15,%r1
  620. #
  621. # One of the work bits is on. Find out which one.
  622. # Checked are: _TIF_SIGPENDING, _TIF_RESTORE_SIGPENDING, _TIF_NEED_RESCHED
  623. # and _TIF_MCCK_PENDING
  624. #
  625. io_work_loop:
  626. tm __TI_flags+7(%r9),_TIF_MCCK_PENDING
  627. jo io_mcck_pending
  628. tm __TI_flags+7(%r9),_TIF_NEED_RESCHED
  629. jo io_reschedule
  630. tm __TI_flags+7(%r9),_TIF_SIGPENDING
  631. jnz io_sigpending
  632. tm __TI_flags+7(%r9),_TIF_NOTIFY_RESUME
  633. jnz io_notify_resume
  634. j io_restore
  635. io_work_done:
  636. #if defined(CONFIG_KVM) || defined(CONFIG_KVM_MODULE)
  637. sie_opcode:
  638. .long 0xb2140000
  639. #endif
  640. #
  641. # _TIF_MCCK_PENDING is set, call handler
  642. #
  643. io_mcck_pending:
  644. brasl %r14,s390_handle_mcck # TIF bit will be cleared by handler
  645. j io_work_loop
  646. #
  647. # _TIF_NEED_RESCHED is set, call schedule
  648. #
  649. io_reschedule:
  650. TRACE_IRQS_ON
  651. stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
  652. brasl %r14,schedule # call scheduler
  653. stnsm __SF_EMPTY(%r15),0xfc # disable I/O and ext. interrupts
  654. TRACE_IRQS_OFF
  655. tm __TI_flags+7(%r9),_TIF_WORK_INT
  656. jz io_restore # there is no work to do
  657. j io_work_loop
  658. #
  659. # _TIF_SIGPENDING or is set, call do_signal
  660. #
  661. io_sigpending:
  662. TRACE_IRQS_ON
  663. stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
  664. la %r2,SP_PTREGS(%r15) # load pt_regs
  665. brasl %r14,do_signal # call do_signal
  666. stnsm __SF_EMPTY(%r15),0xfc # disable I/O and ext. interrupts
  667. TRACE_IRQS_OFF
  668. j io_work_loop
  669. #
  670. # _TIF_NOTIFY_RESUME or is set, call do_notify_resume
  671. #
  672. io_notify_resume:
  673. TRACE_IRQS_ON
  674. stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
  675. la %r2,SP_PTREGS(%r15) # load pt_regs
  676. brasl %r14,do_notify_resume # call do_notify_resume
  677. stnsm __SF_EMPTY(%r15),0xfc # disable I/O and ext. interrupts
  678. TRACE_IRQS_OFF
  679. j io_work_loop
  680. /*
  681. * External interrupt handler routine
  682. */
  683. .globl ext_int_handler
  684. ext_int_handler:
  685. stck __LC_INT_CLOCK
  686. stpt __LC_ASYNC_ENTER_TIMER
  687. SAVE_ALL_BASE __LC_SAVE_AREA+32
  688. SAVE_ALL_ASYNC __LC_EXT_OLD_PSW,__LC_SAVE_AREA+32
  689. CREATE_STACK_FRAME __LC_EXT_OLD_PSW,__LC_SAVE_AREA+32
  690. tm SP_PSW+1(%r15),0x01 # interrupting from user ?
  691. jz ext_no_vtime
  692. UPDATE_VTIME __LC_EXIT_TIMER,__LC_ASYNC_ENTER_TIMER,__LC_USER_TIMER
  693. UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
  694. mvc __LC_LAST_UPDATE_TIMER(8),__LC_ASYNC_ENTER_TIMER
  695. ext_no_vtime:
  696. lg %r9,__LC_THREAD_INFO # load pointer to thread_info struct
  697. TRACE_IRQS_OFF
  698. la %r2,SP_PTREGS(%r15) # address of register-save area
  699. llgh %r3,__LC_EXT_INT_CODE # get interruption code
  700. brasl %r14,do_extint
  701. j io_return
  702. __critical_end:
  703. /*
  704. * Machine check handler routines
  705. */
  706. .globl mcck_int_handler
  707. mcck_int_handler:
  708. stck __LC_INT_CLOCK
  709. la %r1,4095 # revalidate r1
  710. spt __LC_CPU_TIMER_SAVE_AREA-4095(%r1) # revalidate cpu timer
  711. lmg %r0,%r15,__LC_GPREGS_SAVE_AREA-4095(%r1)# revalidate gprs
  712. SAVE_ALL_BASE __LC_SAVE_AREA+64
  713. la %r12,__LC_MCK_OLD_PSW
  714. tm __LC_MCCK_CODE,0x80 # system damage?
  715. jo mcck_int_main # yes -> rest of mcck code invalid
  716. la %r14,4095
  717. mvc __LC_SAVE_AREA+104(8),__LC_ASYNC_ENTER_TIMER
  718. mvc __LC_ASYNC_ENTER_TIMER(8),__LC_CPU_TIMER_SAVE_AREA-4095(%r14)
  719. tm __LC_MCCK_CODE+5,0x02 # stored cpu timer value valid?
  720. jo 1f
  721. la %r14,__LC_SYNC_ENTER_TIMER
  722. clc 0(8,%r14),__LC_ASYNC_ENTER_TIMER
  723. jl 0f
  724. la %r14,__LC_ASYNC_ENTER_TIMER
  725. 0: clc 0(8,%r14),__LC_EXIT_TIMER
  726. jl 0f
  727. la %r14,__LC_EXIT_TIMER
  728. 0: clc 0(8,%r14),__LC_LAST_UPDATE_TIMER
  729. jl 0f
  730. la %r14,__LC_LAST_UPDATE_TIMER
  731. 0: spt 0(%r14)
  732. mvc __LC_ASYNC_ENTER_TIMER(8),0(%r14)
  733. 1: tm __LC_MCCK_CODE+2,0x09 # mwp + ia of old psw valid?
  734. jno mcck_int_main # no -> skip cleanup critical
  735. tm __LC_MCK_OLD_PSW+1,0x01 # test problem state bit
  736. jnz mcck_int_main # from user -> load kernel stack
  737. clc __LC_MCK_OLD_PSW+8(8),BASED(.Lcritical_end)
  738. jhe mcck_int_main
  739. clc __LC_MCK_OLD_PSW+8(8),BASED(.Lcritical_start)
  740. jl mcck_int_main
  741. brasl %r14,cleanup_critical
  742. mcck_int_main:
  743. lg %r14,__LC_PANIC_STACK # are we already on the panic stack?
  744. slgr %r14,%r15
  745. srag %r14,%r14,PAGE_SHIFT
  746. jz 0f
  747. lg %r15,__LC_PANIC_STACK # load panic stack
  748. 0: CREATE_STACK_FRAME __LC_MCK_OLD_PSW,__LC_SAVE_AREA+64
  749. tm __LC_MCCK_CODE+2,0x08 # mwp of old psw valid?
  750. jno mcck_no_vtime # no -> no timer update
  751. tm SP_PSW+1(%r15),0x01 # interrupting from user ?
  752. jz mcck_no_vtime
  753. UPDATE_VTIME __LC_EXIT_TIMER,__LC_ASYNC_ENTER_TIMER,__LC_USER_TIMER
  754. UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
  755. mvc __LC_LAST_UPDATE_TIMER(8),__LC_ASYNC_ENTER_TIMER
  756. mcck_no_vtime:
  757. lg %r9,__LC_THREAD_INFO # load pointer to thread_info struct
  758. la %r2,SP_PTREGS(%r15) # load pt_regs
  759. brasl %r14,s390_do_machine_check
  760. tm SP_PSW+1(%r15),0x01 # returning to user ?
  761. jno mcck_return
  762. lg %r1,__LC_KERNEL_STACK # switch to kernel stack
  763. aghi %r1,-SP_SIZE
  764. mvc SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)
  765. xc __SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1) # clear back chain
  766. lgr %r15,%r1
  767. stosm __SF_EMPTY(%r15),0x04 # turn dat on
  768. tm __TI_flags+7(%r9),_TIF_MCCK_PENDING
  769. jno mcck_return
  770. TRACE_IRQS_OFF
  771. brasl %r14,s390_handle_mcck
  772. TRACE_IRQS_ON
  773. mcck_return:
  774. mvc __LC_RETURN_MCCK_PSW(16),SP_PSW(%r15) # move return PSW
  775. ni __LC_RETURN_MCCK_PSW+1,0xfd # clear wait state bit
  776. lmg %r0,%r15,SP_R0(%r15) # load gprs 0-15
  777. mvc __LC_ASYNC_ENTER_TIMER(8),__LC_SAVE_AREA+104
  778. tm __LC_RETURN_MCCK_PSW+1,0x01 # returning to user ?
  779. jno 0f
  780. stpt __LC_EXIT_TIMER
  781. 0: lpswe __LC_RETURN_MCCK_PSW # back to caller
  782. /*
  783. * Restart interruption handler, kick starter for additional CPUs
  784. */
  785. #ifdef CONFIG_SMP
  786. __CPUINIT
  787. .globl restart_int_handler
  788. restart_int_handler:
  789. basr %r1,0
  790. restart_base:
  791. spt restart_vtime-restart_base(%r1)
  792. stck __LC_LAST_UPDATE_CLOCK
  793. mvc __LC_LAST_UPDATE_TIMER(8),restart_vtime-restart_base(%r1)
  794. mvc __LC_EXIT_TIMER(8),restart_vtime-restart_base(%r1)
  795. lg %r15,__LC_SAVE_AREA+120 # load ksp
  796. lghi %r10,__LC_CREGS_SAVE_AREA
  797. lctlg %c0,%c15,0(%r10) # get new ctl regs
  798. lghi %r10,__LC_AREGS_SAVE_AREA
  799. lam %a0,%a15,0(%r10)
  800. lmg %r6,%r15,__SF_GPRS(%r15) # load registers from clone
  801. lg %r1,__LC_THREAD_INFO
  802. mvc __LC_USER_TIMER(8),__TI_user_timer(%r1)
  803. mvc __LC_SYSTEM_TIMER(8),__TI_system_timer(%r1)
  804. xc __LC_STEAL_TIMER(8),__LC_STEAL_TIMER
  805. stosm __SF_EMPTY(%r15),0x04 # now we can turn dat on
  806. jg start_secondary
  807. .align 8
  808. restart_vtime:
  809. .long 0x7fffffff,0xffffffff
  810. .previous
  811. #else
  812. /*
  813. * If we do not run with SMP enabled, let the new CPU crash ...
  814. */
  815. .globl restart_int_handler
  816. restart_int_handler:
  817. basr %r1,0
  818. restart_base:
  819. lpswe restart_crash-restart_base(%r1)
  820. .align 8
  821. restart_crash:
  822. .long 0x000a0000,0x00000000,0x00000000,0x00000000
  823. restart_go:
  824. #endif
  825. #ifdef CONFIG_CHECK_STACK
  826. /*
  827. * The synchronous or the asynchronous stack overflowed. We are dead.
  828. * No need to properly save the registers, we are going to panic anyway.
  829. * Setup a pt_regs so that show_trace can provide a good call trace.
  830. */
  831. stack_overflow:
  832. lg %r15,__LC_PANIC_STACK # change to panic stack
  833. aghi %r15,-SP_SIZE
  834. mvc SP_PSW(16,%r15),0(%r12) # move user PSW to stack
  835. stmg %r0,%r11,SP_R0(%r15) # store gprs %r0-%r11 to kernel stack
  836. la %r1,__LC_SAVE_AREA
  837. chi %r12,__LC_SVC_OLD_PSW
  838. je 0f
  839. chi %r12,__LC_PGM_OLD_PSW
  840. je 0f
  841. la %r1,__LC_SAVE_AREA+32
  842. 0: mvc SP_R12(32,%r15),0(%r1) # move %r12-%r15 to stack
  843. mvc SP_ARGS(8,%r15),__LC_LAST_BREAK
  844. xc __SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15) # clear back chain
  845. la %r2,SP_PTREGS(%r15) # load pt_regs
  846. jg kernel_stack_overflow
  847. #endif
  848. cleanup_table_system_call:
  849. .quad system_call, sysc_do_svc
  850. cleanup_table_sysc_return:
  851. .quad sysc_return, sysc_leave
  852. cleanup_table_sysc_leave:
  853. .quad sysc_leave, sysc_done
  854. cleanup_table_sysc_work_loop:
  855. .quad sysc_work_loop, sysc_work_done
  856. cleanup_table_io_return:
  857. .quad io_return, io_leave
  858. cleanup_table_io_leave:
  859. .quad io_leave, io_done
  860. cleanup_table_io_work_loop:
  861. .quad io_work_loop, io_work_done
  862. cleanup_critical:
  863. clc 8(8,%r12),BASED(cleanup_table_system_call)
  864. jl 0f
  865. clc 8(8,%r12),BASED(cleanup_table_system_call+8)
  866. jl cleanup_system_call
  867. 0:
  868. clc 8(8,%r12),BASED(cleanup_table_sysc_return)
  869. jl 0f
  870. clc 8(8,%r12),BASED(cleanup_table_sysc_return+8)
  871. jl cleanup_sysc_return
  872. 0:
  873. clc 8(8,%r12),BASED(cleanup_table_sysc_leave)
  874. jl 0f
  875. clc 8(8,%r12),BASED(cleanup_table_sysc_leave+8)
  876. jl cleanup_sysc_leave
  877. 0:
  878. clc 8(8,%r12),BASED(cleanup_table_sysc_work_loop)
  879. jl 0f
  880. clc 8(8,%r12),BASED(cleanup_table_sysc_work_loop+8)
  881. jl cleanup_sysc_return
  882. 0:
  883. clc 8(8,%r12),BASED(cleanup_table_io_return)
  884. jl 0f
  885. clc 8(8,%r12),BASED(cleanup_table_io_return+8)
  886. jl cleanup_io_return
  887. 0:
  888. clc 8(8,%r12),BASED(cleanup_table_io_leave)
  889. jl 0f
  890. clc 8(8,%r12),BASED(cleanup_table_io_leave+8)
  891. jl cleanup_io_leave
  892. 0:
  893. clc 8(8,%r12),BASED(cleanup_table_io_work_loop)
  894. jl 0f
  895. clc 8(8,%r12),BASED(cleanup_table_io_work_loop+8)
  896. jl cleanup_io_return
  897. 0:
  898. br %r14
  899. cleanup_system_call:
  900. mvc __LC_RETURN_PSW(16),0(%r12)
  901. cghi %r12,__LC_MCK_OLD_PSW
  902. je 0f
  903. la %r12,__LC_SAVE_AREA+32
  904. j 1f
  905. 0: la %r12,__LC_SAVE_AREA+64
  906. 1:
  907. clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn+8)
  908. jh 0f
  909. mvc __LC_SYNC_ENTER_TIMER(8),__LC_ASYNC_ENTER_TIMER
  910. 0: clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn+16)
  911. jhe cleanup_vtime
  912. clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn)
  913. jh 0f
  914. mvc __LC_SAVE_AREA(32),0(%r12)
  915. 0: stg %r13,8(%r12)
  916. stg %r12,__LC_SAVE_AREA+96 # argh
  917. SAVE_ALL_SYNC __LC_SVC_OLD_PSW,__LC_SAVE_AREA
  918. CREATE_STACK_FRAME __LC_SVC_OLD_PSW,__LC_SAVE_AREA
  919. lg %r12,__LC_SAVE_AREA+96 # argh
  920. stg %r15,24(%r12)
  921. llgh %r7,__LC_SVC_INT_CODE
  922. cleanup_vtime:
  923. clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn+24)
  924. jhe cleanup_stime
  925. UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
  926. cleanup_stime:
  927. clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn+32)
  928. jh cleanup_update
  929. UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
  930. cleanup_update:
  931. mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
  932. mvc __LC_RETURN_PSW+8(8),BASED(cleanup_table_system_call+8)
  933. la %r12,__LC_RETURN_PSW
  934. br %r14
  935. cleanup_system_call_insn:
  936. .quad sysc_saveall
  937. .quad system_call
  938. .quad sysc_vtime
  939. .quad sysc_stime
  940. .quad sysc_update
  941. cleanup_sysc_return:
  942. mvc __LC_RETURN_PSW(8),0(%r12)
  943. mvc __LC_RETURN_PSW+8(8),BASED(cleanup_table_sysc_return)
  944. la %r12,__LC_RETURN_PSW
  945. br %r14
  946. cleanup_sysc_leave:
  947. clc 8(8,%r12),BASED(cleanup_sysc_leave_insn)
  948. je 3f
  949. clc 8(8,%r12),BASED(cleanup_sysc_leave_insn+8)
  950. jhe 0f
  951. mvc __LC_EXIT_TIMER(8),__LC_ASYNC_ENTER_TIMER
  952. 0: mvc __LC_RETURN_PSW(16),SP_PSW(%r15)
  953. cghi %r12,__LC_MCK_OLD_PSW
  954. jne 1f
  955. mvc __LC_SAVE_AREA+64(32),SP_R12(%r15)
  956. j 2f
  957. 1: mvc __LC_SAVE_AREA+32(32),SP_R12(%r15)
  958. 2: lmg %r0,%r11,SP_R0(%r15)
  959. lg %r15,SP_R15(%r15)
  960. 3: la %r12,__LC_RETURN_PSW
  961. br %r14
  962. cleanup_sysc_leave_insn:
  963. .quad sysc_done - 4
  964. .quad sysc_done - 16
  965. cleanup_io_return:
  966. mvc __LC_RETURN_PSW(8),0(%r12)
  967. mvc __LC_RETURN_PSW+8(8),BASED(cleanup_table_io_work_loop)
  968. la %r12,__LC_RETURN_PSW
  969. br %r14
  970. cleanup_io_leave:
  971. clc 8(8,%r12),BASED(cleanup_io_leave_insn)
  972. je 3f
  973. clc 8(8,%r12),BASED(cleanup_io_leave_insn+8)
  974. jhe 0f
  975. mvc __LC_EXIT_TIMER(8),__LC_ASYNC_ENTER_TIMER
  976. 0: mvc __LC_RETURN_PSW(16),SP_PSW(%r15)
  977. cghi %r12,__LC_MCK_OLD_PSW
  978. jne 1f
  979. mvc __LC_SAVE_AREA+64(32),SP_R12(%r15)
  980. j 2f
  981. 1: mvc __LC_SAVE_AREA+32(32),SP_R12(%r15)
  982. 2: lmg %r0,%r11,SP_R0(%r15)
  983. lg %r15,SP_R15(%r15)
  984. 3: la %r12,__LC_RETURN_PSW
  985. br %r14
  986. cleanup_io_leave_insn:
  987. .quad io_done - 4
  988. .quad io_done - 16
  989. /*
  990. * Integer constants
  991. */
  992. .align 4
  993. .Lconst:
  994. .Lnr_syscalls: .long NR_syscalls
  995. .L0x0130: .short 0x130
  996. .L0x0140: .short 0x140
  997. .L0x0150: .short 0x150
  998. .L0x0160: .short 0x160
  999. .L0x0170: .short 0x170
  1000. .Lcritical_start:
  1001. .quad __critical_start
  1002. .Lcritical_end:
  1003. .quad __critical_end
  1004. .section .rodata, "a"
  1005. #define SYSCALL(esa,esame,emu) .long esame
  1006. .globl sys_call_table
  1007. sys_call_table:
  1008. #include "syscalls.S"
  1009. #undef SYSCALL
  1010. #ifdef CONFIG_COMPAT
  1011. #define SYSCALL(esa,esame,emu) .long emu
  1012. sys_call_table_emu:
  1013. #include "syscalls.S"
  1014. #undef SYSCALL
  1015. #endif