entry64.S 31 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074
  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_FTRACE>>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. .align 8
  266. .globl sysc_restore_trace_psw
  267. sysc_restore_trace_psw:
  268. .quad 0, sysc_restore_trace
  269. #endif
  270. #
  271. # recheck if there is more work to do
  272. #
  273. sysc_work_loop:
  274. tm __TI_flags+7(%r9),_TIF_WORK_SVC
  275. jz sysc_restore # there is no work to do
  276. #
  277. # One of the work bits is on. Find out which one.
  278. #
  279. sysc_work:
  280. tm SP_PSW+1(%r15),0x01 # returning to user ?
  281. jno sysc_restore
  282. tm __TI_flags+7(%r9),_TIF_MCCK_PENDING
  283. jo sysc_mcck_pending
  284. tm __TI_flags+7(%r9),_TIF_NEED_RESCHED
  285. jo sysc_reschedule
  286. tm __TI_flags+7(%r9),_TIF_SIGPENDING
  287. jnz sysc_sigpending
  288. tm __TI_flags+7(%r9),_TIF_NOTIFY_RESUME
  289. jnz sysc_notify_resume
  290. tm __TI_flags+7(%r9),_TIF_RESTART_SVC
  291. jo sysc_restart
  292. tm __TI_flags+7(%r9),_TIF_SINGLE_STEP
  293. jo sysc_singlestep
  294. j sysc_restore
  295. sysc_work_done:
  296. #
  297. # _TIF_NEED_RESCHED is set, call schedule
  298. #
  299. sysc_reschedule:
  300. larl %r14,sysc_work_loop
  301. jg schedule # return point is sysc_return
  302. #
  303. # _TIF_MCCK_PENDING is set, call handler
  304. #
  305. sysc_mcck_pending:
  306. larl %r14,sysc_work_loop
  307. jg s390_handle_mcck # TIF bit will be cleared by handler
  308. #
  309. # _TIF_SIGPENDING is set, call do_signal
  310. #
  311. sysc_sigpending:
  312. ni __TI_flags+7(%r9),255-_TIF_SINGLE_STEP # clear TIF_SINGLE_STEP
  313. la %r2,SP_PTREGS(%r15) # load pt_regs
  314. brasl %r14,do_signal # call do_signal
  315. tm __TI_flags+7(%r9),_TIF_RESTART_SVC
  316. jo sysc_restart
  317. tm __TI_flags+7(%r9),_TIF_SINGLE_STEP
  318. jo sysc_singlestep
  319. j sysc_work_loop
  320. #
  321. # _TIF_NOTIFY_RESUME is set, call do_notify_resume
  322. #
  323. sysc_notify_resume:
  324. la %r2,SP_PTREGS(%r15) # load pt_regs
  325. larl %r14,sysc_work_loop
  326. jg do_notify_resume # call do_notify_resume
  327. #
  328. # _TIF_RESTART_SVC is set, set up registers and restart svc
  329. #
  330. sysc_restart:
  331. ni __TI_flags+7(%r9),255-_TIF_RESTART_SVC # clear TIF_RESTART_SVC
  332. lg %r7,SP_R2(%r15) # load new svc number
  333. mvc SP_R2(8,%r15),SP_ORIG_R2(%r15) # restore first argument
  334. lmg %r2,%r6,SP_R2(%r15) # load svc arguments
  335. j sysc_do_restart # restart svc
  336. #
  337. # _TIF_SINGLE_STEP is set, call do_single_step
  338. #
  339. sysc_singlestep:
  340. ni __TI_flags+7(%r9),255-_TIF_SINGLE_STEP # clear TIF_SINGLE_STEP
  341. xc SP_SVCNR(2,%r15),SP_SVCNR(%r15) # clear svc number
  342. la %r2,SP_PTREGS(%r15) # address of register-save area
  343. larl %r14,sysc_return # load adr. of system return
  344. jg do_single_step # branch to do_sigtrap
  345. #
  346. # call tracehook_report_syscall_entry/tracehook_report_syscall_exit before
  347. # and after the system call
  348. #
  349. sysc_tracesys:
  350. la %r2,SP_PTREGS(%r15) # load pt_regs
  351. la %r3,0
  352. srl %r7,2
  353. stg %r7,SP_R2(%r15)
  354. brasl %r14,do_syscall_trace_enter
  355. lghi %r0,NR_syscalls
  356. clgr %r0,%r2
  357. jnh sysc_tracenogo
  358. sllg %r7,%r2,2 # svc number *4
  359. lgf %r8,0(%r7,%r10)
  360. sysc_tracego:
  361. lmg %r3,%r6,SP_R3(%r15)
  362. lg %r2,SP_ORIG_R2(%r15)
  363. basr %r14,%r8 # call sys_xxx
  364. stg %r2,SP_R2(%r15) # store return value
  365. sysc_tracenogo:
  366. tm __TI_flags+6(%r9),_TIF_SYSCALL
  367. jz sysc_return
  368. la %r2,SP_PTREGS(%r15) # load pt_regs
  369. larl %r14,sysc_return # return point is sysc_return
  370. jg do_syscall_trace_exit
  371. #
  372. # a new process exits the kernel with ret_from_fork
  373. #
  374. .globl ret_from_fork
  375. ret_from_fork:
  376. lg %r13,__LC_SVC_NEW_PSW+8
  377. lg %r9,__LC_THREAD_INFO # load pointer to thread_info struct
  378. tm SP_PSW+1(%r15),0x01 # forking a kernel thread ?
  379. jo 0f
  380. stg %r15,SP_R15(%r15) # store stack pointer for new kthread
  381. 0: brasl %r14,schedule_tail
  382. TRACE_IRQS_ON
  383. stosm 24(%r15),0x03 # reenable interrupts
  384. j sysc_tracenogo
  385. #
  386. # kernel_execve function needs to deal with pt_regs that is not
  387. # at the usual place
  388. #
  389. .globl kernel_execve
  390. kernel_execve:
  391. stmg %r12,%r15,96(%r15)
  392. lgr %r14,%r15
  393. aghi %r15,-SP_SIZE
  394. stg %r14,__SF_BACKCHAIN(%r15)
  395. la %r12,SP_PTREGS(%r15)
  396. xc 0(__PT_SIZE,%r12),0(%r12)
  397. lgr %r5,%r12
  398. brasl %r14,do_execve
  399. ltgfr %r2,%r2
  400. je 0f
  401. aghi %r15,SP_SIZE
  402. lmg %r12,%r15,96(%r15)
  403. br %r14
  404. # execve succeeded.
  405. 0: stnsm __SF_EMPTY(%r15),0xfc # disable interrupts
  406. lg %r15,__LC_KERNEL_STACK # load ksp
  407. aghi %r15,-SP_SIZE # make room for registers & psw
  408. lg %r13,__LC_SVC_NEW_PSW+8
  409. lg %r9,__LC_THREAD_INFO
  410. mvc SP_PTREGS(__PT_SIZE,%r15),0(%r12) # copy pt_regs
  411. xc __SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
  412. stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
  413. brasl %r14,execve_tail
  414. j sysc_return
  415. /*
  416. * Program check handler routine
  417. */
  418. .globl pgm_check_handler
  419. pgm_check_handler:
  420. /*
  421. * First we need to check for a special case:
  422. * Single stepping an instruction that disables the PER event mask will
  423. * cause a PER event AFTER the mask has been set. Example: SVC or LPSW.
  424. * For a single stepped SVC the program check handler gets control after
  425. * the SVC new PSW has been loaded. But we want to execute the SVC first and
  426. * then handle the PER event. Therefore we update the SVC old PSW to point
  427. * to the pgm_check_handler and branch to the SVC handler after we checked
  428. * if we have to load the kernel stack register.
  429. * For every other possible cause for PER event without the PER mask set
  430. * we just ignore the PER event (FIXME: is there anything we have to do
  431. * for LPSW?).
  432. */
  433. stpt __LC_SYNC_ENTER_TIMER
  434. SAVE_ALL_BASE __LC_SAVE_AREA
  435. tm __LC_PGM_INT_CODE+1,0x80 # check whether we got a per exception
  436. jnz pgm_per # got per exception -> special case
  437. SAVE_ALL_SYNC __LC_PGM_OLD_PSW,__LC_SAVE_AREA
  438. CREATE_STACK_FRAME __LC_PGM_OLD_PSW,__LC_SAVE_AREA
  439. tm SP_PSW+1(%r15),0x01 # interrupting from user ?
  440. jz pgm_no_vtime
  441. UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
  442. UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
  443. mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
  444. pgm_no_vtime:
  445. lg %r9,__LC_THREAD_INFO # load pointer to thread_info struct
  446. mvc SP_ARGS(8,%r15),__LC_LAST_BREAK
  447. TRACE_IRQS_OFF
  448. lgf %r3,__LC_PGM_ILC # load program interruption code
  449. lghi %r8,0x7f
  450. ngr %r8,%r3
  451. pgm_do_call:
  452. sll %r8,3
  453. larl %r1,pgm_check_table
  454. lg %r1,0(%r8,%r1) # load address of handler routine
  455. la %r2,SP_PTREGS(%r15) # address of register-save area
  456. larl %r14,sysc_return
  457. br %r1 # branch to interrupt-handler
  458. #
  459. # handle per exception
  460. #
  461. pgm_per:
  462. tm __LC_PGM_OLD_PSW,0x40 # test if per event recording is on
  463. jnz pgm_per_std # ok, normal per event from user space
  464. # ok its one of the special cases, now we need to find out which one
  465. clc __LC_PGM_OLD_PSW(16),__LC_SVC_NEW_PSW
  466. je pgm_svcper
  467. # no interesting special case, ignore PER event
  468. lmg %r12,%r15,__LC_SAVE_AREA
  469. lpswe __LC_PGM_OLD_PSW
  470. #
  471. # Normal per exception
  472. #
  473. pgm_per_std:
  474. SAVE_ALL_SYNC __LC_PGM_OLD_PSW,__LC_SAVE_AREA
  475. CREATE_STACK_FRAME __LC_PGM_OLD_PSW,__LC_SAVE_AREA
  476. tm SP_PSW+1(%r15),0x01 # interrupting from user ?
  477. jz pgm_no_vtime2
  478. UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
  479. UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
  480. mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
  481. pgm_no_vtime2:
  482. lg %r9,__LC_THREAD_INFO # load pointer to thread_info struct
  483. TRACE_IRQS_OFF
  484. lg %r1,__TI_task(%r9)
  485. tm SP_PSW+1(%r15),0x01 # kernel per event ?
  486. jz kernel_per
  487. mvc __THREAD_per+__PER_atmid(2,%r1),__LC_PER_ATMID
  488. mvc __THREAD_per+__PER_address(8,%r1),__LC_PER_ADDRESS
  489. mvc __THREAD_per+__PER_access_id(1,%r1),__LC_PER_ACCESS_ID
  490. oi __TI_flags+7(%r9),_TIF_SINGLE_STEP # set TIF_SINGLE_STEP
  491. lgf %r3,__LC_PGM_ILC # load program interruption code
  492. lghi %r8,0x7f
  493. ngr %r8,%r3 # clear per-event-bit and ilc
  494. je sysc_return
  495. j pgm_do_call
  496. #
  497. # it was a single stepped SVC that is causing all the trouble
  498. #
  499. pgm_svcper:
  500. SAVE_ALL_SYNC __LC_SVC_OLD_PSW,__LC_SAVE_AREA
  501. CREATE_STACK_FRAME __LC_SVC_OLD_PSW,__LC_SAVE_AREA
  502. UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
  503. UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
  504. mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
  505. llgh %r7,__LC_SVC_INT_CODE # get svc number from lowcore
  506. lg %r9,__LC_THREAD_INFO # load pointer to thread_info struct
  507. lg %r1,__TI_task(%r9)
  508. mvc __THREAD_per+__PER_atmid(2,%r1),__LC_PER_ATMID
  509. mvc __THREAD_per+__PER_address(8,%r1),__LC_PER_ADDRESS
  510. mvc __THREAD_per+__PER_access_id(1,%r1),__LC_PER_ACCESS_ID
  511. oi __TI_flags+7(%r9),_TIF_SINGLE_STEP # set TIF_SINGLE_STEP
  512. TRACE_IRQS_ON
  513. stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
  514. j sysc_do_svc
  515. #
  516. # per was called from kernel, must be kprobes
  517. #
  518. kernel_per:
  519. xc SP_SVCNR(2,%r15),SP_SVCNR(%r15) # clear svc number
  520. la %r2,SP_PTREGS(%r15) # address of register-save area
  521. larl %r14,sysc_restore # load adr. of system ret, no work
  522. jg do_single_step # branch to do_single_step
  523. /*
  524. * IO interrupt handler routine
  525. */
  526. .globl io_int_handler
  527. io_int_handler:
  528. stck __LC_INT_CLOCK
  529. stpt __LC_ASYNC_ENTER_TIMER
  530. SAVE_ALL_BASE __LC_SAVE_AREA+32
  531. SAVE_ALL_ASYNC __LC_IO_OLD_PSW,__LC_SAVE_AREA+32
  532. CREATE_STACK_FRAME __LC_IO_OLD_PSW,__LC_SAVE_AREA+32
  533. tm SP_PSW+1(%r15),0x01 # interrupting from user ?
  534. jz io_no_vtime
  535. UPDATE_VTIME __LC_EXIT_TIMER,__LC_ASYNC_ENTER_TIMER,__LC_USER_TIMER
  536. UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
  537. mvc __LC_LAST_UPDATE_TIMER(8),__LC_ASYNC_ENTER_TIMER
  538. io_no_vtime:
  539. lg %r9,__LC_THREAD_INFO # load pointer to thread_info struct
  540. TRACE_IRQS_OFF
  541. la %r2,SP_PTREGS(%r15) # address of register-save area
  542. brasl %r14,do_IRQ # call standard irq handler
  543. io_return:
  544. tm __TI_flags+7(%r9),_TIF_WORK_INT
  545. jnz io_work # there is work to do (signals etc.)
  546. io_restore:
  547. #ifdef CONFIG_TRACE_IRQFLAGS
  548. larl %r1,io_restore_trace_psw
  549. lpswe 0(%r1)
  550. io_restore_trace:
  551. TRACE_IRQS_CHECK
  552. LOCKDEP_SYS_EXIT
  553. #endif
  554. io_leave:
  555. RESTORE_ALL __LC_RETURN_PSW,0
  556. io_done:
  557. #ifdef CONFIG_TRACE_IRQFLAGS
  558. .align 8
  559. .globl io_restore_trace_psw
  560. io_restore_trace_psw:
  561. .quad 0, io_restore_trace
  562. #endif
  563. #
  564. # There is work todo, we need to check if we return to userspace, then
  565. # check, if we are in SIE, if yes leave it
  566. #
  567. io_work:
  568. tm SP_PSW+1(%r15),0x01 # returning to user ?
  569. #ifndef CONFIG_PREEMPT
  570. #if defined(CONFIG_KVM) || defined(CONFIG_KVM_MODULE)
  571. jnz io_work_user # yes -> no need to check for SIE
  572. la %r1, BASED(sie_opcode) # we return to kernel here
  573. lg %r2, SP_PSW+8(%r15)
  574. clc 0(2,%r1), 0(%r2) # is current instruction = SIE?
  575. jne io_restore # no-> return to kernel
  576. lg %r1, SP_PSW+8(%r15) # yes-> add 4 bytes to leave SIE
  577. aghi %r1, 4
  578. stg %r1, SP_PSW+8(%r15)
  579. j io_restore # return to kernel
  580. #else
  581. jno io_restore # no-> skip resched & signal
  582. #endif
  583. #else
  584. jnz io_work_user # yes -> do resched & signal
  585. #if defined(CONFIG_KVM) || defined(CONFIG_KVM_MODULE)
  586. la %r1, BASED(sie_opcode)
  587. lg %r2, SP_PSW+8(%r15)
  588. clc 0(2,%r1), 0(%r2) # is current instruction = SIE?
  589. jne 0f # no -> leave PSW alone
  590. lg %r1, SP_PSW+8(%r15) # yes-> add 4 bytes to leave SIE
  591. aghi %r1, 4
  592. stg %r1, SP_PSW+8(%r15)
  593. 0:
  594. #endif
  595. # check for preemptive scheduling
  596. icm %r0,15,__TI_precount(%r9)
  597. jnz io_restore # preemption is disabled
  598. # switch to kernel stack
  599. lg %r1,SP_R15(%r15)
  600. aghi %r1,-SP_SIZE
  601. mvc SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)
  602. xc __SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1) # clear back chain
  603. lgr %r15,%r1
  604. io_resume_loop:
  605. tm __TI_flags+7(%r9),_TIF_NEED_RESCHED
  606. jno io_restore
  607. larl %r14,io_resume_loop
  608. jg preempt_schedule_irq
  609. #endif
  610. io_work_user:
  611. lg %r1,__LC_KERNEL_STACK
  612. aghi %r1,-SP_SIZE
  613. mvc SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)
  614. xc __SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1) # clear back chain
  615. lgr %r15,%r1
  616. #
  617. # One of the work bits is on. Find out which one.
  618. # Checked are: _TIF_SIGPENDING, _TIF_RESTORE_SIGPENDING, _TIF_NEED_RESCHED
  619. # and _TIF_MCCK_PENDING
  620. #
  621. io_work_loop:
  622. tm __TI_flags+7(%r9),_TIF_MCCK_PENDING
  623. jo io_mcck_pending
  624. tm __TI_flags+7(%r9),_TIF_NEED_RESCHED
  625. jo io_reschedule
  626. tm __TI_flags+7(%r9),_TIF_SIGPENDING
  627. jnz io_sigpending
  628. tm __TI_flags+7(%r9),_TIF_NOTIFY_RESUME
  629. jnz io_notify_resume
  630. j io_restore
  631. io_work_done:
  632. #if defined(CONFIG_KVM) || defined(CONFIG_KVM_MODULE)
  633. sie_opcode:
  634. .long 0xb2140000
  635. #endif
  636. #
  637. # _TIF_MCCK_PENDING is set, call handler
  638. #
  639. io_mcck_pending:
  640. brasl %r14,s390_handle_mcck # TIF bit will be cleared by handler
  641. j io_work_loop
  642. #
  643. # _TIF_NEED_RESCHED is set, call schedule
  644. #
  645. io_reschedule:
  646. TRACE_IRQS_ON
  647. stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
  648. brasl %r14,schedule # call scheduler
  649. stnsm __SF_EMPTY(%r15),0xfc # disable I/O and ext. interrupts
  650. TRACE_IRQS_OFF
  651. tm __TI_flags+7(%r9),_TIF_WORK_INT
  652. jz io_restore # there is no work to do
  653. j io_work_loop
  654. #
  655. # _TIF_SIGPENDING or is set, call do_signal
  656. #
  657. io_sigpending:
  658. TRACE_IRQS_ON
  659. stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
  660. la %r2,SP_PTREGS(%r15) # load pt_regs
  661. brasl %r14,do_signal # call do_signal
  662. stnsm __SF_EMPTY(%r15),0xfc # disable I/O and ext. interrupts
  663. TRACE_IRQS_OFF
  664. j io_work_loop
  665. #
  666. # _TIF_NOTIFY_RESUME or is set, call do_notify_resume
  667. #
  668. io_notify_resume:
  669. TRACE_IRQS_ON
  670. stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
  671. la %r2,SP_PTREGS(%r15) # load pt_regs
  672. brasl %r14,do_notify_resume # call do_notify_resume
  673. stnsm __SF_EMPTY(%r15),0xfc # disable I/O and ext. interrupts
  674. TRACE_IRQS_OFF
  675. j io_work_loop
  676. /*
  677. * External interrupt handler routine
  678. */
  679. .globl ext_int_handler
  680. ext_int_handler:
  681. stck __LC_INT_CLOCK
  682. stpt __LC_ASYNC_ENTER_TIMER
  683. SAVE_ALL_BASE __LC_SAVE_AREA+32
  684. SAVE_ALL_ASYNC __LC_EXT_OLD_PSW,__LC_SAVE_AREA+32
  685. CREATE_STACK_FRAME __LC_EXT_OLD_PSW,__LC_SAVE_AREA+32
  686. tm SP_PSW+1(%r15),0x01 # interrupting from user ?
  687. jz ext_no_vtime
  688. UPDATE_VTIME __LC_EXIT_TIMER,__LC_ASYNC_ENTER_TIMER,__LC_USER_TIMER
  689. UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
  690. mvc __LC_LAST_UPDATE_TIMER(8),__LC_ASYNC_ENTER_TIMER
  691. ext_no_vtime:
  692. lg %r9,__LC_THREAD_INFO # load pointer to thread_info struct
  693. TRACE_IRQS_OFF
  694. la %r2,SP_PTREGS(%r15) # address of register-save area
  695. llgh %r3,__LC_EXT_INT_CODE # get interruption code
  696. brasl %r14,do_extint
  697. j io_return
  698. __critical_end:
  699. /*
  700. * Machine check handler routines
  701. */
  702. .globl mcck_int_handler
  703. mcck_int_handler:
  704. stck __LC_INT_CLOCK
  705. la %r1,4095 # revalidate r1
  706. spt __LC_CPU_TIMER_SAVE_AREA-4095(%r1) # revalidate cpu timer
  707. lmg %r0,%r15,__LC_GPREGS_SAVE_AREA-4095(%r1)# revalidate gprs
  708. SAVE_ALL_BASE __LC_SAVE_AREA+64
  709. la %r12,__LC_MCK_OLD_PSW
  710. tm __LC_MCCK_CODE,0x80 # system damage?
  711. jo mcck_int_main # yes -> rest of mcck code invalid
  712. la %r14,4095
  713. mvc __LC_SAVE_AREA+104(8),__LC_ASYNC_ENTER_TIMER
  714. mvc __LC_ASYNC_ENTER_TIMER(8),__LC_CPU_TIMER_SAVE_AREA-4095(%r14)
  715. tm __LC_MCCK_CODE+5,0x02 # stored cpu timer value valid?
  716. jo 1f
  717. la %r14,__LC_SYNC_ENTER_TIMER
  718. clc 0(8,%r14),__LC_ASYNC_ENTER_TIMER
  719. jl 0f
  720. la %r14,__LC_ASYNC_ENTER_TIMER
  721. 0: clc 0(8,%r14),__LC_EXIT_TIMER
  722. jl 0f
  723. la %r14,__LC_EXIT_TIMER
  724. 0: clc 0(8,%r14),__LC_LAST_UPDATE_TIMER
  725. jl 0f
  726. la %r14,__LC_LAST_UPDATE_TIMER
  727. 0: spt 0(%r14)
  728. mvc __LC_ASYNC_ENTER_TIMER(8),0(%r14)
  729. 1: tm __LC_MCCK_CODE+2,0x09 # mwp + ia of old psw valid?
  730. jno mcck_int_main # no -> skip cleanup critical
  731. tm __LC_MCK_OLD_PSW+1,0x01 # test problem state bit
  732. jnz mcck_int_main # from user -> load kernel stack
  733. clc __LC_MCK_OLD_PSW+8(8),BASED(.Lcritical_end)
  734. jhe mcck_int_main
  735. clc __LC_MCK_OLD_PSW+8(8),BASED(.Lcritical_start)
  736. jl mcck_int_main
  737. brasl %r14,cleanup_critical
  738. mcck_int_main:
  739. lg %r14,__LC_PANIC_STACK # are we already on the panic stack?
  740. slgr %r14,%r15
  741. srag %r14,%r14,PAGE_SHIFT
  742. jz 0f
  743. lg %r15,__LC_PANIC_STACK # load panic stack
  744. 0: CREATE_STACK_FRAME __LC_MCK_OLD_PSW,__LC_SAVE_AREA+64
  745. tm __LC_MCCK_CODE+2,0x08 # mwp of old psw valid?
  746. jno mcck_no_vtime # no -> no timer update
  747. tm SP_PSW+1(%r15),0x01 # interrupting from user ?
  748. jz mcck_no_vtime
  749. UPDATE_VTIME __LC_EXIT_TIMER,__LC_ASYNC_ENTER_TIMER,__LC_USER_TIMER
  750. UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
  751. mvc __LC_LAST_UPDATE_TIMER(8),__LC_ASYNC_ENTER_TIMER
  752. mcck_no_vtime:
  753. lg %r9,__LC_THREAD_INFO # load pointer to thread_info struct
  754. la %r2,SP_PTREGS(%r15) # load pt_regs
  755. brasl %r14,s390_do_machine_check
  756. tm SP_PSW+1(%r15),0x01 # returning to user ?
  757. jno mcck_return
  758. lg %r1,__LC_KERNEL_STACK # switch to kernel stack
  759. aghi %r1,-SP_SIZE
  760. mvc SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)
  761. xc __SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1) # clear back chain
  762. lgr %r15,%r1
  763. stosm __SF_EMPTY(%r15),0x04 # turn dat on
  764. tm __TI_flags+7(%r9),_TIF_MCCK_PENDING
  765. jno mcck_return
  766. TRACE_IRQS_OFF
  767. brasl %r14,s390_handle_mcck
  768. TRACE_IRQS_ON
  769. mcck_return:
  770. mvc __LC_RETURN_MCCK_PSW(16),SP_PSW(%r15) # move return PSW
  771. ni __LC_RETURN_MCCK_PSW+1,0xfd # clear wait state bit
  772. lmg %r0,%r15,SP_R0(%r15) # load gprs 0-15
  773. mvc __LC_ASYNC_ENTER_TIMER(8),__LC_SAVE_AREA+104
  774. tm __LC_RETURN_MCCK_PSW+1,0x01 # returning to user ?
  775. jno 0f
  776. stpt __LC_EXIT_TIMER
  777. 0: lpswe __LC_RETURN_MCCK_PSW # back to caller
  778. /*
  779. * Restart interruption handler, kick starter for additional CPUs
  780. */
  781. #ifdef CONFIG_SMP
  782. __CPUINIT
  783. .globl restart_int_handler
  784. restart_int_handler:
  785. basr %r1,0
  786. restart_base:
  787. spt restart_vtime-restart_base(%r1)
  788. stck __LC_LAST_UPDATE_CLOCK
  789. mvc __LC_LAST_UPDATE_TIMER(8),restart_vtime-restart_base(%r1)
  790. mvc __LC_EXIT_TIMER(8),restart_vtime-restart_base(%r1)
  791. lg %r15,__LC_SAVE_AREA+120 # load ksp
  792. lghi %r10,__LC_CREGS_SAVE_AREA
  793. lctlg %c0,%c15,0(%r10) # get new ctl regs
  794. lghi %r10,__LC_AREGS_SAVE_AREA
  795. lam %a0,%a15,0(%r10)
  796. lmg %r6,%r15,__SF_GPRS(%r15) # load registers from clone
  797. lg %r1,__LC_THREAD_INFO
  798. mvc __LC_USER_TIMER(8),__TI_user_timer(%r1)
  799. mvc __LC_SYSTEM_TIMER(8),__TI_system_timer(%r1)
  800. xc __LC_STEAL_TIMER(8),__LC_STEAL_TIMER
  801. stosm __SF_EMPTY(%r15),0x04 # now we can turn dat on
  802. jg start_secondary
  803. .align 8
  804. restart_vtime:
  805. .long 0x7fffffff,0xffffffff
  806. .previous
  807. #else
  808. /*
  809. * If we do not run with SMP enabled, let the new CPU crash ...
  810. */
  811. .globl restart_int_handler
  812. restart_int_handler:
  813. basr %r1,0
  814. restart_base:
  815. lpswe restart_crash-restart_base(%r1)
  816. .align 8
  817. restart_crash:
  818. .long 0x000a0000,0x00000000,0x00000000,0x00000000
  819. restart_go:
  820. #endif
  821. #ifdef CONFIG_CHECK_STACK
  822. /*
  823. * The synchronous or the asynchronous stack overflowed. We are dead.
  824. * No need to properly save the registers, we are going to panic anyway.
  825. * Setup a pt_regs so that show_trace can provide a good call trace.
  826. */
  827. stack_overflow:
  828. lg %r15,__LC_PANIC_STACK # change to panic stack
  829. aghi %r15,-SP_SIZE
  830. mvc SP_PSW(16,%r15),0(%r12) # move user PSW to stack
  831. stmg %r0,%r11,SP_R0(%r15) # store gprs %r0-%r11 to kernel stack
  832. la %r1,__LC_SAVE_AREA
  833. chi %r12,__LC_SVC_OLD_PSW
  834. je 0f
  835. chi %r12,__LC_PGM_OLD_PSW
  836. je 0f
  837. la %r1,__LC_SAVE_AREA+32
  838. 0: mvc SP_R12(32,%r15),0(%r1) # move %r12-%r15 to stack
  839. mvc SP_ARGS(8,%r15),__LC_LAST_BREAK
  840. xc __SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15) # clear back chain
  841. la %r2,SP_PTREGS(%r15) # load pt_regs
  842. jg kernel_stack_overflow
  843. #endif
  844. cleanup_table_system_call:
  845. .quad system_call, sysc_do_svc
  846. cleanup_table_sysc_return:
  847. .quad sysc_return, sysc_leave
  848. cleanup_table_sysc_leave:
  849. .quad sysc_leave, sysc_done
  850. cleanup_table_sysc_work_loop:
  851. .quad sysc_work_loop, sysc_work_done
  852. cleanup_table_io_return:
  853. .quad io_return, io_leave
  854. cleanup_table_io_leave:
  855. .quad io_leave, io_done
  856. cleanup_table_io_work_loop:
  857. .quad io_work_loop, io_work_done
  858. cleanup_critical:
  859. clc 8(8,%r12),BASED(cleanup_table_system_call)
  860. jl 0f
  861. clc 8(8,%r12),BASED(cleanup_table_system_call+8)
  862. jl cleanup_system_call
  863. 0:
  864. clc 8(8,%r12),BASED(cleanup_table_sysc_return)
  865. jl 0f
  866. clc 8(8,%r12),BASED(cleanup_table_sysc_return+8)
  867. jl cleanup_sysc_return
  868. 0:
  869. clc 8(8,%r12),BASED(cleanup_table_sysc_leave)
  870. jl 0f
  871. clc 8(8,%r12),BASED(cleanup_table_sysc_leave+8)
  872. jl cleanup_sysc_leave
  873. 0:
  874. clc 8(8,%r12),BASED(cleanup_table_sysc_work_loop)
  875. jl 0f
  876. clc 8(8,%r12),BASED(cleanup_table_sysc_work_loop+8)
  877. jl cleanup_sysc_return
  878. 0:
  879. clc 8(8,%r12),BASED(cleanup_table_io_return)
  880. jl 0f
  881. clc 8(8,%r12),BASED(cleanup_table_io_return+8)
  882. jl cleanup_io_return
  883. 0:
  884. clc 8(8,%r12),BASED(cleanup_table_io_leave)
  885. jl 0f
  886. clc 8(8,%r12),BASED(cleanup_table_io_leave+8)
  887. jl cleanup_io_leave
  888. 0:
  889. clc 8(8,%r12),BASED(cleanup_table_io_work_loop)
  890. jl 0f
  891. clc 8(8,%r12),BASED(cleanup_table_io_work_loop+8)
  892. jl cleanup_io_return
  893. 0:
  894. br %r14
  895. cleanup_system_call:
  896. mvc __LC_RETURN_PSW(16),0(%r12)
  897. cghi %r12,__LC_MCK_OLD_PSW
  898. je 0f
  899. la %r12,__LC_SAVE_AREA+32
  900. j 1f
  901. 0: la %r12,__LC_SAVE_AREA+64
  902. 1:
  903. clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn+8)
  904. jh 0f
  905. mvc __LC_SYNC_ENTER_TIMER(8),__LC_ASYNC_ENTER_TIMER
  906. 0: clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn+16)
  907. jhe cleanup_vtime
  908. clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn)
  909. jh 0f
  910. mvc __LC_SAVE_AREA(32),0(%r12)
  911. 0: stg %r13,8(%r12)
  912. stg %r12,__LC_SAVE_AREA+96 # argh
  913. SAVE_ALL_SYNC __LC_SVC_OLD_PSW,__LC_SAVE_AREA
  914. CREATE_STACK_FRAME __LC_SVC_OLD_PSW,__LC_SAVE_AREA
  915. lg %r12,__LC_SAVE_AREA+96 # argh
  916. stg %r15,24(%r12)
  917. llgh %r7,__LC_SVC_INT_CODE
  918. cleanup_vtime:
  919. clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn+24)
  920. jhe cleanup_stime
  921. UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
  922. cleanup_stime:
  923. clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn+32)
  924. jh cleanup_update
  925. UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
  926. cleanup_update:
  927. mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
  928. mvc __LC_RETURN_PSW+8(8),BASED(cleanup_table_system_call+8)
  929. la %r12,__LC_RETURN_PSW
  930. br %r14
  931. cleanup_system_call_insn:
  932. .quad sysc_saveall
  933. .quad system_call
  934. .quad sysc_vtime
  935. .quad sysc_stime
  936. .quad sysc_update
  937. cleanup_sysc_return:
  938. mvc __LC_RETURN_PSW(8),0(%r12)
  939. mvc __LC_RETURN_PSW+8(8),BASED(cleanup_table_sysc_return)
  940. la %r12,__LC_RETURN_PSW
  941. br %r14
  942. cleanup_sysc_leave:
  943. clc 8(8,%r12),BASED(cleanup_sysc_leave_insn)
  944. je 3f
  945. clc 8(8,%r12),BASED(cleanup_sysc_leave_insn+8)
  946. jhe 0f
  947. mvc __LC_EXIT_TIMER(8),__LC_ASYNC_ENTER_TIMER
  948. 0: mvc __LC_RETURN_PSW(16),SP_PSW(%r15)
  949. cghi %r12,__LC_MCK_OLD_PSW
  950. jne 1f
  951. mvc __LC_SAVE_AREA+64(32),SP_R12(%r15)
  952. j 2f
  953. 1: mvc __LC_SAVE_AREA+32(32),SP_R12(%r15)
  954. 2: lmg %r0,%r11,SP_R0(%r15)
  955. lg %r15,SP_R15(%r15)
  956. 3: la %r12,__LC_RETURN_PSW
  957. br %r14
  958. cleanup_sysc_leave_insn:
  959. .quad sysc_done - 4
  960. .quad sysc_done - 16
  961. cleanup_io_return:
  962. mvc __LC_RETURN_PSW(8),0(%r12)
  963. mvc __LC_RETURN_PSW+8(8),BASED(cleanup_table_io_work_loop)
  964. la %r12,__LC_RETURN_PSW
  965. br %r14
  966. cleanup_io_leave:
  967. clc 8(8,%r12),BASED(cleanup_io_leave_insn)
  968. je 3f
  969. clc 8(8,%r12),BASED(cleanup_io_leave_insn+8)
  970. jhe 0f
  971. mvc __LC_EXIT_TIMER(8),__LC_ASYNC_ENTER_TIMER
  972. 0: mvc __LC_RETURN_PSW(16),SP_PSW(%r15)
  973. cghi %r12,__LC_MCK_OLD_PSW
  974. jne 1f
  975. mvc __LC_SAVE_AREA+64(32),SP_R12(%r15)
  976. j 2f
  977. 1: mvc __LC_SAVE_AREA+32(32),SP_R12(%r15)
  978. 2: lmg %r0,%r11,SP_R0(%r15)
  979. lg %r15,SP_R15(%r15)
  980. 3: la %r12,__LC_RETURN_PSW
  981. br %r14
  982. cleanup_io_leave_insn:
  983. .quad io_done - 4
  984. .quad io_done - 16
  985. /*
  986. * Integer constants
  987. */
  988. .align 4
  989. .Lconst:
  990. .Lnr_syscalls: .long NR_syscalls
  991. .L0x0130: .short 0x130
  992. .L0x0140: .short 0x140
  993. .L0x0150: .short 0x150
  994. .L0x0160: .short 0x160
  995. .L0x0170: .short 0x170
  996. .Lcritical_start:
  997. .quad __critical_start
  998. .Lcritical_end:
  999. .quad __critical_end
  1000. .section .rodata, "a"
  1001. #define SYSCALL(esa,esame,emu) .long esame
  1002. .globl sys_call_table
  1003. sys_call_table:
  1004. #include "syscalls.S"
  1005. #undef SYSCALL
  1006. #ifdef CONFIG_COMPAT
  1007. #define SYSCALL(esa,esame,emu) .long emu
  1008. sys_call_table_emu:
  1009. #include "syscalls.S"
  1010. #undef SYSCALL
  1011. #endif