blob: 5698668166cd1cbc8cf7de05b3dd65e642fb3960 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * Linux/PA-RISC Project (http://www.parisc-linux.org/)
3 *
4 * System call entry code Copyright (c) Matthew Wilcox 1999 <willy@bofh.ai>
5 * Licensed under the GNU GPL.
6 * thanks to Philipp Rumpf, Mike Shaver and various others
7 * sorry about the wall, puffin..
8 */
9
Sam Ravnborg0013a852005-09-09 20:57:26 +020010#include <asm/asm-offsets.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070011#include <asm/unistd.h>
12#include <asm/errno.h>
Sam Ravnborg1c593572007-10-18 00:04:34 -070013#include <asm/page.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070014#include <asm/psw.h>
15#include <asm/thread_info.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070016#include <asm/assembly.h>
17#include <asm/processor.h>
18
Helge Deller8e9e9842007-01-24 22:36:32 +010019#include <linux/linkage.h>
20
Linus Torvalds1da177e2005-04-16 15:20:36 -070021 /* We fill the empty parts of the gateway page with
22 * something that will kill the kernel or a
23 * userspace application.
24 */
25#define KILL_INSN break 0,0
26
Helge Deller0b3d6432007-01-28 14:52:57 +010027 .level LEVEL
Helge Deller8e9e9842007-01-24 22:36:32 +010028
Kyle McMartindfcf7532008-05-22 14:36:31 -040029 .text
Linus Torvalds1da177e2005-04-16 15:20:36 -070030
31 .import syscall_exit,code
32 .import syscall_exit_rfi,code
Linus Torvalds1da177e2005-04-16 15:20:36 -070033
34 /* Linux gateway page is aliased to virtual page 0 in the kernel
35 * address space. Since it is a gateway page it cannot be
36 * dereferenced, so null pointers will still fault. We start
37 * the actual entry point at 0x100. We put break instructions
38 * at the beginning of the page to trap null indirect function
39 * pointers.
40 */
41
Sam Ravnborg1c593572007-10-18 00:04:34 -070042 .align PAGE_SIZE
Helge Deller8e9e9842007-01-24 22:36:32 +010043ENTRY(linux_gateway_page)
Linus Torvalds1da177e2005-04-16 15:20:36 -070044
45 /* ADDRESS 0x00 to 0xb0 = 176 bytes / 4 bytes per insn = 44 insns */
46 .rept 44
47 KILL_INSN
48 .endr
49
50 /* ADDRESS 0xb0 to 0xb4, lws uses 1 insns for entry */
51 /* Light-weight-syscall entry must always be located at 0xb0 */
52 /* WARNING: Keep this number updated with table size changes */
53#define __NR_lws_entries (2)
54
55lws_entry:
56 /* Unconditional branch to lws_start, located on the
57 same gateway page */
58 b,n lws_start
59
60 /* Fill from 0xb4 to 0xe0 */
61 .rept 11
62 KILL_INSN
63 .endr
64
65 /* This function MUST be located at 0xe0 for glibc's threading
66 mechanism to work. DO NOT MOVE THIS CODE EVER! */
67set_thread_pointer:
68 gate .+8, %r0 /* increase privilege */
69 depi 3, 31, 2, %r31 /* Ensure we return into user mode. */
70 be 0(%sr7,%r31) /* return to user space */
71 mtctl %r26, %cr27 /* move arg0 to the control register */
72
73 /* Increase the chance of trapping if random jumps occur to this
74 address, fill from 0xf0 to 0x100 */
75 .rept 4
76 KILL_INSN
77 .endr
78
79/* This address must remain fixed at 0x100 for glibc's syscalls to work */
80 .align 256
81linux_gateway_entry:
82 gate .+8, %r0 /* become privileged */
83 mtsp %r0,%sr4 /* get kernel space into sr4 */
84 mtsp %r0,%sr5 /* get kernel space into sr5 */
85 mtsp %r0,%sr6 /* get kernel space into sr6 */
86 mfsp %sr7,%r1 /* save user sr7 */
87 mtsp %r1,%sr3 /* and store it in sr3 */
88
Grant Grundler413059f2005-10-21 22:46:48 -040089#ifdef CONFIG_64BIT
Linus Torvalds1da177e2005-04-16 15:20:36 -070090 /* for now we can *always* set the W bit on entry to the syscall
91 * since we don't support wide userland processes. We could
92 * also save the current SM other than in r0 and restore it on
93 * exit from the syscall, and also use that value to know
94 * whether to do narrow or wide syscalls. -PB
95 */
96 ssm PSW_SM_W, %r1
97 extrd,u %r1,PSW_W_BIT,1,%r1
98 /* sp must be aligned on 4, so deposit the W bit setting into
99 * the bottom of sp temporarily */
100 or,ev %r1,%r30,%r30
101 b,n 1f
102 /* The top halves of argument registers must be cleared on syscall
103 * entry from narrow executable.
104 */
105 depdi 0, 31, 32, %r26
106 depdi 0, 31, 32, %r25
107 depdi 0, 31, 32, %r24
108 depdi 0, 31, 32, %r23
109 depdi 0, 31, 32, %r22
110 depdi 0, 31, 32, %r21
1111:
112#endif
113 mfctl %cr30,%r1
114 xor %r1,%r30,%r30 /* ye olde xor trick */
115 xor %r1,%r30,%r1
116 xor %r1,%r30,%r30
117
118 ldo THREAD_SZ_ALGN+FRAME_SIZE(%r30),%r30 /* set up kernel stack */
119
120 /* N.B.: It is critical that we don't set sr7 to 0 until r30
121 * contains a valid kernel stack pointer. It is also
122 * critical that we don't start using the kernel stack
123 * until after sr7 has been set to 0.
124 */
125
126 mtsp %r0,%sr7 /* get kernel space into sr7 */
127 STREGM %r1,FRAME_SIZE(%r30) /* save r1 (usp) here for now */
128 mfctl %cr30,%r1 /* get task ptr in %r1 */
129 LDREG TI_TASK(%r1),%r1
130
131 /* Save some registers for sigcontext and potential task
132 switch (see entry.S for the details of which ones are
133 saved/restored). TASK_PT_PSW is zeroed so we can see whether
134 a process is on a syscall or not. For an interrupt the real
135 PSW value is stored. This is needed for gdb and sys_ptrace. */
136 STREG %r0, TASK_PT_PSW(%r1)
137 STREG %r2, TASK_PT_GR2(%r1) /* preserve rp */
138 STREG %r19, TASK_PT_GR19(%r1)
139
140 LDREGM -FRAME_SIZE(%r30), %r2 /* get users sp back */
Grant Grundler413059f2005-10-21 22:46:48 -0400141#ifdef CONFIG_64BIT
Linus Torvalds1da177e2005-04-16 15:20:36 -0700142 extrd,u %r2,63,1,%r19 /* W hidden in bottom bit */
143#if 0
144 xor %r19,%r2,%r2 /* clear bottom bit */
145 depd,z %r19,1,1,%r19
146 std %r19,TASK_PT_PSW(%r1)
147#endif
148#endif
149 STREG %r2, TASK_PT_GR30(%r1) /* ... and save it */
150
Carlos O'Donellaa0eecb2005-11-17 16:32:46 -0500151 STREG %r20, TASK_PT_GR20(%r1) /* Syscall number */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700152 STREG %r21, TASK_PT_GR21(%r1)
153 STREG %r22, TASK_PT_GR22(%r1)
154 STREG %r23, TASK_PT_GR23(%r1) /* 4th argument */
155 STREG %r24, TASK_PT_GR24(%r1) /* 3rd argument */
156 STREG %r25, TASK_PT_GR25(%r1) /* 2nd argument */
157 STREG %r26, TASK_PT_GR26(%r1) /* 1st argument */
158 STREG %r27, TASK_PT_GR27(%r1) /* user dp */
159 STREG %r28, TASK_PT_GR28(%r1) /* return value 0 */
160 STREG %r28, TASK_PT_ORIG_R28(%r1) /* return value 0 (saved for signals) */
161 STREG %r29, TASK_PT_GR29(%r1) /* return value 1 */
162 STREG %r31, TASK_PT_GR31(%r1) /* preserve syscall return ptr */
163
164 ldo TASK_PT_FR0(%r1), %r27 /* save fpregs from the kernel */
165 save_fp %r27 /* or potential task switch */
166
167 mfctl %cr11, %r27 /* i.e. SAR */
168 STREG %r27, TASK_PT_SAR(%r1)
169
170 loadgp
171
Grant Grundler413059f2005-10-21 22:46:48 -0400172#ifdef CONFIG_64BIT
Linus Torvalds1da177e2005-04-16 15:20:36 -0700173 ldo -16(%r30),%r29 /* Reference param save area */
174 copy %r19,%r2 /* W bit back to r2 */
175#else
176 /* no need to save these on stack in wide mode because the first 8
177 * args are passed in registers */
178 stw %r22, -52(%r30) /* 5th argument */
179 stw %r21, -56(%r30) /* 6th argument */
180#endif
181
182 /* Are we being ptraced? */
183 mfctl %cr30, %r1
184 LDREG TI_TASK(%r1),%r1
Kyle McMartin376e2102007-05-30 02:27:46 -0400185 ldw TASK_PTRACE(%r1), %r1
Linus Torvalds1da177e2005-04-16 15:20:36 -0700186 bb,<,n %r1,31,.Ltracesys
187
188 /* Note! We cannot use the syscall table that is mapped
189 nearby since the gateway page is mapped execute-only. */
190
Grant Grundler413059f2005-10-21 22:46:48 -0400191#ifdef CONFIG_64BIT
Linus Torvalds1da177e2005-04-16 15:20:36 -0700192 ldil L%sys_call_table, %r1
193 or,= %r2,%r2,%r2
194 addil L%(sys_call_table64-sys_call_table), %r1
195 ldo R%sys_call_table(%r1), %r19
196 or,= %r2,%r2,%r2
197 ldo R%sys_call_table64(%r1), %r19
198#else
199 ldil L%sys_call_table, %r1
200 ldo R%sys_call_table(%r1), %r19
201#endif
Kyle McMartin3bb457a2007-06-03 17:47:00 -0400202 comiclr,>> __NR_Linux_syscalls, %r20, %r0
Linus Torvalds1da177e2005-04-16 15:20:36 -0700203 b,n .Lsyscall_nosys
204
205 LDREGX %r20(%r19), %r19
206
207 /* If this is a sys_rt_sigreturn call, and the signal was received
208 * when not in_syscall, then we want to return via syscall_exit_rfi,
209 * not syscall_exit. Signal no. in r20, in_syscall in r25 (see
210 * trampoline code in signal.c).
211 */
212 ldi __NR_rt_sigreturn,%r2
213 comb,= %r2,%r20,.Lrt_sigreturn
214.Lin_syscall:
215 ldil L%syscall_exit,%r2
216 be 0(%sr7,%r19)
217 ldo R%syscall_exit(%r2),%r2
218.Lrt_sigreturn:
219 comib,<> 0,%r25,.Lin_syscall
220 ldil L%syscall_exit_rfi,%r2
221 be 0(%sr7,%r19)
222 ldo R%syscall_exit_rfi(%r2),%r2
223
224 /* Note! Because we are not running where we were linked, any
225 calls to functions external to this file must be indirect. To
226 be safe, we apply the opposite rule to functions within this
227 file, with local labels given to them to ensure correctness. */
228
229.Lsyscall_nosys:
230syscall_nosys:
231 ldil L%syscall_exit,%r1
232 be R%syscall_exit(%sr7,%r1)
233 ldo -ENOSYS(%r0),%r28 /* set errno */
234
235
236/* Warning! This trace code is a virtual duplicate of the code above so be
237 * sure to maintain both! */
238.Ltracesys:
239tracesys:
240 /* Need to save more registers so the debugger can see where we
241 * are. This saves only the lower 8 bits of PSW, so that the C
242 * bit is still clear on syscalls, and the D bit is set if this
243 * full register save path has been executed. We check the D
244 * bit on syscall_return_rfi to determine which registers to
245 * restore. An interrupt results in a full PSW saved with the
246 * C bit set, a non-straced syscall entry results in C and D clear
247 * in the saved PSW.
248 */
249 ldo -THREAD_SZ_ALGN-FRAME_SIZE(%r30),%r1 /* get task ptr */
250 LDREG TI_TASK(%r1), %r1
251 ssm 0,%r2
252 STREG %r2,TASK_PT_PSW(%r1) /* Lower 8 bits only!! */
253 mfsp %sr0,%r2
254 STREG %r2,TASK_PT_SR0(%r1)
255 mfsp %sr1,%r2
256 STREG %r2,TASK_PT_SR1(%r1)
257 mfsp %sr2,%r2
258 STREG %r2,TASK_PT_SR2(%r1)
259 mfsp %sr3,%r2
260 STREG %r2,TASK_PT_SR3(%r1)
261 STREG %r2,TASK_PT_SR4(%r1)
262 STREG %r2,TASK_PT_SR5(%r1)
263 STREG %r2,TASK_PT_SR6(%r1)
264 STREG %r2,TASK_PT_SR7(%r1)
265 STREG %r2,TASK_PT_IASQ0(%r1)
266 STREG %r2,TASK_PT_IASQ1(%r1)
267 LDREG TASK_PT_GR31(%r1),%r2
268 STREG %r2,TASK_PT_IAOQ0(%r1)
269 ldo 4(%r2),%r2
270 STREG %r2,TASK_PT_IAOQ1(%r1)
271 ldo TASK_REGS(%r1),%r2
272 /* reg_save %r2 */
273 STREG %r3,PT_GR3(%r2)
274 STREG %r4,PT_GR4(%r2)
275 STREG %r5,PT_GR5(%r2)
276 STREG %r6,PT_GR6(%r2)
277 STREG %r7,PT_GR7(%r2)
278 STREG %r8,PT_GR8(%r2)
279 STREG %r9,PT_GR9(%r2)
280 STREG %r10,PT_GR10(%r2)
281 STREG %r11,PT_GR11(%r2)
282 STREG %r12,PT_GR12(%r2)
283 STREG %r13,PT_GR13(%r2)
284 STREG %r14,PT_GR14(%r2)
285 STREG %r15,PT_GR15(%r2)
286 STREG %r16,PT_GR16(%r2)
287 STREG %r17,PT_GR17(%r2)
288 STREG %r18,PT_GR18(%r2)
289 /* Finished saving things for the debugger */
290
Kyle McMartind6b58772009-04-26 23:53:34 -0400291 ldi 0,%r26 /* syscall entry */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700292 ldil L%syscall_trace,%r1
293 ldil L%tracesys_next,%r2
294 be R%syscall_trace(%sr7,%r1)
295 ldo R%tracesys_next(%r2),%r2
296
297tracesys_next:
298 ldil L%sys_call_table,%r1
299 ldo R%sys_call_table(%r1), %r19
300
301 ldo -THREAD_SZ_ALGN-FRAME_SIZE(%r30),%r1 /* get task ptr */
302 LDREG TI_TASK(%r1), %r1
303 LDREG TASK_PT_GR20(%r1), %r20
304 LDREG TASK_PT_GR26(%r1), %r26 /* Restore the users args */
305 LDREG TASK_PT_GR25(%r1), %r25
306 LDREG TASK_PT_GR24(%r1), %r24
307 LDREG TASK_PT_GR23(%r1), %r23
Grant Grundler413059f2005-10-21 22:46:48 -0400308#ifdef CONFIG_64BIT
Linus Torvalds1da177e2005-04-16 15:20:36 -0700309 LDREG TASK_PT_GR22(%r1), %r22
310 LDREG TASK_PT_GR21(%r1), %r21
311 ldo -16(%r30),%r29 /* Reference param save area */
312#endif
313
314 comiclr,>>= __NR_Linux_syscalls, %r20, %r0
315 b,n .Lsyscall_nosys
316
317 LDREGX %r20(%r19), %r19
318
319 /* If this is a sys_rt_sigreturn call, and the signal was received
320 * when not in_syscall, then we want to return via syscall_exit_rfi,
321 * not syscall_exit. Signal no. in r20, in_syscall in r25 (see
322 * trampoline code in signal.c).
323 */
324 ldi __NR_rt_sigreturn,%r2
325 comb,= %r2,%r20,.Ltrace_rt_sigreturn
326.Ltrace_in_syscall:
327 ldil L%tracesys_exit,%r2
328 be 0(%sr7,%r19)
329 ldo R%tracesys_exit(%r2),%r2
330
331 /* Do *not* call this function on the gateway page, because it
332 makes a direct call to syscall_trace. */
333
334tracesys_exit:
335 ldo -THREAD_SZ_ALGN-FRAME_SIZE(%r30),%r1 /* get task ptr */
336 LDREG TI_TASK(%r1), %r1
Grant Grundler413059f2005-10-21 22:46:48 -0400337#ifdef CONFIG_64BIT
Linus Torvalds1da177e2005-04-16 15:20:36 -0700338 ldo -16(%r30),%r29 /* Reference param save area */
339#endif
Kyle McMartind6b58772009-04-26 23:53:34 -0400340 ldi 1,%r26 /* syscall exit */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700341 bl syscall_trace, %r2
342 STREG %r28,TASK_PT_GR28(%r1) /* save return value now */
343 ldo -THREAD_SZ_ALGN-FRAME_SIZE(%r30),%r1 /* get task ptr */
344 LDREG TI_TASK(%r1), %r1
345 LDREG TASK_PT_GR28(%r1), %r28 /* Restore return val. */
346
347 ldil L%syscall_exit,%r1
348 be,n R%syscall_exit(%sr7,%r1)
349
350.Ltrace_rt_sigreturn:
351 comib,<> 0,%r25,.Ltrace_in_syscall
352 ldil L%tracesys_sigexit,%r2
353 be 0(%sr7,%r19)
354 ldo R%tracesys_sigexit(%r2),%r2
355
356tracesys_sigexit:
357 ldo -THREAD_SZ_ALGN-FRAME_SIZE(%r30),%r1 /* get task ptr */
358 LDREG 0(%r1), %r1
Grant Grundler413059f2005-10-21 22:46:48 -0400359#ifdef CONFIG_64BIT
Linus Torvalds1da177e2005-04-16 15:20:36 -0700360 ldo -16(%r30),%r29 /* Reference param save area */
361#endif
362 bl syscall_trace, %r2
Kyle McMartind6b58772009-04-26 23:53:34 -0400363 ldi 1,%r26 /* syscall exit */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700364
365 ldil L%syscall_exit_rfi,%r1
366 be,n R%syscall_exit_rfi(%sr7,%r1)
367
368
369 /*********************************************************
Helge Dellerc84c3a62008-12-30 02:47:38 +0000370 32/64-bit Light-Weight-Syscall ABI
Linus Torvalds1da177e2005-04-16 15:20:36 -0700371
Helge Dellerc84c3a62008-12-30 02:47:38 +0000372 * - Indicates a hint for userspace inline asm
373 implementations.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700374
Helge Dellerc84c3a62008-12-30 02:47:38 +0000375 Syscall number (caller-saves)
376 - %r20
377 * In asm clobber.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700378
Helge Dellerc84c3a62008-12-30 02:47:38 +0000379 Argument registers (caller-saves)
380 - %r26, %r25, %r24, %r23, %r22
381 * In asm input.
382
383 Return registers (caller-saves)
384 - %r28 (return), %r21 (errno)
385 * In asm output.
386
387 Caller-saves registers
388 - %r1, %r27, %r29
389 - %r2 (return pointer)
390 - %r31 (ble link register)
391 * In asm clobber.
392
393 Callee-saves registers
394 - %r3-%r18
395 - %r30 (stack pointer)
396 * Not in asm clobber.
397
398 If userspace is 32-bit:
399 Callee-saves registers
400 - %r19 (32-bit PIC register)
401
402 Differences from 32-bit calling convention:
403 - Syscall number in %r20
404 - Additional argument register %r22 (arg4)
405 - Callee-saves %r19.
406
407 If userspace is 64-bit:
408 Callee-saves registers
409 - %r27 (64-bit PIC register)
410
411 Differences from 64-bit calling convention:
412 - Syscall number in %r20
413 - Additional argument register %r22 (arg4)
414 - Callee-saves %r27.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700415
416 Error codes returned by entry path:
417
418 ENOSYS - r20 was an invalid LWS number.
419
420 *********************************************************/
421lws_start:
422 /* Gate and ensure we return to userspace */
423 gate .+8, %r0
424 depi 3, 31, 2, %r31 /* Ensure we return to userspace */
425
Grant Grundler413059f2005-10-21 22:46:48 -0400426#ifdef CONFIG_64BIT
Linus Torvalds1da177e2005-04-16 15:20:36 -0700427 /* FIXME: If we are a 64-bit kernel just
428 * turn this on unconditionally.
429 */
430 ssm PSW_SM_W, %r1
431 extrd,u %r1,PSW_W_BIT,1,%r1
432 /* sp must be aligned on 4, so deposit the W bit setting into
433 * the bottom of sp temporarily */
434 or,ev %r1,%r30,%r30
435
436 /* Clip LWS number to a 32-bit value always */
437 depdi 0, 31, 32, %r20
438#endif
439
440 /* Is the lws entry number valid? */
441 comiclr,>>= __NR_lws_entries, %r20, %r0
442 b,n lws_exit_nosys
443
444 /* WARNING: Trashing sr2 and sr3 */
445 mfsp %sr7,%r1 /* get userspace into sr3 */
446 mtsp %r1,%sr3
447 mtsp %r0,%sr2 /* get kernel space into sr2 */
448
449 /* Load table start */
450 ldil L%lws_table, %r1
451 ldo R%lws_table(%r1), %r28 /* Scratch use of r28 */
452 LDREGX %r20(%sr2,r28), %r21 /* Scratch use of r21 */
453
454 /* Jump to lws, lws table pointers already relocated */
455 be,n 0(%sr2,%r21)
456
457lws_exit_nosys:
458 ldo -ENOSYS(%r0),%r21 /* set errno */
459 /* Fall through: Return to userspace */
460
461lws_exit:
Grant Grundler413059f2005-10-21 22:46:48 -0400462#ifdef CONFIG_64BIT
Linus Torvalds1da177e2005-04-16 15:20:36 -0700463 /* decide whether to reset the wide mode bit
464 *
465 * For a syscall, the W bit is stored in the lowest bit
466 * of sp. Extract it and reset W if it is zero */
467 extrd,u,*<> %r30,63,1,%r1
468 rsm PSW_SM_W, %r0
469 /* now reset the lowest bit of sp if it was set */
470 xor %r30,%r1,%r30
471#endif
472 be,n 0(%sr3, %r31)
473
474
475
476 /***************************************************
477 Implementing CAS as an atomic operation:
478
479 %r26 - Address to examine
480 %r25 - Old value to check (old)
481 %r24 - New value to set (new)
482 %r28 - Return prev through this register.
483 %r21 - Kernel error code
484
485 If debugging is DISabled:
486
487 %r21 has the following meanings:
488
489 EAGAIN - CAS is busy, ldcw failed, try again.
490 EFAULT - Read or write failed.
491
492 If debugging is enabled:
493
494 EDEADLOCK - CAS called recursively.
495 EAGAIN && r28 == 1 - CAS is busy. Lock contended.
496 EAGAIN && r28 == 2 - CAS is busy. ldcw failed.
497 EFAULT - Read or write failed.
498
499 Scratch: r20, r28, r1
500
501 ****************************************************/
502
503 /* Do not enable LWS debugging */
504#define ENABLE_LWS_DEBUG 0
505
506 /* ELF64 Process entry path */
507lws_compare_and_swap64:
Grant Grundler413059f2005-10-21 22:46:48 -0400508#ifdef CONFIG_64BIT
Linus Torvalds1da177e2005-04-16 15:20:36 -0700509 b,n lws_compare_and_swap
510#else
511 /* If we are not a 64-bit kernel, then we don't
Helge Dellerc84c3a62008-12-30 02:47:38 +0000512 * have 64-bit input registers, and calling
513 * the 64-bit LWS CAS returns ENOSYS.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700514 */
515 b,n lws_exit_nosys
516#endif
517
518 /* ELF32 Process entry path */
519lws_compare_and_swap32:
Grant Grundler413059f2005-10-21 22:46:48 -0400520#ifdef CONFIG_64BIT
Linus Torvalds1da177e2005-04-16 15:20:36 -0700521 /* Clip all the input registers */
522 depdi 0, 31, 32, %r26
523 depdi 0, 31, 32, %r25
524 depdi 0, 31, 32, %r24
525#endif
526
527lws_compare_and_swap:
528#ifdef CONFIG_SMP
529 /* Load start of lock table */
530 ldil L%lws_lock_start, %r20
531 ldo R%lws_lock_start(%r20), %r28
532
533 /* Extract four bits from r26 and hash lock (Bits 4-7) */
534 extru %r26, 27, 4, %r20
535
536 /* Find lock to use, the hash is either one of 0 to
537 15, multiplied by 16 (keep it 16-byte aligned)
538 and add to the lock table offset. */
539 shlw %r20, 4, %r20
540 add %r20, %r28, %r20
541
Aurelien Jarnob5e8b732007-05-22 17:38:26 +0200542# if ENABLE_LWS_DEBUG
Linus Torvalds1da177e2005-04-16 15:20:36 -0700543 /*
544 DEBUG, check for deadlock!
545 If the thread register values are the same
546 then we were the one that locked it last and
547 this is a recurisve call that will deadlock.
548 We *must* giveup this call and fail.
549 */
550 ldw 4(%sr2,%r20), %r28 /* Load thread register */
Carlos O'Donellaa0eecb2005-11-17 16:32:46 -0500551 /* WARNING: If cr27 cycles to the same value we have problems */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700552 mfctl %cr27, %r21 /* Get current thread register */
553 cmpb,<>,n %r21, %r28, cas_lock /* Called recursive? */
554 b lws_exit /* Return error! */
555 ldo -EDEADLOCK(%r0), %r21
556cas_lock:
557 cmpb,=,n %r0, %r28, cas_nocontend /* Is nobody using it? */
558 ldo 1(%r0), %r28 /* 1st case */
559 b lws_exit /* Contended... */
560 ldo -EAGAIN(%r0), %r21 /* Spin in userspace */
561cas_nocontend:
562# endif
563/* ENABLE_LWS_DEBUG */
564
Kyle McMartin64f49532006-04-22 00:48:22 -0600565 LDCW 0(%sr2,%r20), %r28 /* Try to acquire the lock */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700566 cmpb,<>,n %r0, %r28, cas_action /* Did we get it? */
567cas_wouldblock:
568 ldo 2(%r0), %r28 /* 2nd case */
569 b lws_exit /* Contended... */
570 ldo -EAGAIN(%r0), %r21 /* Spin in userspace */
571#endif
572/* CONFIG_SMP */
573
574 /*
575 prev = *addr;
576 if ( prev == old )
577 *addr = new;
578 return prev;
579 */
580
581 /* NOTES:
582 This all works becuse intr_do_signal
583 and schedule both check the return iasq
584 and see that we are on the kernel page
585 so this process is never scheduled off
586 or is ever sent any signal of any sort,
587 thus it is wholly atomic from usrspaces
588 perspective
589 */
590cas_action:
Aurelien Jarnob5e8b732007-05-22 17:38:26 +0200591#if defined CONFIG_SMP && ENABLE_LWS_DEBUG
Linus Torvalds1da177e2005-04-16 15:20:36 -0700592 /* DEBUG */
593 mfctl %cr27, %r1
594 stw %r1, 4(%sr2,%r20)
595#endif
596 /* The load and store could fail */
5971: ldw 0(%sr3,%r26), %r28
598 sub,<> %r28, %r25, %r0
5992: stw %r24, 0(%sr3,%r26)
600#ifdef CONFIG_SMP
601 /* Free lock */
602 stw %r20, 0(%sr2,%r20)
Aurelien Jarnob5e8b732007-05-22 17:38:26 +0200603# if ENABLE_LWS_DEBUG
Linus Torvalds1da177e2005-04-16 15:20:36 -0700604 /* Clear thread register indicator */
605 stw %r0, 4(%sr2,%r20)
606# endif
607#endif
608 /* Return to userspace, set no error */
609 b lws_exit
610 copy %r0, %r21
611
6123:
613 /* Error occured on load or store */
614#ifdef CONFIG_SMP
615 /* Free lock */
616 stw %r20, 0(%sr2,%r20)
Aurelien Jarnob5e8b732007-05-22 17:38:26 +0200617# if ENABLE_LWS_DEBUG
Linus Torvalds1da177e2005-04-16 15:20:36 -0700618 stw %r0, 4(%sr2,%r20)
619# endif
620#endif
621 b lws_exit
622 ldo -EFAULT(%r0),%r21 /* set errno */
623 nop
624 nop
625 nop
626 nop
627
628 /* Two exception table entries, one for the load,
629 the other for the store. Either return -EFAULT.
630 Each of the entries must be relocated. */
631 .section __ex_table,"aw"
Helge Deller0b3d6432007-01-28 14:52:57 +0100632 ASM_ULONG_INSN (1b - linux_gateway_page), (3b - linux_gateway_page)
633 ASM_ULONG_INSN (2b - linux_gateway_page), (3b - linux_gateway_page)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700634 .previous
635
Linus Torvalds1da177e2005-04-16 15:20:36 -0700636
637 /* Make sure nothing else is placed on this page */
Sam Ravnborg1c593572007-10-18 00:04:34 -0700638 .align PAGE_SIZE
Helge Deller8e9e9842007-01-24 22:36:32 +0100639END(linux_gateway_page)
640ENTRY(end_linux_gateway_page)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700641
642 /* Relocate symbols assuming linux_gateway_page is mapped
643 to virtual address 0x0 */
Helge Deller8e9e9842007-01-24 22:36:32 +0100644
Helge Deller0b3d6432007-01-28 14:52:57 +0100645#define LWS_ENTRY(_name_) ASM_ULONG_INSN (lws_##_name_ - linux_gateway_page)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700646
Helge Deller1bcdd852006-01-13 13:21:06 -0700647 .section .rodata,"a"
648
Sam Ravnborg1c593572007-10-18 00:04:34 -0700649 .align PAGE_SIZE
Linus Torvalds1da177e2005-04-16 15:20:36 -0700650 /* Light-weight-syscall table */
651 /* Start of lws table. */
Helge Deller8e9e9842007-01-24 22:36:32 +0100652ENTRY(lws_table)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700653 LWS_ENTRY(compare_and_swap32) /* 0 - ELF32 Atomic compare and swap */
654 LWS_ENTRY(compare_and_swap64) /* 1 - ELF64 Atomic compare and swap */
Helge Deller8e9e9842007-01-24 22:36:32 +0100655END(lws_table)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700656 /* End of lws table */
657
Sam Ravnborg1c593572007-10-18 00:04:34 -0700658 .align PAGE_SIZE
Helge Deller8e9e9842007-01-24 22:36:32 +0100659ENTRY(sys_call_table)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700660#include "syscall_table.S"
Helge Deller8e9e9842007-01-24 22:36:32 +0100661END(sys_call_table)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700662
Grant Grundler413059f2005-10-21 22:46:48 -0400663#ifdef CONFIG_64BIT
Sam Ravnborg1c593572007-10-18 00:04:34 -0700664 .align PAGE_SIZE
Helge Deller8e9e9842007-01-24 22:36:32 +0100665ENTRY(sys_call_table64)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700666#define SYSCALL_TABLE_64BIT
667#include "syscall_table.S"
Helge Deller8e9e9842007-01-24 22:36:32 +0100668END(sys_call_table64)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700669#endif
670
671#ifdef CONFIG_SMP
672 /*
673 All light-weight-syscall atomic operations
674 will use this set of locks
Helge Dellerc84c3a62008-12-30 02:47:38 +0000675
676 NOTE: The lws_lock_start symbol must be
677 at least 16-byte aligned for safe use
678 with ldcw.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700679 */
Kyle McMartindfcf7532008-05-22 14:36:31 -0400680 .section .data
Kyle McMartin873d50e2007-10-18 00:04:53 -0700681 .align PAGE_SIZE
Helge Deller8e9e9842007-01-24 22:36:32 +0100682ENTRY(lws_lock_start)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700683 /* lws locks */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700684 .rept 16
685 /* Keep locks aligned at 16-bytes */
686 .word 1
687 .word 0
688 .word 0
689 .word 0
690 .endr
Helge Deller8e9e9842007-01-24 22:36:32 +0100691END(lws_lock_start)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700692 .previous
693#endif
694/* CONFIG_SMP for lws_lock_start */
695
696.end
697
698