fsys.S 29 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989
  1. /*
  2. * This file contains the light-weight system call handlers (fsyscall-handlers).
  3. *
  4. * Copyright (C) 2003 Hewlett-Packard Co
  5. * David Mosberger-Tang <davidm@hpl.hp.com>
  6. *
  7. * 25-Sep-03 davidm Implement fsys_rt_sigprocmask().
  8. * 18-Feb-03 louisk Implement fsys_gettimeofday().
  9. * 28-Feb-03 davidm Fixed several bugs in fsys_gettimeofday(). Tuned it some more,
  10. * probably broke it along the way... ;-)
  11. * 13-Jul-04 clameter Implement fsys_clock_gettime and revise fsys_gettimeofday to make
  12. * it capable of using memory based clocks without falling back to C code.
  13. * 08-Feb-07 Fenghua Yu Implement fsys_getcpu.
  14. *
  15. */
  16. #include <asm/asmmacro.h>
  17. #include <asm/errno.h>
  18. #include <asm/asm-offsets.h>
  19. #include <asm/percpu.h>
  20. #include <asm/thread_info.h>
  21. #include <asm/sal.h>
  22. #include <asm/signal.h>
  23. #include <asm/system.h>
  24. #include <asm/unistd.h>
  25. #include "entry.h"
  26. /*
  27. * See Documentation/ia64/fsys.txt for details on fsyscalls.
  28. *
  29. * On entry to an fsyscall handler:
  30. * r10 = 0 (i.e., defaults to "successful syscall return")
  31. * r11 = saved ar.pfs (a user-level value)
  32. * r15 = system call number
  33. * r16 = "current" task pointer (in normal kernel-mode, this is in r13)
  34. * r32-r39 = system call arguments
  35. * b6 = return address (a user-level value)
  36. * ar.pfs = previous frame-state (a user-level value)
  37. * PSR.be = cleared to zero (i.e., little-endian byte order is in effect)
  38. * all other registers may contain values passed in from user-mode
  39. *
  40. * On return from an fsyscall handler:
  41. * r11 = saved ar.pfs (as passed into the fsyscall handler)
  42. * r15 = system call number (as passed into the fsyscall handler)
  43. * r32-r39 = system call arguments (as passed into the fsyscall handler)
  44. * b6 = return address (as passed into the fsyscall handler)
  45. * ar.pfs = previous frame-state (as passed into the fsyscall handler)
  46. */
  47. ENTRY(fsys_ni_syscall)
  48. .prologue
  49. .altrp b6
  50. .body
  51. mov r8=ENOSYS
  52. mov r10=-1
  53. FSYS_RETURN
  54. END(fsys_ni_syscall)
  55. ENTRY(fsys_getpid)
  56. .prologue
  57. .altrp b6
  58. .body
  59. add r9=TI_FLAGS+IA64_TASK_SIZE,r16
  60. ;;
  61. ld4 r9=[r9]
  62. add r8=IA64_TASK_TGID_OFFSET,r16
  63. ;;
  64. and r9=TIF_ALLWORK_MASK,r9
  65. ld4 r8=[r8] // r8 = current->tgid
  66. ;;
  67. cmp.ne p8,p0=0,r9
  68. (p8) br.spnt.many fsys_fallback_syscall
  69. FSYS_RETURN
  70. END(fsys_getpid)
  71. ENTRY(fsys_getppid)
  72. .prologue
  73. .altrp b6
  74. .body
  75. add r17=IA64_TASK_GROUP_LEADER_OFFSET,r16
  76. ;;
  77. ld8 r17=[r17] // r17 = current->group_leader
  78. add r9=TI_FLAGS+IA64_TASK_SIZE,r16
  79. ;;
  80. ld4 r9=[r9]
  81. add r17=IA64_TASK_REAL_PARENT_OFFSET,r17 // r17 = &current->group_leader->real_parent
  82. ;;
  83. and r9=TIF_ALLWORK_MASK,r9
  84. 1: ld8 r18=[r17] // r18 = current->group_leader->real_parent
  85. ;;
  86. cmp.ne p8,p0=0,r9
  87. add r8=IA64_TASK_TGID_OFFSET,r18 // r8 = &current->group_leader->real_parent->tgid
  88. ;;
  89. /*
  90. * The .acq is needed to ensure that the read of tgid has returned its data before
  91. * we re-check "real_parent".
  92. */
  93. ld4.acq r8=[r8] // r8 = current->group_leader->real_parent->tgid
  94. #ifdef CONFIG_SMP
  95. /*
  96. * Re-read current->group_leader->real_parent.
  97. */
  98. ld8 r19=[r17] // r19 = current->group_leader->real_parent
  99. (p8) br.spnt.many fsys_fallback_syscall
  100. ;;
  101. cmp.ne p6,p0=r18,r19 // did real_parent change?
  102. mov r19=0 // i must not leak kernel bits...
  103. (p6) br.cond.spnt.few 1b // yes -> redo the read of tgid and the check
  104. ;;
  105. mov r17=0 // i must not leak kernel bits...
  106. mov r18=0 // i must not leak kernel bits...
  107. #else
  108. mov r17=0 // i must not leak kernel bits...
  109. mov r18=0 // i must not leak kernel bits...
  110. mov r19=0 // i must not leak kernel bits...
  111. #endif
  112. FSYS_RETURN
  113. END(fsys_getppid)
  114. ENTRY(fsys_set_tid_address)
  115. .prologue
  116. .altrp b6
  117. .body
  118. add r9=TI_FLAGS+IA64_TASK_SIZE,r16
  119. ;;
  120. ld4 r9=[r9]
  121. tnat.z p6,p7=r32 // check argument register for being NaT
  122. ;;
  123. and r9=TIF_ALLWORK_MASK,r9
  124. add r8=IA64_TASK_PID_OFFSET,r16
  125. add r18=IA64_TASK_CLEAR_CHILD_TID_OFFSET,r16
  126. ;;
  127. ld4 r8=[r8]
  128. cmp.ne p8,p0=0,r9
  129. mov r17=-1
  130. ;;
  131. (p6) st8 [r18]=r32
  132. (p7) st8 [r18]=r17
  133. (p8) br.spnt.many fsys_fallback_syscall
  134. ;;
  135. mov r17=0 // i must not leak kernel bits...
  136. mov r18=0 // i must not leak kernel bits...
  137. FSYS_RETURN
  138. END(fsys_set_tid_address)
  139. /*
  140. * Ensure that the time interpolator structure is compatible with the asm code
  141. */
  142. #if IA64_TIME_INTERPOLATOR_SOURCE_OFFSET !=0 || IA64_TIME_INTERPOLATOR_SHIFT_OFFSET != 2 \
  143. || IA64_TIME_INTERPOLATOR_JITTER_OFFSET != 3 || IA64_TIME_INTERPOLATOR_NSEC_OFFSET != 4
  144. #error fsys_gettimeofday incompatible with changes to struct time_interpolator
  145. #endif
  146. #define CLOCK_REALTIME 0
  147. #define CLOCK_MONOTONIC 1
  148. #define CLOCK_DIVIDE_BY_1000 0x4000
  149. #define CLOCK_ADD_MONOTONIC 0x8000
  150. ENTRY(fsys_gettimeofday)
  151. .prologue
  152. .altrp b6
  153. .body
  154. mov r31 = r32
  155. tnat.nz p6,p0 = r33 // guard against NaT argument
  156. (p6) br.cond.spnt.few .fail_einval
  157. mov r30 = CLOCK_DIVIDE_BY_1000
  158. ;;
  159. .gettime:
  160. // Register map
  161. // Incoming r31 = pointer to address where to place result
  162. // r30 = flags determining how time is processed
  163. // r2,r3 = temp r4-r7 preserved
  164. // r8 = result nanoseconds
  165. // r9 = result seconds
  166. // r10 = temporary storage for clock difference
  167. // r11 = preserved: saved ar.pfs
  168. // r12 = preserved: memory stack
  169. // r13 = preserved: thread pointer
  170. // r14 = address of mask / mask
  171. // r15 = preserved: system call number
  172. // r16 = preserved: current task pointer
  173. // r17 = wall to monotonic use
  174. // r18 = time_interpolator->offset
  175. // r19 = address of wall_to_monotonic
  176. // r20 = pointer to struct time_interpolator / pointer to time_interpolator->address
  177. // r21 = shift factor
  178. // r22 = address of time interpolator->last_counter
  179. // r23 = address of time_interpolator->last_cycle
  180. // r24 = adress of time_interpolator->offset
  181. // r25 = last_cycle value
  182. // r26 = last_counter value
  183. // r27 = pointer to xtime
  184. // r28 = sequence number at the beginning of critcal section
  185. // r29 = address of seqlock
  186. // r30 = time processing flags / memory address
  187. // r31 = pointer to result
  188. // Predicates
  189. // p6,p7 short term use
  190. // p8 = timesource ar.itc
  191. // p9 = timesource mmio64
  192. // p10 = timesource mmio32
  193. // p11 = timesource not to be handled by asm code
  194. // p12 = memory time source ( = p9 | p10)
  195. // p13 = do cmpxchg with time_interpolator_last_cycle
  196. // p14 = Divide by 1000
  197. // p15 = Add monotonic
  198. //
  199. // Note that instructions are optimized for McKinley. McKinley can process two
  200. // bundles simultaneously and therefore we continuously try to feed the CPU
  201. // two bundles and then a stop.
  202. tnat.nz p6,p0 = r31 // branch deferred since it does not fit into bundle structure
  203. mov pr = r30,0xc000 // Set predicates according to function
  204. add r2 = TI_FLAGS+IA64_TASK_SIZE,r16
  205. movl r20 = time_interpolator
  206. ;;
  207. ld8 r20 = [r20] // get pointer to time_interpolator structure
  208. movl r29 = xtime_lock
  209. ld4 r2 = [r2] // process work pending flags
  210. movl r27 = xtime
  211. ;; // only one bundle here
  212. ld8 r21 = [r20] // first quad with control information
  213. and r2 = TIF_ALLWORK_MASK,r2
  214. (p6) br.cond.spnt.few .fail_einval // deferred branch
  215. ;;
  216. add r10 = IA64_TIME_INTERPOLATOR_ADDRESS_OFFSET,r20
  217. extr r3 = r21,32,32 // time_interpolator->nsec_per_cyc
  218. extr r8 = r21,0,16 // time_interpolator->source
  219. cmp.ne p6, p0 = 0, r2 // Fallback if work is scheduled
  220. (p6) br.cond.spnt.many fsys_fallback_syscall
  221. ;;
  222. cmp.eq p8,p12 = 0,r8 // Check for cpu timer
  223. cmp.eq p9,p0 = 1,r8 // MMIO64 ?
  224. extr r2 = r21,24,8 // time_interpolator->jitter
  225. cmp.eq p10,p0 = 2,r8 // MMIO32 ?
  226. cmp.ltu p11,p0 = 2,r8 // function or other clock
  227. (p11) br.cond.spnt.many fsys_fallback_syscall
  228. ;;
  229. setf.sig f7 = r3 // Setup for scaling of counter
  230. (p15) movl r19 = wall_to_monotonic
  231. (p12) ld8 r30 = [r10]
  232. cmp.ne p13,p0 = r2,r0 // need jitter compensation?
  233. extr r21 = r21,16,8 // shift factor
  234. ;;
  235. .time_redo:
  236. .pred.rel.mutex p8,p9,p10
  237. ld4.acq r28 = [r29] // xtime_lock.sequence. Must come first for locking purposes
  238. (p8) mov r2 = ar.itc // CPU_TIMER. 36 clocks latency!!!
  239. add r22 = IA64_TIME_INTERPOLATOR_LAST_COUNTER_OFFSET,r20
  240. (p9) ld8 r2 = [r30] // readq(ti->address). Could also have latency issues..
  241. (p10) ld4 r2 = [r30] // readw(ti->address)
  242. (p13) add r23 = IA64_TIME_INTERPOLATOR_LAST_CYCLE_OFFSET,r20
  243. ;; // could be removed by moving the last add upward
  244. ld8 r26 = [r22] // time_interpolator->last_counter
  245. (p13) ld8 r25 = [r23] // time interpolator->last_cycle
  246. add r24 = IA64_TIME_INTERPOLATOR_OFFSET_OFFSET,r20
  247. (p15) ld8 r17 = [r19],IA64_TIMESPEC_TV_NSEC_OFFSET
  248. ld8 r9 = [r27],IA64_TIMESPEC_TV_NSEC_OFFSET
  249. add r14 = IA64_TIME_INTERPOLATOR_MASK_OFFSET, r20
  250. ;;
  251. ld8 r18 = [r24] // time_interpolator->offset
  252. ld8 r8 = [r27],-IA64_TIMESPEC_TV_NSEC_OFFSET // xtime.tv_nsec
  253. (p13) sub r3 = r25,r2 // Diff needed before comparison (thanks davidm)
  254. ;;
  255. ld8 r14 = [r14] // time_interpolator->mask
  256. (p13) cmp.gt.unc p6,p7 = r3,r0 // check if it is less than last. p6,p7 cleared
  257. sub r10 = r2,r26 // current_counter - last_counter
  258. ;;
  259. (p6) sub r10 = r25,r26 // time we got was less than last_cycle
  260. (p7) mov ar.ccv = r25 // more than last_cycle. Prep for cmpxchg
  261. ;;
  262. and r10 = r10,r14 // Apply mask
  263. ;;
  264. setf.sig f8 = r10
  265. nop.i 123
  266. ;;
  267. (p7) cmpxchg8.rel r3 = [r23],r2,ar.ccv
  268. EX(.fail_efault, probe.w.fault r31, 3) // This takes 5 cycles and we have spare time
  269. xmpy.l f8 = f8,f7 // nsec_per_cyc*(counter-last_counter)
  270. (p15) add r9 = r9,r17 // Add wall to monotonic.secs to result secs
  271. ;;
  272. (p15) ld8 r17 = [r19],-IA64_TIMESPEC_TV_NSEC_OFFSET
  273. (p7) cmp.ne p7,p0 = r25,r3 // if cmpxchg not successful redo
  274. // simulate tbit.nz.or p7,p0 = r28,0
  275. and r28 = ~1,r28 // Make sequence even to force retry if odd
  276. getf.sig r2 = f8
  277. mf
  278. add r8 = r8,r18 // Add time interpolator offset
  279. ;;
  280. ld4 r10 = [r29] // xtime_lock.sequence
  281. (p15) add r8 = r8, r17 // Add monotonic.nsecs to nsecs
  282. shr.u r2 = r2,r21
  283. ;; // overloaded 3 bundles!
  284. // End critical section.
  285. add r8 = r8,r2 // Add xtime.nsecs
  286. cmp4.ne.or p7,p0 = r28,r10
  287. (p7) br.cond.dpnt.few .time_redo // sequence number changed ?
  288. // Now r8=tv->tv_nsec and r9=tv->tv_sec
  289. mov r10 = r0
  290. movl r2 = 1000000000
  291. add r23 = IA64_TIMESPEC_TV_NSEC_OFFSET, r31
  292. (p14) movl r3 = 2361183241434822607 // Prep for / 1000 hack
  293. ;;
  294. .time_normalize:
  295. mov r21 = r8
  296. cmp.ge p6,p0 = r8,r2
  297. (p14) shr.u r20 = r8, 3 // We can repeat this if necessary just wasting some time
  298. ;;
  299. (p14) setf.sig f8 = r20
  300. (p6) sub r8 = r8,r2
  301. (p6) add r9 = 1,r9 // two nops before the branch.
  302. (p14) setf.sig f7 = r3 // Chances for repeats are 1 in 10000 for gettod
  303. (p6) br.cond.dpnt.few .time_normalize
  304. ;;
  305. // Divided by 8 though shift. Now divide by 125
  306. // The compiler was able to do that with a multiply
  307. // and a shift and we do the same
  308. EX(.fail_efault, probe.w.fault r23, 3) // This also costs 5 cycles
  309. (p14) xmpy.hu f8 = f8, f7 // xmpy has 5 cycles latency so use it...
  310. ;;
  311. mov r8 = r0
  312. (p14) getf.sig r2 = f8
  313. ;;
  314. (p14) shr.u r21 = r2, 4
  315. ;;
  316. EX(.fail_efault, st8 [r31] = r9)
  317. EX(.fail_efault, st8 [r23] = r21)
  318. FSYS_RETURN
  319. .fail_einval:
  320. mov r8 = EINVAL
  321. mov r10 = -1
  322. FSYS_RETURN
  323. .fail_efault:
  324. mov r8 = EFAULT
  325. mov r10 = -1
  326. FSYS_RETURN
  327. END(fsys_gettimeofday)
  328. ENTRY(fsys_clock_gettime)
  329. .prologue
  330. .altrp b6
  331. .body
  332. cmp4.ltu p6, p0 = CLOCK_MONOTONIC, r32
  333. // Fallback if this is not CLOCK_REALTIME or CLOCK_MONOTONIC
  334. (p6) br.spnt.few fsys_fallback_syscall
  335. mov r31 = r33
  336. shl r30 = r32,15
  337. br.many .gettime
  338. END(fsys_clock_gettime)
  339. /*
  340. * long fsys_rt_sigprocmask (int how, sigset_t *set, sigset_t *oset, size_t sigsetsize).
  341. */
  342. #if _NSIG_WORDS != 1
  343. # error Sorry, fsys_rt_sigprocmask() needs to be updated for _NSIG_WORDS != 1.
  344. #endif
  345. ENTRY(fsys_rt_sigprocmask)
  346. .prologue
  347. .altrp b6
  348. .body
  349. add r2=IA64_TASK_BLOCKED_OFFSET,r16
  350. add r9=TI_FLAGS+IA64_TASK_SIZE,r16
  351. cmp4.ltu p6,p0=SIG_SETMASK,r32
  352. cmp.ne p15,p0=r0,r34 // oset != NULL?
  353. tnat.nz p8,p0=r34
  354. add r31=IA64_TASK_SIGHAND_OFFSET,r16
  355. ;;
  356. ld8 r3=[r2] // read/prefetch current->blocked
  357. ld4 r9=[r9]
  358. tnat.nz.or p6,p0=r35
  359. cmp.ne.or p6,p0=_NSIG_WORDS*8,r35
  360. tnat.nz.or p6,p0=r32
  361. (p6) br.spnt.few .fail_einval // fail with EINVAL
  362. ;;
  363. #ifdef CONFIG_SMP
  364. ld8 r31=[r31] // r31 <- current->sighand
  365. #endif
  366. and r9=TIF_ALLWORK_MASK,r9
  367. tnat.nz.or p8,p0=r33
  368. ;;
  369. cmp.ne p7,p0=0,r9
  370. cmp.eq p6,p0=r0,r33 // set == NULL?
  371. add r31=IA64_SIGHAND_SIGLOCK_OFFSET,r31 // r31 <- current->sighand->siglock
  372. (p8) br.spnt.few .fail_efault // fail with EFAULT
  373. (p7) br.spnt.many fsys_fallback_syscall // got pending kernel work...
  374. (p6) br.dpnt.many .store_mask // -> short-circuit to just reading the signal mask
  375. /* Argh, we actually have to do some work and _update_ the signal mask: */
  376. EX(.fail_efault, probe.r.fault r33, 3) // verify user has read-access to *set
  377. EX(.fail_efault, ld8 r14=[r33]) // r14 <- *set
  378. mov r17=(1 << (SIGKILL - 1)) | (1 << (SIGSTOP - 1))
  379. ;;
  380. rsm psr.i // mask interrupt delivery
  381. mov ar.ccv=0
  382. andcm r14=r14,r17 // filter out SIGKILL & SIGSTOP
  383. #ifdef CONFIG_SMP
  384. mov r17=1
  385. ;;
  386. cmpxchg4.acq r18=[r31],r17,ar.ccv // try to acquire the lock
  387. mov r8=EINVAL // default to EINVAL
  388. ;;
  389. ld8 r3=[r2] // re-read current->blocked now that we hold the lock
  390. cmp4.ne p6,p0=r18,r0
  391. (p6) br.cond.spnt.many .lock_contention
  392. ;;
  393. #else
  394. ld8 r3=[r2] // re-read current->blocked now that we hold the lock
  395. mov r8=EINVAL // default to EINVAL
  396. #endif
  397. add r18=IA64_TASK_PENDING_OFFSET+IA64_SIGPENDING_SIGNAL_OFFSET,r16
  398. add r19=IA64_TASK_SIGNAL_OFFSET,r16
  399. cmp4.eq p6,p0=SIG_BLOCK,r32
  400. ;;
  401. ld8 r19=[r19] // r19 <- current->signal
  402. cmp4.eq p7,p0=SIG_UNBLOCK,r32
  403. cmp4.eq p8,p0=SIG_SETMASK,r32
  404. ;;
  405. ld8 r18=[r18] // r18 <- current->pending.signal
  406. .pred.rel.mutex p6,p7,p8
  407. (p6) or r14=r3,r14 // SIG_BLOCK
  408. (p7) andcm r14=r3,r14 // SIG_UNBLOCK
  409. (p8) mov r14=r14 // SIG_SETMASK
  410. (p6) mov r8=0 // clear error code
  411. // recalc_sigpending()
  412. add r17=IA64_SIGNAL_GROUP_STOP_COUNT_OFFSET,r19
  413. add r19=IA64_SIGNAL_SHARED_PENDING_OFFSET+IA64_SIGPENDING_SIGNAL_OFFSET,r19
  414. ;;
  415. ld4 r17=[r17] // r17 <- current->signal->group_stop_count
  416. (p7) mov r8=0 // clear error code
  417. ld8 r19=[r19] // r19 <- current->signal->shared_pending
  418. ;;
  419. cmp4.gt p6,p7=r17,r0 // p6/p7 <- (current->signal->group_stop_count > 0)?
  420. (p8) mov r8=0 // clear error code
  421. or r18=r18,r19 // r18 <- current->pending | current->signal->shared_pending
  422. ;;
  423. // r18 <- (current->pending | current->signal->shared_pending) & ~current->blocked:
  424. andcm r18=r18,r14
  425. add r9=TI_FLAGS+IA64_TASK_SIZE,r16
  426. ;;
  427. (p7) cmp.ne.or.andcm p6,p7=r18,r0 // p6/p7 <- signal pending
  428. mov r19=0 // i must not leak kernel bits...
  429. (p6) br.cond.dpnt.many .sig_pending
  430. ;;
  431. 1: ld4 r17=[r9] // r17 <- current->thread_info->flags
  432. ;;
  433. mov ar.ccv=r17
  434. and r18=~_TIF_SIGPENDING,r17 // r18 <- r17 & ~(1 << TIF_SIGPENDING)
  435. ;;
  436. st8 [r2]=r14 // update current->blocked with new mask
  437. cmpxchg4.acq r8=[r9],r18,ar.ccv // current->thread_info->flags <- r18
  438. ;;
  439. cmp.ne p6,p0=r17,r8 // update failed?
  440. (p6) br.cond.spnt.few 1b // yes -> retry
  441. #ifdef CONFIG_SMP
  442. st4.rel [r31]=r0 // release the lock
  443. #endif
  444. ssm psr.i
  445. ;;
  446. srlz.d // ensure psr.i is set again
  447. mov r18=0 // i must not leak kernel bits...
  448. .store_mask:
  449. EX(.fail_efault, (p15) probe.w.fault r34, 3) // verify user has write-access to *oset
  450. EX(.fail_efault, (p15) st8 [r34]=r3)
  451. mov r2=0 // i must not leak kernel bits...
  452. mov r3=0 // i must not leak kernel bits...
  453. mov r8=0 // return 0
  454. mov r9=0 // i must not leak kernel bits...
  455. mov r14=0 // i must not leak kernel bits...
  456. mov r17=0 // i must not leak kernel bits...
  457. mov r31=0 // i must not leak kernel bits...
  458. FSYS_RETURN
  459. .sig_pending:
  460. #ifdef CONFIG_SMP
  461. st4.rel [r31]=r0 // release the lock
  462. #endif
  463. ssm psr.i
  464. ;;
  465. srlz.d
  466. br.sptk.many fsys_fallback_syscall // with signal pending, do the heavy-weight syscall
  467. #ifdef CONFIG_SMP
  468. .lock_contention:
  469. /* Rather than spinning here, fall back on doing a heavy-weight syscall. */
  470. ssm psr.i
  471. ;;
  472. srlz.d
  473. br.sptk.many fsys_fallback_syscall
  474. #endif
  475. END(fsys_rt_sigprocmask)
  476. /*
  477. * fsys_getcpu doesn't use the third parameter in this implementation. It reads
  478. * current_thread_info()->cpu and corresponding node in cpu_to_node_map.
  479. */
  480. ENTRY(fsys_getcpu)
  481. .prologue
  482. .altrp b6
  483. .body
  484. ;;
  485. add r2=TI_FLAGS+IA64_TASK_SIZE,r16
  486. tnat.nz p6,p0 = r32 // guard against NaT argument
  487. add r3=TI_CPU+IA64_TASK_SIZE,r16
  488. ;;
  489. ld4 r3=[r3] // M r3 = thread_info->cpu
  490. ld4 r2=[r2] // M r2 = thread_info->flags
  491. (p6) br.cond.spnt.few .fail_einval // B
  492. ;;
  493. tnat.nz p7,p0 = r33 // I guard against NaT argument
  494. (p7) br.cond.spnt.few .fail_einval // B
  495. #ifdef CONFIG_NUMA
  496. movl r17=cpu_to_node_map
  497. ;;
  498. EX(.fail_efault, probe.w.fault r32, 3) // M This takes 5 cycles
  499. EX(.fail_efault, probe.w.fault r33, 3) // M This takes 5 cycles
  500. shladd r18=r3,1,r17
  501. ;;
  502. ld2 r20=[r18] // r20 = cpu_to_node_map[cpu]
  503. and r2 = TIF_ALLWORK_MASK,r2
  504. ;;
  505. cmp.ne p8,p0=0,r2
  506. (p8) br.spnt.many fsys_fallback_syscall
  507. ;;
  508. ;;
  509. EX(.fail_efault, st4 [r32] = r3)
  510. EX(.fail_efault, st2 [r33] = r20)
  511. mov r8=0
  512. ;;
  513. #else
  514. EX(.fail_efault, probe.w.fault r32, 3) // M This takes 5 cycles
  515. EX(.fail_efault, probe.w.fault r33, 3) // M This takes 5 cycles
  516. and r2 = TIF_ALLWORK_MASK,r2
  517. ;;
  518. cmp.ne p8,p0=0,r2
  519. (p8) br.spnt.many fsys_fallback_syscall
  520. ;;
  521. EX(.fail_efault, st4 [r32] = r3)
  522. EX(.fail_efault, st2 [r33] = r0)
  523. mov r8=0
  524. ;;
  525. #endif
  526. FSYS_RETURN
  527. END(fsys_getcpu)
  528. ENTRY(fsys_fallback_syscall)
  529. .prologue
  530. .altrp b6
  531. .body
  532. /*
  533. * We only get here from light-weight syscall handlers. Thus, we already
  534. * know that r15 contains a valid syscall number. No need to re-check.
  535. */
  536. adds r17=-1024,r15
  537. movl r14=sys_call_table
  538. ;;
  539. rsm psr.i
  540. shladd r18=r17,3,r14
  541. ;;
  542. ld8 r18=[r18] // load normal (heavy-weight) syscall entry-point
  543. mov r29=psr // read psr (12 cyc load latency)
  544. mov r27=ar.rsc
  545. mov r21=ar.fpsr
  546. mov r26=ar.pfs
  547. END(fsys_fallback_syscall)
  548. /* FALL THROUGH */
  549. GLOBAL_ENTRY(fsys_bubble_down)
  550. .prologue
  551. .altrp b6
  552. .body
  553. /*
  554. * We get here for syscalls that don't have a lightweight
  555. * handler. For those, we need to bubble down into the kernel
  556. * and that requires setting up a minimal pt_regs structure,
  557. * and initializing the CPU state more or less as if an
  558. * interruption had occurred. To make syscall-restarts work,
  559. * we setup pt_regs such that cr_iip points to the second
  560. * instruction in syscall_via_break. Decrementing the IP
  561. * hence will restart the syscall via break and not
  562. * decrementing IP will return us to the caller, as usual.
  563. * Note that we preserve the value of psr.pp rather than
  564. * initializing it from dcr.pp. This makes it possible to
  565. * distinguish fsyscall execution from other privileged
  566. * execution.
  567. *
  568. * On entry:
  569. * - normal fsyscall handler register usage, except
  570. * that we also have:
  571. * - r18: address of syscall entry point
  572. * - r21: ar.fpsr
  573. * - r26: ar.pfs
  574. * - r27: ar.rsc
  575. * - r29: psr
  576. *
  577. * We used to clear some PSR bits here but that requires slow
  578. * serialization. Fortuntely, that isn't really necessary.
  579. * The rationale is as follows: we used to clear bits
  580. * ~PSR_PRESERVED_BITS in PSR.L. Since
  581. * PSR_PRESERVED_BITS==PSR.{UP,MFL,MFH,PK,DT,PP,SP,RT,IC}, we
  582. * ended up clearing PSR.{BE,AC,I,DFL,DFH,DI,DB,SI,TB}.
  583. * However,
  584. *
  585. * PSR.BE : already is turned off in __kernel_syscall_via_epc()
  586. * PSR.AC : don't care (kernel normally turns PSR.AC on)
  587. * PSR.I : already turned off by the time fsys_bubble_down gets
  588. * invoked
  589. * PSR.DFL: always 0 (kernel never turns it on)
  590. * PSR.DFH: don't care --- kernel never touches f32-f127 on its own
  591. * initiative
  592. * PSR.DI : always 0 (kernel never turns it on)
  593. * PSR.SI : always 0 (kernel never turns it on)
  594. * PSR.DB : don't care --- kernel never enables kernel-level
  595. * breakpoints
  596. * PSR.TB : must be 0 already; if it wasn't zero on entry to
  597. * __kernel_syscall_via_epc, the branch to fsys_bubble_down
  598. * will trigger a taken branch; the taken-trap-handler then
  599. * converts the syscall into a break-based system-call.
  600. */
  601. /*
  602. * Reading psr.l gives us only bits 0-31, psr.it, and psr.mc.
  603. * The rest we have to synthesize.
  604. */
  605. # define PSR_ONE_BITS ((3 << IA64_PSR_CPL0_BIT) \
  606. | (0x1 << IA64_PSR_RI_BIT) \
  607. | IA64_PSR_BN | IA64_PSR_I)
  608. invala // M0|1
  609. movl r14=ia64_ret_from_syscall // X
  610. nop.m 0
  611. movl r28=__kernel_syscall_via_break // X create cr.iip
  612. ;;
  613. mov r2=r16 // A get task addr to addl-addressable register
  614. adds r16=IA64_TASK_THREAD_ON_USTACK_OFFSET,r16 // A
  615. mov r31=pr // I0 save pr (2 cyc)
  616. ;;
  617. st1 [r16]=r0 // M2|3 clear current->thread.on_ustack flag
  618. addl r22=IA64_RBS_OFFSET,r2 // A compute base of RBS
  619. add r3=TI_FLAGS+IA64_TASK_SIZE,r2 // A
  620. ;;
  621. ld4 r3=[r3] // M0|1 r3 = current_thread_info()->flags
  622. lfetch.fault.excl.nt1 [r22] // M0|1 prefetch register backing-store
  623. nop.i 0
  624. ;;
  625. mov ar.rsc=0 // M2 set enforced lazy mode, pl 0, LE, loadrs=0
  626. nop.m 0
  627. nop.i 0
  628. ;;
  629. mov r23=ar.bspstore // M2 (12 cyc) save ar.bspstore
  630. mov.m r24=ar.rnat // M2 (5 cyc) read ar.rnat (dual-issues!)
  631. nop.i 0
  632. ;;
  633. mov ar.bspstore=r22 // M2 (6 cyc) switch to kernel RBS
  634. movl r8=PSR_ONE_BITS // X
  635. ;;
  636. mov r25=ar.unat // M2 (5 cyc) save ar.unat
  637. mov r19=b6 // I0 save b6 (2 cyc)
  638. mov r20=r1 // A save caller's gp in r20
  639. ;;
  640. or r29=r8,r29 // A construct cr.ipsr value to save
  641. mov b6=r18 // I0 copy syscall entry-point to b6 (7 cyc)
  642. addl r1=IA64_STK_OFFSET-IA64_PT_REGS_SIZE,r2 // A compute base of memory stack
  643. mov r18=ar.bsp // M2 save (kernel) ar.bsp (12 cyc)
  644. cmp.ne pKStk,pUStk=r0,r0 // A set pKStk <- 0, pUStk <- 1
  645. br.call.sptk.many b7=ia64_syscall_setup // B
  646. ;;
  647. mov ar.rsc=0x3 // M2 set eager mode, pl 0, LE, loadrs=0
  648. mov rp=r14 // I0 set the real return addr
  649. and r3=_TIF_SYSCALL_TRACEAUDIT,r3 // A
  650. ;;
  651. ssm psr.i // M2 we're on kernel stacks now, reenable irqs
  652. cmp.eq p8,p0=r3,r0 // A
  653. (p10) br.cond.spnt.many ia64_ret_from_syscall // B return if bad call-frame or r15 is a NaT
  654. nop.m 0
  655. (p8) br.call.sptk.many b6=b6 // B (ignore return address)
  656. br.cond.spnt ia64_trace_syscall // B
  657. END(fsys_bubble_down)
  658. .rodata
  659. .align 8
  660. .globl fsyscall_table
  661. data8 fsys_bubble_down
  662. fsyscall_table:
  663. data8 fsys_ni_syscall
  664. data8 0 // exit // 1025
  665. data8 0 // read
  666. data8 0 // write
  667. data8 0 // open
  668. data8 0 // close
  669. data8 0 // creat // 1030
  670. data8 0 // link
  671. data8 0 // unlink
  672. data8 0 // execve
  673. data8 0 // chdir
  674. data8 0 // fchdir // 1035
  675. data8 0 // utimes
  676. data8 0 // mknod
  677. data8 0 // chmod
  678. data8 0 // chown
  679. data8 0 // lseek // 1040
  680. data8 fsys_getpid // getpid
  681. data8 fsys_getppid // getppid
  682. data8 0 // mount
  683. data8 0 // umount
  684. data8 0 // setuid // 1045
  685. data8 0 // getuid
  686. data8 0 // geteuid
  687. data8 0 // ptrace
  688. data8 0 // access
  689. data8 0 // sync // 1050
  690. data8 0 // fsync
  691. data8 0 // fdatasync
  692. data8 0 // kill
  693. data8 0 // rename
  694. data8 0 // mkdir // 1055
  695. data8 0 // rmdir
  696. data8 0 // dup
  697. data8 0 // pipe
  698. data8 0 // times
  699. data8 0 // brk // 1060
  700. data8 0 // setgid
  701. data8 0 // getgid
  702. data8 0 // getegid
  703. data8 0 // acct
  704. data8 0 // ioctl // 1065
  705. data8 0 // fcntl
  706. data8 0 // umask
  707. data8 0 // chroot
  708. data8 0 // ustat
  709. data8 0 // dup2 // 1070
  710. data8 0 // setreuid
  711. data8 0 // setregid
  712. data8 0 // getresuid
  713. data8 0 // setresuid
  714. data8 0 // getresgid // 1075
  715. data8 0 // setresgid
  716. data8 0 // getgroups
  717. data8 0 // setgroups
  718. data8 0 // getpgid
  719. data8 0 // setpgid // 1080
  720. data8 0 // setsid
  721. data8 0 // getsid
  722. data8 0 // sethostname
  723. data8 0 // setrlimit
  724. data8 0 // getrlimit // 1085
  725. data8 0 // getrusage
  726. data8 fsys_gettimeofday // gettimeofday
  727. data8 0 // settimeofday
  728. data8 0 // select
  729. data8 0 // poll // 1090
  730. data8 0 // symlink
  731. data8 0 // readlink
  732. data8 0 // uselib
  733. data8 0 // swapon
  734. data8 0 // swapoff // 1095
  735. data8 0 // reboot
  736. data8 0 // truncate
  737. data8 0 // ftruncate
  738. data8 0 // fchmod
  739. data8 0 // fchown // 1100
  740. data8 0 // getpriority
  741. data8 0 // setpriority
  742. data8 0 // statfs
  743. data8 0 // fstatfs
  744. data8 0 // gettid // 1105
  745. data8 0 // semget
  746. data8 0 // semop
  747. data8 0 // semctl
  748. data8 0 // msgget
  749. data8 0 // msgsnd // 1110
  750. data8 0 // msgrcv
  751. data8 0 // msgctl
  752. data8 0 // shmget
  753. data8 0 // shmat
  754. data8 0 // shmdt // 1115
  755. data8 0 // shmctl
  756. data8 0 // syslog
  757. data8 0 // setitimer
  758. data8 0 // getitimer
  759. data8 0 // 1120
  760. data8 0
  761. data8 0
  762. data8 0 // vhangup
  763. data8 0 // lchown
  764. data8 0 // remap_file_pages // 1125
  765. data8 0 // wait4
  766. data8 0 // sysinfo
  767. data8 0 // clone
  768. data8 0 // setdomainname
  769. data8 0 // newuname // 1130
  770. data8 0 // adjtimex
  771. data8 0
  772. data8 0 // init_module
  773. data8 0 // delete_module
  774. data8 0 // 1135
  775. data8 0
  776. data8 0 // quotactl
  777. data8 0 // bdflush
  778. data8 0 // sysfs
  779. data8 0 // personality // 1140
  780. data8 0 // afs_syscall
  781. data8 0 // setfsuid
  782. data8 0 // setfsgid
  783. data8 0 // getdents
  784. data8 0 // flock // 1145
  785. data8 0 // readv
  786. data8 0 // writev
  787. data8 0 // pread64
  788. data8 0 // pwrite64
  789. data8 0 // sysctl // 1150
  790. data8 0 // mmap
  791. data8 0 // munmap
  792. data8 0 // mlock
  793. data8 0 // mlockall
  794. data8 0 // mprotect // 1155
  795. data8 0 // mremap
  796. data8 0 // msync
  797. data8 0 // munlock
  798. data8 0 // munlockall
  799. data8 0 // sched_getparam // 1160
  800. data8 0 // sched_setparam
  801. data8 0 // sched_getscheduler
  802. data8 0 // sched_setscheduler
  803. data8 0 // sched_yield
  804. data8 0 // sched_get_priority_max // 1165
  805. data8 0 // sched_get_priority_min
  806. data8 0 // sched_rr_get_interval
  807. data8 0 // nanosleep
  808. data8 0 // nfsservctl
  809. data8 0 // prctl // 1170
  810. data8 0 // getpagesize
  811. data8 0 // mmap2
  812. data8 0 // pciconfig_read
  813. data8 0 // pciconfig_write
  814. data8 0 // perfmonctl // 1175
  815. data8 0 // sigaltstack
  816. data8 0 // rt_sigaction
  817. data8 0 // rt_sigpending
  818. data8 fsys_rt_sigprocmask // rt_sigprocmask
  819. data8 0 // rt_sigqueueinfo // 1180
  820. data8 0 // rt_sigreturn
  821. data8 0 // rt_sigsuspend
  822. data8 0 // rt_sigtimedwait
  823. data8 0 // getcwd
  824. data8 0 // capget // 1185
  825. data8 0 // capset
  826. data8 0 // sendfile
  827. data8 0
  828. data8 0
  829. data8 0 // socket // 1190
  830. data8 0 // bind
  831. data8 0 // connect
  832. data8 0 // listen
  833. data8 0 // accept
  834. data8 0 // getsockname // 1195
  835. data8 0 // getpeername
  836. data8 0 // socketpair
  837. data8 0 // send
  838. data8 0 // sendto
  839. data8 0 // recv // 1200
  840. data8 0 // recvfrom
  841. data8 0 // shutdown
  842. data8 0 // setsockopt
  843. data8 0 // getsockopt
  844. data8 0 // sendmsg // 1205
  845. data8 0 // recvmsg
  846. data8 0 // pivot_root
  847. data8 0 // mincore
  848. data8 0 // madvise
  849. data8 0 // newstat // 1210
  850. data8 0 // newlstat
  851. data8 0 // newfstat
  852. data8 0 // clone2
  853. data8 0 // getdents64
  854. data8 0 // getunwind // 1215
  855. data8 0 // readahead
  856. data8 0 // setxattr
  857. data8 0 // lsetxattr
  858. data8 0 // fsetxattr
  859. data8 0 // getxattr // 1220
  860. data8 0 // lgetxattr
  861. data8 0 // fgetxattr
  862. data8 0 // listxattr
  863. data8 0 // llistxattr
  864. data8 0 // flistxattr // 1225
  865. data8 0 // removexattr
  866. data8 0 // lremovexattr
  867. data8 0 // fremovexattr
  868. data8 0 // tkill
  869. data8 0 // futex // 1230
  870. data8 0 // sched_setaffinity
  871. data8 0 // sched_getaffinity
  872. data8 fsys_set_tid_address // set_tid_address
  873. data8 0 // fadvise64_64
  874. data8 0 // tgkill // 1235
  875. data8 0 // exit_group
  876. data8 0 // lookup_dcookie
  877. data8 0 // io_setup
  878. data8 0 // io_destroy
  879. data8 0 // io_getevents // 1240
  880. data8 0 // io_submit
  881. data8 0 // io_cancel
  882. data8 0 // epoll_create
  883. data8 0 // epoll_ctl
  884. data8 0 // epoll_wait // 1245
  885. data8 0 // restart_syscall
  886. data8 0 // semtimedop
  887. data8 0 // timer_create
  888. data8 0 // timer_settime
  889. data8 0 // timer_gettime // 1250
  890. data8 0 // timer_getoverrun
  891. data8 0 // timer_delete
  892. data8 0 // clock_settime
  893. data8 fsys_clock_gettime // clock_gettime
  894. data8 0 // clock_getres // 1255
  895. data8 0 // clock_nanosleep
  896. data8 0 // fstatfs64
  897. data8 0 // statfs64
  898. data8 0 // mbind
  899. data8 0 // get_mempolicy // 1260
  900. data8 0 // set_mempolicy
  901. data8 0 // mq_open
  902. data8 0 // mq_unlink
  903. data8 0 // mq_timedsend
  904. data8 0 // mq_timedreceive // 1265
  905. data8 0 // mq_notify
  906. data8 0 // mq_getsetattr
  907. data8 0 // kexec_load
  908. data8 0 // vserver
  909. data8 0 // waitid // 1270
  910. data8 0 // add_key
  911. data8 0 // request_key
  912. data8 0 // keyctl
  913. data8 0 // ioprio_set
  914. data8 0 // ioprio_get // 1275
  915. data8 0 // move_pages
  916. data8 0 // inotify_init
  917. data8 0 // inotify_add_watch
  918. data8 0 // inotify_rm_watch
  919. data8 0 // migrate_pages // 1280
  920. data8 0 // openat
  921. data8 0 // mkdirat
  922. data8 0 // mknodat
  923. data8 0 // fchownat
  924. data8 0 // futimesat // 1285
  925. data8 0 // newfstatat
  926. data8 0 // unlinkat
  927. data8 0 // renameat
  928. data8 0 // linkat
  929. data8 0 // symlinkat // 1290
  930. data8 0 // readlinkat
  931. data8 0 // fchmodat
  932. data8 0 // faccessat
  933. data8 0
  934. data8 0 // 1295
  935. data8 0 // unshare
  936. data8 0 // splice
  937. data8 0 // set_robust_list
  938. data8 0 // get_robust_list
  939. data8 0 // sync_file_range // 1300
  940. data8 0 // tee
  941. data8 0 // vmsplice
  942. data8 0
  943. data8 fsys_getcpu // getcpu // 1304
  944. // fill in zeros for the remaining entries
  945. .zero:
  946. .space fsyscall_table + 8*NR_syscalls - .zero, 0