Merge branches 'topic/slob/cleanups', 'topic/slob/fixes', 'topic/slub/core', 'topic...
[linux-block.git] / arch / arm / kernel / entry-common.S
CommitLineData
1da177e4
LT
1/*
2 * linux/arch/arm/kernel/entry-common.S
3 *
4 * Copyright (C) 2000 Russell King
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
9 */
1da177e4 10
1da177e4 11#include <asm/unistd.h>
395a59d0 12#include <asm/ftrace.h>
a09e64fb 13#include <mach/entry-macro.S>
1da177e4
LT
14
15#include "entry-header.S"
16
1da177e4
LT
17
18 .align 5
19/*
20 * This is the fast syscall return path. We do as little as
21 * possible here, and this includes saving r0 back into the SVC
22 * stack.
23 */
24ret_fast_syscall:
1ec42c0c 25 disable_irq @ disable interrupts
1da177e4
LT
26 ldr r1, [tsk, #TI_FLAGS]
27 tst r1, #_TIF_WORK_MASK
28 bne fast_work_pending
f4dc9a4c 29
f80dff9d
DW
30 /* perform architecture specific actions before user return */
31 arch_ret_to_user r1, lr
32
f4dc9a4c
RK
33 @ fast_restore_user_regs
34 ldr r1, [sp, #S_OFF + S_PSR] @ get calling cpsr
35 ldr lr, [sp, #S_OFF + S_PC]! @ get pc
36 msr spsr_cxsf, r1 @ save in spsr_svc
37 ldmdb sp, {r1 - lr}^ @ get calling r1 - lr
38 mov r0, r0
39 add sp, sp, #S_FRAME_SIZE - S_PC
40 movs pc, lr @ return & move spsr_svc into cpsr
1da177e4
LT
41
42/*
43 * Ok, we need to do extra processing, enter the slow path.
44 */
45fast_work_pending:
46 str r0, [sp, #S_R0+S_OFF]! @ returned r0
47work_pending:
48 tst r1, #_TIF_NEED_RESCHED
49 bne work_resched
a583f1b5 50 tst r1, #_TIF_SIGPENDING
1da177e4
LT
51 beq no_work_pending
52 mov r0, sp @ 'regs'
53 mov r2, why @ 'syscall'
54 bl do_notify_resume
a6c61e9d 55 b ret_slow_syscall @ Check work again
1da177e4
LT
56
57work_resched:
58 bl schedule
59/*
60 * "slow" syscall return path. "why" tells us if this was a real syscall.
61 */
62ENTRY(ret_to_user)
63ret_slow_syscall:
1ec42c0c 64 disable_irq @ disable interrupts
1da177e4
LT
65 ldr r1, [tsk, #TI_FLAGS]
66 tst r1, #_TIF_WORK_MASK
67 bne work_pending
68no_work_pending:
f80dff9d
DW
69 /* perform architecture specific actions before user return */
70 arch_ret_to_user r1, lr
71
f4dc9a4c
RK
72 @ slow_restore_user_regs
73 ldr r1, [sp, #S_PSR] @ get calling cpsr
74 ldr lr, [sp, #S_PC]! @ get pc
75 msr spsr_cxsf, r1 @ save in spsr_svc
7b544c99 76 ldmdb sp, {r0 - lr}^ @ get calling r0 - lr
f4dc9a4c
RK
77 mov r0, r0
78 add sp, sp, #S_FRAME_SIZE - S_PC
79 movs pc, lr @ return & move spsr_svc into cpsr
93ed3970 80ENDPROC(ret_to_user)
1da177e4
LT
81
82/*
83 * This is how we return from a fork.
84 */
85ENTRY(ret_from_fork)
86 bl schedule_tail
87 get_thread_info tsk
88 ldr r1, [tsk, #TI_FLAGS] @ check for syscall tracing
89 mov why, #1
90 tst r1, #_TIF_SYSCALL_TRACE @ are we tracing syscalls?
91 beq ret_slow_syscall
92 mov r1, sp
93 mov r0, #1 @ trace exit [IP = 1]
94 bl syscall_trace
95 b ret_slow_syscall
93ed3970 96ENDPROC(ret_from_fork)
1da177e4 97
fa1b4f91
AV
98 .equ NR_syscalls,0
99#define CALL(x) .equ NR_syscalls,NR_syscalls+1
1da177e4 100#include "calls.S"
fa1b4f91
AV
101#undef CALL
102#define CALL(x) .long x
1da177e4 103
606576ce 104#ifdef CONFIG_FUNCTION_TRACER
014c257c
AS
105#ifdef CONFIG_DYNAMIC_FTRACE
106ENTRY(mcount)
107 stmdb sp!, {r0-r3, lr}
108 mov r0, lr
395a59d0 109 sub r0, r0, #MCOUNT_INSN_SIZE
014c257c
AS
110
111 .globl mcount_call
112mcount_call:
113 bl ftrace_stub
d4cc510c 114 ldr lr, [fp, #-4] @ restore lr
014c257c
AS
115 ldmia sp!, {r0-r3, pc}
116
117ENTRY(ftrace_caller)
118 stmdb sp!, {r0-r3, lr}
119 ldr r1, [fp, #-4]
120 mov r0, lr
395a59d0 121 sub r0, r0, #MCOUNT_INSN_SIZE
014c257c
AS
122
123 .globl ftrace_call
124ftrace_call:
125 bl ftrace_stub
d4cc510c 126 ldr lr, [fp, #-4] @ restore lr
014c257c
AS
127 ldmia sp!, {r0-r3, pc}
128
129#else
130
131ENTRY(mcount)
132 stmdb sp!, {r0-r3, lr}
133 ldr r0, =ftrace_trace_function
134 ldr r2, [r0]
135 adr r0, ftrace_stub
136 cmp r0, r2
137 bne trace
d4cc510c 138 ldr lr, [fp, #-4] @ restore lr
014c257c
AS
139 ldmia sp!, {r0-r3, pc}
140
141trace:
b3c960b2 142 ldr r1, [fp, #-4] @ lr of instrumented routine
014c257c 143 mov r0, lr
395a59d0 144 sub r0, r0, #MCOUNT_INSN_SIZE
014c257c
AS
145 mov lr, pc
146 mov pc, r2
d4cc510c 147 mov lr, r1 @ restore lr
014c257c
AS
148 ldmia sp!, {r0-r3, pc}
149
150#endif /* CONFIG_DYNAMIC_FTRACE */
151
152 .globl ftrace_stub
153ftrace_stub:
154 mov pc, lr
155
606576ce 156#endif /* CONFIG_FUNCTION_TRACER */
014c257c 157
1da177e4
LT
158/*=============================================================================
159 * SWI handler
160 *-----------------------------------------------------------------------------
161 */
162
163 /* If we're optimising for StrongARM the resulting code won't
164 run on an ARM7 and we can save a couple of instructions.
165 --pb */
166#ifdef CONFIG_CPU_ARM710
3f2829a3
NP
167#define A710(code...) code
168.Larm710bug:
1da177e4
LT
169 ldmia sp, {r0 - lr}^ @ Get calling r0 - lr
170 mov r0, r0
1da177e4 171 add sp, sp, #S_FRAME_SIZE
60ac133a 172 subs pc, lr, #4
1da177e4 173#else
3f2829a3 174#define A710(code...)
1da177e4
LT
175#endif
176
177 .align 5
178ENTRY(vector_swi)
f4dc9a4c
RK
179 sub sp, sp, #S_FRAME_SIZE
180 stmia sp, {r0 - r12} @ Calling r0 - r12
181 add r8, sp, #S_PC
182 stmdb r8, {sp, lr}^ @ Calling sp, lr
183 mrs r8, spsr @ called from non-FIQ mode, so ok.
184 str lr, [sp, #S_PC] @ Save calling PC
185 str r8, [sp, #S_PSR] @ Save CPSR
186 str r0, [sp, #S_OLD_R0] @ Save OLD_R0
1da177e4 187 zero_fp
e0f9f4a6
RK
188
189 /*
190 * Get the system call number.
191 */
3f2829a3 192
dd35afc2 193#if defined(CONFIG_OABI_COMPAT)
3f2829a3 194
dd35afc2
NP
195 /*
196 * If we have CONFIG_OABI_COMPAT then we need to look at the swi
197 * value to determine if it is an EABI or an old ABI call.
198 */
199#ifdef CONFIG_ARM_THUMB
200 tst r8, #PSR_T_BIT
201 movne r10, #0 @ no thumb OABI emulation
202 ldreq r10, [lr, #-4] @ get SWI instruction
203#else
204 ldr r10, [lr, #-4] @ get SWI instruction
205 A710( and ip, r10, #0x0f000000 @ check for SWI )
206 A710( teq ip, #0x0f000000 )
207 A710( bne .Larm710bug )
208#endif
209
210#elif defined(CONFIG_AEABI)
211
212 /*
213 * Pure EABI user space always put syscall number into scno (r7).
214 */
3f2829a3
NP
215 A710( ldr ip, [lr, #-4] @ get SWI instruction )
216 A710( and ip, ip, #0x0f000000 @ check for SWI )
217 A710( teq ip, #0x0f000000 )
218 A710( bne .Larm710bug )
dd35afc2 219
3f2829a3 220#elif defined(CONFIG_ARM_THUMB)
dd35afc2
NP
221
222 /* Legacy ABI only, possibly thumb mode. */
e0f9f4a6
RK
223 tst r8, #PSR_T_BIT @ this is SPSR from save_user_regs
224 addne scno, r7, #__NR_SYSCALL_BASE @ put OS number in
225 ldreq scno, [lr, #-4]
dd35afc2 226
e0f9f4a6 227#else
dd35afc2
NP
228
229 /* Legacy ABI only. */
e0f9f4a6 230 ldr scno, [lr, #-4] @ get SWI instruction
3f2829a3
NP
231 A710( and ip, scno, #0x0f000000 @ check for SWI )
232 A710( teq ip, #0x0f000000 )
233 A710( bne .Larm710bug )
dd35afc2 234
e0f9f4a6 235#endif
1da177e4
LT
236
237#ifdef CONFIG_ALIGNMENT_TRAP
238 ldr ip, __cr_alignment
239 ldr ip, [ip]
240 mcr p15, 0, ip, c1, c0 @ update control register
241#endif
1ec42c0c 242 enable_irq
1da177e4 243
1da177e4 244 get_thread_info tsk
dd35afc2 245 adr tbl, sys_call_table @ load syscall table pointer
1da177e4 246 ldr ip, [tsk, #TI_FLAGS] @ check for syscall tracing
dd35afc2
NP
247
248#if defined(CONFIG_OABI_COMPAT)
249 /*
250 * If the swi argument is zero, this is an EABI call and we do nothing.
251 *
252 * If this is an old ABI call, get the syscall number into scno and
253 * get the old ABI syscall table address.
254 */
255 bics r10, r10, #0xff000000
256 eorne scno, r10, #__NR_OABI_SYSCALL_BASE
257 ldrne tbl, =sys_oabi_call_table
258#elif !defined(CONFIG_AEABI)
1da177e4 259 bic scno, scno, #0xff000000 @ mask off SWI op-code
e0f9f4a6 260 eor scno, scno, #__NR_SYSCALL_BASE @ check OS number
3f2829a3 261#endif
dd35afc2 262
3f2829a3 263 stmdb sp!, {r4, r5} @ push fifth and sixth args
1da177e4
LT
264 tst ip, #_TIF_SYSCALL_TRACE @ are we tracing syscalls?
265 bne __sys_trace
266
1da177e4 267 cmp scno, #NR_syscalls @ check upper syscall limit
3f2829a3 268 adr lr, ret_fast_syscall @ return address
1da177e4
LT
269 ldrcc pc, [tbl, scno, lsl #2] @ call sys_* routine
270
271 add r1, sp, #S_OFF
2722: mov why, #0 @ no longer a real syscall
e0f9f4a6
RK
273 cmp scno, #(__ARM_NR_BASE - __NR_SYSCALL_BASE)
274 eor r0, scno, #__NR_SYSCALL_BASE @ put OS number back
1da177e4
LT
275 bcs arm_syscall
276 b sys_ni_syscall @ not private func
93ed3970 277ENDPROC(vector_swi)
1da177e4
LT
278
279 /*
280 * This is the really slow path. We're going to be doing
281 * context switches, and waiting for our parent to respond.
282 */
283__sys_trace:
3f471126 284 mov r2, scno
1da177e4
LT
285 add r1, sp, #S_OFF
286 mov r0, #0 @ trace entry [IP = 0]
287 bl syscall_trace
288
289 adr lr, __sys_trace_return @ return address
3f471126 290 mov scno, r0 @ syscall number (possibly new)
1da177e4
LT
291 add r1, sp, #S_R0 + S_OFF @ pointer to regs
292 cmp scno, #NR_syscalls @ check upper syscall limit
293 ldmccia r1, {r0 - r3} @ have to reload r0 - r3
294 ldrcc pc, [tbl, scno, lsl #2] @ call sys_* routine
295 b 2b
296
297__sys_trace_return:
298 str r0, [sp, #S_R0 + S_OFF]! @ save returned r0
3f471126 299 mov r2, scno
1da177e4
LT
300 mov r1, sp
301 mov r0, #1 @ trace exit [IP = 1]
302 bl syscall_trace
303 b ret_slow_syscall
304
305 .align 5
306#ifdef CONFIG_ALIGNMENT_TRAP
307 .type __cr_alignment, #object
308__cr_alignment:
309 .word cr_alignment
dd35afc2
NP
310#endif
311 .ltorg
312
313/*
314 * This is the syscall table declaration for native ABI syscalls.
315 * With EABI a couple syscalls are obsolete and defined as sys_ni_syscall.
316 */
317#define ABI(native, compat) native
318#ifdef CONFIG_AEABI
319#define OBSOLETE(syscall) sys_ni_syscall
320#else
321#define OBSOLETE(syscall) syscall
1da177e4
LT
322#endif
323
324 .type sys_call_table, #object
325ENTRY(sys_call_table)
326#include "calls.S"
dd35afc2
NP
327#undef ABI
328#undef OBSOLETE
1da177e4
LT
329
330/*============================================================================
331 * Special system call wrappers
332 */
333@ r0 = syscall number
567bd980 334@ r8 = syscall table
1da177e4 335sys_syscall:
5247593c 336 bic scno, r0, #__NR_OABI_SYSCALL_BASE
1da177e4
LT
337 cmp scno, #__NR_syscall - __NR_SYSCALL_BASE
338 cmpne scno, #NR_syscalls @ check range
339 stmloia sp, {r5, r6} @ shuffle args
340 movlo r0, r1
341 movlo r1, r2
342 movlo r2, r3
343 movlo r3, r4
344 ldrlo pc, [tbl, scno, lsl #2]
345 b sys_ni_syscall
93ed3970 346ENDPROC(sys_syscall)
1da177e4
LT
347
348sys_fork_wrapper:
349 add r0, sp, #S_OFF
350 b sys_fork
93ed3970 351ENDPROC(sys_fork_wrapper)
1da177e4
LT
352
353sys_vfork_wrapper:
354 add r0, sp, #S_OFF
355 b sys_vfork
93ed3970 356ENDPROC(sys_vfork_wrapper)
1da177e4
LT
357
358sys_execve_wrapper:
359 add r3, sp, #S_OFF
360 b sys_execve
93ed3970 361ENDPROC(sys_execve_wrapper)
1da177e4
LT
362
363sys_clone_wrapper:
364 add ip, sp, #S_OFF
365 str ip, [sp, #4]
366 b sys_clone
93ed3970 367ENDPROC(sys_clone_wrapper)
1da177e4
LT
368
369sys_sigsuspend_wrapper:
370 add r3, sp, #S_OFF
371 b sys_sigsuspend
93ed3970 372ENDPROC(sys_sigsuspend_wrapper)
1da177e4
LT
373
374sys_rt_sigsuspend_wrapper:
375 add r2, sp, #S_OFF
376 b sys_rt_sigsuspend
93ed3970 377ENDPROC(sys_rt_sigsuspend_wrapper)
1da177e4
LT
378
379sys_sigreturn_wrapper:
380 add r0, sp, #S_OFF
381 b sys_sigreturn
93ed3970 382ENDPROC(sys_sigreturn_wrapper)
1da177e4
LT
383
384sys_rt_sigreturn_wrapper:
385 add r0, sp, #S_OFF
386 b sys_rt_sigreturn
93ed3970 387ENDPROC(sys_rt_sigreturn_wrapper)
1da177e4
LT
388
389sys_sigaltstack_wrapper:
390 ldr r2, [sp, #S_OFF + S_SP]
391 b do_sigaltstack
93ed3970 392ENDPROC(sys_sigaltstack_wrapper)
1da177e4 393
713c4815
NP
394sys_statfs64_wrapper:
395 teq r1, #88
396 moveq r1, #84
397 b sys_statfs64
93ed3970 398ENDPROC(sys_statfs64_wrapper)
713c4815
NP
399
400sys_fstatfs64_wrapper:
401 teq r1, #88
402 moveq r1, #84
403 b sys_fstatfs64
93ed3970 404ENDPROC(sys_fstatfs64_wrapper)
713c4815 405
1da177e4
LT
406/*
407 * Note: off_4k (r5) is always units of 4K. If we can't do the requested
408 * offset, we return EINVAL.
409 */
410sys_mmap2:
411#if PAGE_SHIFT > 12
412 tst r5, #PGOFF_MASK
413 moveq r5, r5, lsr #PAGE_SHIFT - 12
414 streq r5, [sp, #4]
415 beq do_mmap2
416 mov r0, #-EINVAL
7999d8d7 417 mov pc, lr
1da177e4
LT
418#else
419 str r5, [sp, #4]
420 b do_mmap2
421#endif
93ed3970 422ENDPROC(sys_mmap2)
687ad019 423
48d7927b
PB
424ENTRY(pabort_ifar)
425 mrc p15, 0, r0, cr6, cr0, 2
426ENTRY(pabort_noifar)
427 mov pc, lr
93ed3970
CM
428ENDPROC(pabort_ifar)
429ENDPROC(pabort_noifar)
48d7927b 430
687ad019 431#ifdef CONFIG_OABI_COMPAT
dd35afc2 432
687ad019
NP
433/*
434 * These are syscalls with argument register differences
435 */
436
437sys_oabi_pread64:
438 stmia sp, {r3, r4}
439 b sys_pread64
93ed3970 440ENDPROC(sys_oabi_pread64)
687ad019
NP
441
442sys_oabi_pwrite64:
443 stmia sp, {r3, r4}
444 b sys_pwrite64
93ed3970 445ENDPROC(sys_oabi_pwrite64)
687ad019
NP
446
447sys_oabi_truncate64:
448 mov r3, r2
449 mov r2, r1
450 b sys_truncate64
93ed3970 451ENDPROC(sys_oabi_truncate64)
687ad019
NP
452
453sys_oabi_ftruncate64:
454 mov r3, r2
455 mov r2, r1
456 b sys_ftruncate64
93ed3970 457ENDPROC(sys_oabi_ftruncate64)
687ad019
NP
458
459sys_oabi_readahead:
460 str r3, [sp]
461 mov r3, r2
462 mov r2, r1
463 b sys_readahead
93ed3970 464ENDPROC(sys_oabi_readahead)
687ad019 465
dd35afc2
NP
466/*
467 * Let's declare a second syscall table for old ABI binaries
468 * using the compatibility syscall entries.
469 */
470#define ABI(native, compat) compat
471#define OBSOLETE(syscall) syscall
472
473 .type sys_oabi_call_table, #object
474ENTRY(sys_oabi_call_table)
475#include "calls.S"
476#undef ABI
477#undef OBSOLETE
478
687ad019
NP
479#endif
480