ex-scall.S 2.2 KB
Newer Older
G
Greentime Hu 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21
// SPDX-License-Identifier: GPL-2.0
// Copyright (C) 2005-2017 Andes Technology Corporation

#include <linux/linkage.h>
#include <asm/unistd.h>
#include <asm/assembler.h>
#include <asm/nds32.h>
#include <asm/asm-offsets.h>
#include <asm/thread_info.h>
#include <asm/current.h>

/*
 * $r0 = previous task_struct,
 * $r1 = next task_struct,
 * previous and next are guaranteed not to be the same.
 */

ENTRY(__switch_to)

	la	$p0, __entry_task
	sw	$r1, [$p0]
V
Vincent Chen 已提交
22
	addi	$p1, $r0, #THREAD_CPU_CONTEXT
G
Greentime Hu 已提交
23 24
	smw.bi 	$r6, [$p1], $r14, #0xb		! push r6~r14, fp, lp, sp
	move	$r25, $r1
V
Vincent Chen 已提交
25 26 27 28
#if defined(CONFIG_FPU)
	call	_switch_fpu
#endif
	addi	$r1, $r25, #THREAD_CPU_CONTEXT
G
Greentime Hu 已提交
29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100
	lmw.bi 	$r6, [$r1], $r14, #0xb		! pop r6~r14, fp, lp, sp
	ret


#define tbl $r8

/*
 * $r7 will be writen as syscall nr
 */
	.macro	get_scno
	lwi	$r7, [$sp + R15_OFFSET]
	swi	$r7, [$sp + SYSCALLNO_OFFSET]
	.endm

	.macro	updateipc
	addi	$r17, $r13, #4				! $r13 is $IPC
	swi	$r17, [$sp + IPC_OFFSET]
	.endm

ENTRY(eh_syscall)
	updateipc

	get_scno
	gie_enable

	lwi	$p0, [tsk+#TSK_TI_FLAGS]		! check for syscall tracing

	andi	$p1, $p0, #_TIF_WORK_SYSCALL_ENTRY	! are we tracing syscalls?
	bnez	$p1, __sys_trace

	la	$lp, ret_fast_syscall		! return address
jmp_systbl:
	addi	$p1, $r7, #-__NR_syscalls	! syscall number of syscall instruction is guarded by addembler
	bgez	$p1, _SCNO_EXCEED		! call sys_* routine
	la	tbl, sys_call_table		! load syscall table pointer
	slli	$p1, $r7, #2
	add	$p1, tbl, $p1
	lwi	$p1, [$p1]
	jr	$p1				! no return

_SCNO_EXCEED:
	ori	$r0, $r7, #0
        ori	$r1, $sp, #0
	b	bad_syscall

/*
 * This is the really slow path.  We're going to be doing
 * context switches, and waiting for our parent to respond.
 */
__sys_trace:
	move	$r0, $sp
	bal	syscall_trace_enter
	move	$r7, $r0
	la	$lp, __sys_trace_return		! return address

	addi    $p1, $r7, #1
	beqz    $p1, ret_slow_syscall		! fatal signal is pending

	addi	$p1, $sp, #R0_OFFSET		! pointer to regs
	lmw.bi	$r0, [$p1], $r5			! have to reload $r0 - $r5
	b	jmp_systbl

__sys_trace_return:
	swi	$r0, [$sp+#R0_OFFSET]		! T: save returned $r0
	move	$r0, $sp			! set pt_regs for syscall_trace_leave
	bal	syscall_trace_leave
	b	ret_slow_syscall

ENTRY(sys_rt_sigreturn_wrapper)
	addi	$r0, $sp, #0
	b	sys_rt_sigreturn
ENDPROC(sys_rt_sigreturn_wrapper)