entry64.S 31 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079
  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 %r8,__TI_task(%r9)
  510. mvc __THREAD_per+__PER_atmid(2,%r8),__LC_PER_ATMID
  511. mvc __THREAD_per+__PER_address(8,%r8),__LC_PER_ADDRESS
  512. mvc __THREAD_per+__PER_access_id(1,%r8),__LC_PER_ACCESS_ID
  513. oi __TI_flags+7(%r9),_TIF_SINGLE_STEP # set TIF_SINGLE_STEP
  514. TRACE_IRQS_ON
  515. lmg %r2,%r6,SP_R2(%r15) # load svc arguments
  516. stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
  517. j sysc_do_svc
  518. #
  519. # per was called from kernel, must be kprobes
  520. #
  521. kernel_per:
  522. xc SP_SVCNR(2,%r15),SP_SVCNR(%r15) # clear svc number
  523. la %r2,SP_PTREGS(%r15) # address of register-save area
  524. larl %r14,sysc_restore # load adr. of system ret, no work
  525. jg do_single_step # branch to do_single_step
  526. /*
  527. * IO interrupt handler routine
  528. */
  529. .globl io_int_handler
  530. io_int_handler:
  531. stck __LC_INT_CLOCK
  532. stpt __LC_ASYNC_ENTER_TIMER
  533. SAVE_ALL_BASE __LC_SAVE_AREA+32
  534. SAVE_ALL_ASYNC __LC_IO_OLD_PSW,__LC_SAVE_AREA+32
  535. CREATE_STACK_FRAME __LC_IO_OLD_PSW,__LC_SAVE_AREA+32
  536. tm SP_PSW+1(%r15),0x01 # interrupting from user ?
  537. jz io_no_vtime
  538. UPDATE_VTIME __LC_EXIT_TIMER,__LC_ASYNC_ENTER_TIMER,__LC_USER_TIMER
  539. UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
  540. mvc __LC_LAST_UPDATE_TIMER(8),__LC_ASYNC_ENTER_TIMER
  541. io_no_vtime:
  542. lg %r9,__LC_THREAD_INFO # load pointer to thread_info struct
  543. TRACE_IRQS_OFF
  544. la %r2,SP_PTREGS(%r15) # address of register-save area
  545. brasl %r14,do_IRQ # call standard irq handler
  546. io_return:
  547. tm __TI_flags+7(%r9),_TIF_WORK_INT
  548. jnz io_work # there is work to do (signals etc.)
  549. io_restore:
  550. #ifdef CONFIG_TRACE_IRQFLAGS
  551. larl %r1,io_restore_trace_psw
  552. lpswe 0(%r1)
  553. io_restore_trace:
  554. TRACE_IRQS_CHECK
  555. LOCKDEP_SYS_EXIT
  556. #endif
  557. io_leave:
  558. RESTORE_ALL __LC_RETURN_PSW,0
  559. io_done:
  560. #ifdef CONFIG_TRACE_IRQFLAGS
  561. .section .data,"aw",@progbits
  562. .align 8
  563. .globl io_restore_trace_psw
  564. io_restore_trace_psw:
  565. .quad 0, io_restore_trace
  566. .previous
  567. #endif
  568. #
  569. # There is work todo, we need to check if we return to userspace, then
  570. # check, if we are in SIE, if yes leave it
  571. #
  572. io_work:
  573. tm SP_PSW+1(%r15),0x01 # returning to user ?
  574. #ifndef CONFIG_PREEMPT
  575. #if defined(CONFIG_KVM) || defined(CONFIG_KVM_MODULE)
  576. jnz io_work_user # yes -> no need to check for SIE
  577. la %r1, BASED(sie_opcode) # we return to kernel here
  578. lg %r2, SP_PSW+8(%r15)
  579. clc 0(2,%r1), 0(%r2) # is current instruction = SIE?
  580. jne io_restore # no-> return to kernel
  581. lg %r1, SP_PSW+8(%r15) # yes-> add 4 bytes to leave SIE
  582. aghi %r1, 4
  583. stg %r1, SP_PSW+8(%r15)
  584. j io_restore # return to kernel
  585. #else
  586. jno io_restore # no-> skip resched & signal
  587. #endif
  588. #else
  589. jnz io_work_user # yes -> do resched & signal
  590. #if defined(CONFIG_KVM) || defined(CONFIG_KVM_MODULE)
  591. la %r1, BASED(sie_opcode)
  592. lg %r2, SP_PSW+8(%r15)
  593. clc 0(2,%r1), 0(%r2) # is current instruction = SIE?
  594. jne 0f # no -> leave PSW alone
  595. lg %r1, SP_PSW+8(%r15) # yes-> add 4 bytes to leave SIE
  596. aghi %r1, 4
  597. stg %r1, SP_PSW+8(%r15)
  598. 0:
  599. #endif
  600. # check for preemptive scheduling
  601. icm %r0,15,__TI_precount(%r9)
  602. jnz io_restore # preemption is disabled
  603. # switch to kernel stack
  604. lg %r1,SP_R15(%r15)
  605. aghi %r1,-SP_SIZE
  606. mvc SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)
  607. xc __SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1) # clear back chain
  608. lgr %r15,%r1
  609. io_resume_loop:
  610. tm __TI_flags+7(%r9),_TIF_NEED_RESCHED
  611. jno io_restore
  612. larl %r14,io_resume_loop
  613. jg preempt_schedule_irq
  614. #endif
  615. io_work_user:
  616. lg %r1,__LC_KERNEL_STACK
  617. aghi %r1,-SP_SIZE
  618. mvc SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)
  619. xc __SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1) # clear back chain
  620. lgr %r15,%r1
  621. #
  622. # One of the work bits is on. Find out which one.
  623. # Checked are: _TIF_SIGPENDING, _TIF_RESTORE_SIGPENDING, _TIF_NEED_RESCHED
  624. # and _TIF_MCCK_PENDING
  625. #
  626. io_work_loop:
  627. tm __TI_flags+7(%r9),_TIF_MCCK_PENDING
  628. jo io_mcck_pending
  629. tm __TI_flags+7(%r9),_TIF_NEED_RESCHED
  630. jo io_reschedule
  631. tm __TI_flags+7(%r9),_TIF_SIGPENDING
  632. jnz io_sigpending
  633. tm __TI_flags+7(%r9),_TIF_NOTIFY_RESUME
  634. jnz io_notify_resume
  635. j io_restore
  636. io_work_done:
  637. #if defined(CONFIG_KVM) || defined(CONFIG_KVM_MODULE)
  638. sie_opcode:
  639. .long 0xb2140000
  640. #endif
  641. #
  642. # _TIF_MCCK_PENDING is set, call handler
  643. #
  644. io_mcck_pending:
  645. brasl %r14,s390_handle_mcck # TIF bit will be cleared by handler
  646. j io_work_loop
  647. #
  648. # _TIF_NEED_RESCHED is set, call schedule
  649. #
  650. io_reschedule:
  651. TRACE_IRQS_ON
  652. stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
  653. brasl %r14,schedule # call scheduler
  654. stnsm __SF_EMPTY(%r15),0xfc # disable I/O and ext. interrupts
  655. TRACE_IRQS_OFF
  656. tm __TI_flags+7(%r9),_TIF_WORK_INT
  657. jz io_restore # there is no work to do
  658. j io_work_loop
  659. #
  660. # _TIF_SIGPENDING or is set, call do_signal
  661. #
  662. io_sigpending:
  663. TRACE_IRQS_ON
  664. stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
  665. la %r2,SP_PTREGS(%r15) # load pt_regs
  666. brasl %r14,do_signal # call do_signal
  667. stnsm __SF_EMPTY(%r15),0xfc # disable I/O and ext. interrupts
  668. TRACE_IRQS_OFF
  669. j io_work_loop
  670. #
  671. # _TIF_NOTIFY_RESUME or is set, call do_notify_resume
  672. #
  673. io_notify_resume:
  674. TRACE_IRQS_ON
  675. stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
  676. la %r2,SP_PTREGS(%r15) # load pt_regs
  677. brasl %r14,do_notify_resume # call do_notify_resume
  678. stnsm __SF_EMPTY(%r15),0xfc # disable I/O and ext. interrupts
  679. TRACE_IRQS_OFF
  680. j io_work_loop
  681. /*
  682. * External interrupt handler routine
  683. */
  684. .globl ext_int_handler
  685. ext_int_handler:
  686. stck __LC_INT_CLOCK
  687. stpt __LC_ASYNC_ENTER_TIMER
  688. SAVE_ALL_BASE __LC_SAVE_AREA+32
  689. SAVE_ALL_ASYNC __LC_EXT_OLD_PSW,__LC_SAVE_AREA+32
  690. CREATE_STACK_FRAME __LC_EXT_OLD_PSW,__LC_SAVE_AREA+32
  691. tm SP_PSW+1(%r15),0x01 # interrupting from user ?
  692. jz ext_no_vtime
  693. UPDATE_VTIME __LC_EXIT_TIMER,__LC_ASYNC_ENTER_TIMER,__LC_USER_TIMER
  694. UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
  695. mvc __LC_LAST_UPDATE_TIMER(8),__LC_ASYNC_ENTER_TIMER
  696. ext_no_vtime:
  697. lg %r9,__LC_THREAD_INFO # load pointer to thread_info struct
  698. TRACE_IRQS_OFF
  699. la %r2,SP_PTREGS(%r15) # address of register-save area
  700. llgh %r3,__LC_EXT_INT_CODE # get interruption code
  701. brasl %r14,do_extint
  702. j io_return
  703. __critical_end:
  704. /*
  705. * Machine check handler routines
  706. */
  707. .globl mcck_int_handler
  708. mcck_int_handler:
  709. stck __LC_INT_CLOCK
  710. la %r1,4095 # revalidate r1
  711. spt __LC_CPU_TIMER_SAVE_AREA-4095(%r1) # revalidate cpu timer
  712. lmg %r0,%r15,__LC_GPREGS_SAVE_AREA-4095(%r1)# revalidate gprs
  713. SAVE_ALL_BASE __LC_SAVE_AREA+64
  714. la %r12,__LC_MCK_OLD_PSW
  715. tm __LC_MCCK_CODE,0x80 # system damage?
  716. jo mcck_int_main # yes -> rest of mcck code invalid
  717. la %r14,4095
  718. mvc __LC_SAVE_AREA+104(8),__LC_ASYNC_ENTER_TIMER
  719. mvc __LC_ASYNC_ENTER_TIMER(8),__LC_CPU_TIMER_SAVE_AREA-4095(%r14)
  720. tm __LC_MCCK_CODE+5,0x02 # stored cpu timer value valid?
  721. jo 1f
  722. la %r14,__LC_SYNC_ENTER_TIMER
  723. clc 0(8,%r14),__LC_ASYNC_ENTER_TIMER
  724. jl 0f
  725. la %r14,__LC_ASYNC_ENTER_TIMER
  726. 0: clc 0(8,%r14),__LC_EXIT_TIMER
  727. jl 0f
  728. la %r14,__LC_EXIT_TIMER
  729. 0: clc 0(8,%r14),__LC_LAST_UPDATE_TIMER
  730. jl 0f
  731. la %r14,__LC_LAST_UPDATE_TIMER
  732. 0: spt 0(%r14)
  733. mvc __LC_ASYNC_ENTER_TIMER(8),0(%r14)
  734. 1: tm __LC_MCCK_CODE+2,0x09 # mwp + ia of old psw valid?
  735. jno mcck_int_main # no -> skip cleanup critical
  736. tm __LC_MCK_OLD_PSW+1,0x01 # test problem state bit
  737. jnz mcck_int_main # from user -> load kernel stack
  738. clc __LC_MCK_OLD_PSW+8(8),BASED(.Lcritical_end)
  739. jhe mcck_int_main
  740. clc __LC_MCK_OLD_PSW+8(8),BASED(.Lcritical_start)
  741. jl mcck_int_main
  742. brasl %r14,cleanup_critical
  743. mcck_int_main:
  744. lg %r14,__LC_PANIC_STACK # are we already on the panic stack?
  745. slgr %r14,%r15
  746. srag %r14,%r14,PAGE_SHIFT
  747. jz 0f
  748. lg %r15,__LC_PANIC_STACK # load panic stack
  749. 0: CREATE_STACK_FRAME __LC_MCK_OLD_PSW,__LC_SAVE_AREA+64
  750. tm __LC_MCCK_CODE+2,0x08 # mwp of old psw valid?
  751. jno mcck_no_vtime # no -> no timer update
  752. tm SP_PSW+1(%r15),0x01 # interrupting from user ?
  753. jz mcck_no_vtime
  754. UPDATE_VTIME __LC_EXIT_TIMER,__LC_ASYNC_ENTER_TIMER,__LC_USER_TIMER
  755. UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
  756. mvc __LC_LAST_UPDATE_TIMER(8),__LC_ASYNC_ENTER_TIMER
  757. mcck_no_vtime:
  758. lg %r9,__LC_THREAD_INFO # load pointer to thread_info struct
  759. la %r2,SP_PTREGS(%r15) # load pt_regs
  760. brasl %r14,s390_do_machine_check
  761. tm SP_PSW+1(%r15),0x01 # returning to user ?
  762. jno mcck_return
  763. lg %r1,__LC_KERNEL_STACK # switch to kernel stack
  764. aghi %r1,-SP_SIZE
  765. mvc SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)
  766. xc __SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1) # clear back chain
  767. lgr %r15,%r1
  768. stosm __SF_EMPTY(%r15),0x04 # turn dat on
  769. tm __TI_flags+7(%r9),_TIF_MCCK_PENDING
  770. jno mcck_return
  771. TRACE_IRQS_OFF
  772. brasl %r14,s390_handle_mcck
  773. TRACE_IRQS_ON
  774. mcck_return:
  775. mvc __LC_RETURN_MCCK_PSW(16),SP_PSW(%r15) # move return PSW
  776. ni __LC_RETURN_MCCK_PSW+1,0xfd # clear wait state bit
  777. lmg %r0,%r15,SP_R0(%r15) # load gprs 0-15
  778. mvc __LC_ASYNC_ENTER_TIMER(8),__LC_SAVE_AREA+104
  779. tm __LC_RETURN_MCCK_PSW+1,0x01 # returning to user ?
  780. jno 0f
  781. stpt __LC_EXIT_TIMER
  782. 0: lpswe __LC_RETURN_MCCK_PSW # back to caller
  783. /*
  784. * Restart interruption handler, kick starter for additional CPUs
  785. */
  786. #ifdef CONFIG_SMP
  787. __CPUINIT
  788. .globl restart_int_handler
  789. restart_int_handler:
  790. basr %r1,0
  791. restart_base:
  792. spt restart_vtime-restart_base(%r1)
  793. stck __LC_LAST_UPDATE_CLOCK
  794. mvc __LC_LAST_UPDATE_TIMER(8),restart_vtime-restart_base(%r1)
  795. mvc __LC_EXIT_TIMER(8),restart_vtime-restart_base(%r1)
  796. lg %r15,__LC_SAVE_AREA+120 # load ksp
  797. lghi %r10,__LC_CREGS_SAVE_AREA
  798. lctlg %c0,%c15,0(%r10) # get new ctl regs
  799. lghi %r10,__LC_AREGS_SAVE_AREA
  800. lam %a0,%a15,0(%r10)
  801. lmg %r6,%r15,__SF_GPRS(%r15) # load registers from clone
  802. lg %r1,__LC_THREAD_INFO
  803. mvc __LC_USER_TIMER(8),__TI_user_timer(%r1)
  804. mvc __LC_SYSTEM_TIMER(8),__TI_system_timer(%r1)
  805. xc __LC_STEAL_TIMER(8),__LC_STEAL_TIMER
  806. stosm __SF_EMPTY(%r15),0x04 # now we can turn dat on
  807. jg start_secondary
  808. .align 8
  809. restart_vtime:
  810. .long 0x7fffffff,0xffffffff
  811. .previous
  812. #else
  813. /*
  814. * If we do not run with SMP enabled, let the new CPU crash ...
  815. */
  816. .globl restart_int_handler
  817. restart_int_handler:
  818. basr %r1,0
  819. restart_base:
  820. lpswe restart_crash-restart_base(%r1)
  821. .align 8
  822. restart_crash:
  823. .long 0x000a0000,0x00000000,0x00000000,0x00000000
  824. restart_go:
  825. #endif
  826. #ifdef CONFIG_CHECK_STACK
  827. /*
  828. * The synchronous or the asynchronous stack overflowed. We are dead.
  829. * No need to properly save the registers, we are going to panic anyway.
  830. * Setup a pt_regs so that show_trace can provide a good call trace.
  831. */
  832. stack_overflow:
  833. lg %r15,__LC_PANIC_STACK # change to panic stack
  834. aghi %r15,-SP_SIZE
  835. mvc SP_PSW(16,%r15),0(%r12) # move user PSW to stack
  836. stmg %r0,%r11,SP_R0(%r15) # store gprs %r0-%r11 to kernel stack
  837. la %r1,__LC_SAVE_AREA
  838. chi %r12,__LC_SVC_OLD_PSW
  839. je 0f
  840. chi %r12,__LC_PGM_OLD_PSW
  841. je 0f
  842. la %r1,__LC_SAVE_AREA+32
  843. 0: mvc SP_R12(32,%r15),0(%r1) # move %r12-%r15 to stack
  844. mvc SP_ARGS(8,%r15),__LC_LAST_BREAK
  845. xc __SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15) # clear back chain
  846. la %r2,SP_PTREGS(%r15) # load pt_regs
  847. jg kernel_stack_overflow
  848. #endif
  849. cleanup_table_system_call:
  850. .quad system_call, sysc_do_svc
  851. cleanup_table_sysc_return:
  852. .quad sysc_return, sysc_leave
  853. cleanup_table_sysc_leave:
  854. .quad sysc_leave, sysc_done
  855. cleanup_table_sysc_work_loop:
  856. .quad sysc_work_loop, sysc_work_done
  857. cleanup_table_io_return:
  858. .quad io_return, io_leave
  859. cleanup_table_io_leave:
  860. .quad io_leave, io_done
  861. cleanup_table_io_work_loop:
  862. .quad io_work_loop, io_work_done
  863. cleanup_critical:
  864. clc 8(8,%r12),BASED(cleanup_table_system_call)
  865. jl 0f
  866. clc 8(8,%r12),BASED(cleanup_table_system_call+8)
  867. jl cleanup_system_call
  868. 0:
  869. clc 8(8,%r12),BASED(cleanup_table_sysc_return)
  870. jl 0f
  871. clc 8(8,%r12),BASED(cleanup_table_sysc_return+8)
  872. jl cleanup_sysc_return
  873. 0:
  874. clc 8(8,%r12),BASED(cleanup_table_sysc_leave)
  875. jl 0f
  876. clc 8(8,%r12),BASED(cleanup_table_sysc_leave+8)
  877. jl cleanup_sysc_leave
  878. 0:
  879. clc 8(8,%r12),BASED(cleanup_table_sysc_work_loop)
  880. jl 0f
  881. clc 8(8,%r12),BASED(cleanup_table_sysc_work_loop+8)
  882. jl cleanup_sysc_return
  883. 0:
  884. clc 8(8,%r12),BASED(cleanup_table_io_return)
  885. jl 0f
  886. clc 8(8,%r12),BASED(cleanup_table_io_return+8)
  887. jl cleanup_io_return
  888. 0:
  889. clc 8(8,%r12),BASED(cleanup_table_io_leave)
  890. jl 0f
  891. clc 8(8,%r12),BASED(cleanup_table_io_leave+8)
  892. jl cleanup_io_leave
  893. 0:
  894. clc 8(8,%r12),BASED(cleanup_table_io_work_loop)
  895. jl 0f
  896. clc 8(8,%r12),BASED(cleanup_table_io_work_loop+8)
  897. jl cleanup_io_return
  898. 0:
  899. br %r14
  900. cleanup_system_call:
  901. mvc __LC_RETURN_PSW(16),0(%r12)
  902. cghi %r12,__LC_MCK_OLD_PSW
  903. je 0f
  904. la %r12,__LC_SAVE_AREA+32
  905. j 1f
  906. 0: la %r12,__LC_SAVE_AREA+64
  907. 1:
  908. clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn+8)
  909. jh 0f
  910. mvc __LC_SYNC_ENTER_TIMER(8),__LC_ASYNC_ENTER_TIMER
  911. 0: clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn+16)
  912. jhe cleanup_vtime
  913. clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn)
  914. jh 0f
  915. mvc __LC_SAVE_AREA(32),0(%r12)
  916. 0: stg %r13,8(%r12)
  917. stg %r12,__LC_SAVE_AREA+96 # argh
  918. SAVE_ALL_SYNC __LC_SVC_OLD_PSW,__LC_SAVE_AREA
  919. CREATE_STACK_FRAME __LC_SVC_OLD_PSW,__LC_SAVE_AREA
  920. lg %r12,__LC_SAVE_AREA+96 # argh
  921. stg %r15,24(%r12)
  922. llgh %r7,__LC_SVC_INT_CODE
  923. cleanup_vtime:
  924. clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn+24)
  925. jhe cleanup_stime
  926. UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
  927. cleanup_stime:
  928. clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn+32)
  929. jh cleanup_update
  930. UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
  931. cleanup_update:
  932. mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
  933. mvc __LC_RETURN_PSW+8(8),BASED(cleanup_table_system_call+8)
  934. la %r12,__LC_RETURN_PSW
  935. br %r14
  936. cleanup_system_call_insn:
  937. .quad sysc_saveall
  938. .quad system_call
  939. .quad sysc_vtime
  940. .quad sysc_stime
  941. .quad sysc_update
  942. cleanup_sysc_return:
  943. mvc __LC_RETURN_PSW(8),0(%r12)
  944. mvc __LC_RETURN_PSW+8(8),BASED(cleanup_table_sysc_return)
  945. la %r12,__LC_RETURN_PSW
  946. br %r14
  947. cleanup_sysc_leave:
  948. clc 8(8,%r12),BASED(cleanup_sysc_leave_insn)
  949. je 3f
  950. clc 8(8,%r12),BASED(cleanup_sysc_leave_insn+8)
  951. jhe 0f
  952. mvc __LC_EXIT_TIMER(8),__LC_ASYNC_ENTER_TIMER
  953. 0: mvc __LC_RETURN_PSW(16),SP_PSW(%r15)
  954. cghi %r12,__LC_MCK_OLD_PSW
  955. jne 1f
  956. mvc __LC_SAVE_AREA+64(32),SP_R12(%r15)
  957. j 2f
  958. 1: mvc __LC_SAVE_AREA+32(32),SP_R12(%r15)
  959. 2: lmg %r0,%r11,SP_R0(%r15)
  960. lg %r15,SP_R15(%r15)
  961. 3: la %r12,__LC_RETURN_PSW
  962. br %r14
  963. cleanup_sysc_leave_insn:
  964. .quad sysc_done - 4
  965. .quad sysc_done - 16
  966. cleanup_io_return:
  967. mvc __LC_RETURN_PSW(8),0(%r12)
  968. mvc __LC_RETURN_PSW+8(8),BASED(cleanup_table_io_work_loop)
  969. la %r12,__LC_RETURN_PSW
  970. br %r14
  971. cleanup_io_leave:
  972. clc 8(8,%r12),BASED(cleanup_io_leave_insn)
  973. je 3f
  974. clc 8(8,%r12),BASED(cleanup_io_leave_insn+8)
  975. jhe 0f
  976. mvc __LC_EXIT_TIMER(8),__LC_ASYNC_ENTER_TIMER
  977. 0: mvc __LC_RETURN_PSW(16),SP_PSW(%r15)
  978. cghi %r12,__LC_MCK_OLD_PSW
  979. jne 1f
  980. mvc __LC_SAVE_AREA+64(32),SP_R12(%r15)
  981. j 2f
  982. 1: mvc __LC_SAVE_AREA+32(32),SP_R12(%r15)
  983. 2: lmg %r0,%r11,SP_R0(%r15)
  984. lg %r15,SP_R15(%r15)
  985. 3: la %r12,__LC_RETURN_PSW
  986. br %r14
  987. cleanup_io_leave_insn:
  988. .quad io_done - 4
  989. .quad io_done - 16
  990. /*
  991. * Integer constants
  992. */
  993. .align 4
  994. .Lconst:
  995. .Lnr_syscalls: .long NR_syscalls
  996. .L0x0130: .short 0x130
  997. .L0x0140: .short 0x140
  998. .L0x0150: .short 0x150
  999. .L0x0160: .short 0x160
  1000. .L0x0170: .short 0x170
  1001. .Lcritical_start:
  1002. .quad __critical_start
  1003. .Lcritical_end:
  1004. .quad __critical_end
  1005. .section .rodata, "a"
  1006. #define SYSCALL(esa,esame,emu) .long esame
  1007. .globl sys_call_table
  1008. sys_call_table:
  1009. #include "syscalls.S"
  1010. #undef SYSCALL
  1011. #ifdef CONFIG_COMPAT
  1012. #define SYSCALL(esa,esame,emu) .long emu
  1013. sys_call_table_emu:
  1014. #include "syscalls.S"
  1015. #undef SYSCALL
  1016. #endif