2 * arch/score/kernel/signal.c
4 * Score Processor version.
6 * Copyright (C) 2009 Sunplus Core Technology Co., Ltd.
7 * Chen Liqin <liqin.chen@sunplusct.com>
8 * Lennox Wu <lennox.wu@sunplusct.com>
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License as published by
12 * the Free Software Foundation; either version 2 of the License, or
13 * (at your option) any later version.
15 * This program is distributed in the hope that it will be useful,
16 * but WITHOUT ANY WARRANTY; without even the implied warranty of
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18 * GNU General Public License for more details.
20 * You should have received a copy of the GNU General Public License
21 * along with this program; if not, see the file COPYING, or write
22 * to the Free Software Foundation, Inc.,
23 * 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
26 #include <linux/errno.h>
27 #include <linux/signal.h>
28 #include <linux/ptrace.h>
29 #include <linux/unistd.h>
30 #include <linux/uaccess.h>
31 #include <linux/tracehook.h>
33 #include <asm/cacheflush.h>
34 #include <asm/syscalls.h>
35 #include <asm/ucontext.h>
37 #define _BLOCKABLE (~(sigmask(SIGKILL) | sigmask(SIGSTOP)))
40 u32 rs_ass[4]; /* argument save space */
41 u32 rs_code[2]; /* signal trampoline */
42 struct siginfo rs_info;
43 struct ucontext rs_uc;
46 static int setup_sigcontext(struct pt_regs *regs, struct sigcontext __user *sc)
51 reg = regs->cp0_epc; err |= __put_user(reg, &sc->sc_pc);
52 err |= __put_user(regs->cp0_psr, &sc->sc_psr);
53 err |= __put_user(regs->cp0_condition, &sc->sc_condition);
56 #define save_gp_reg(i) { \
57 reg = regs->regs[i]; \
58 err |= __put_user(reg, &sc->sc_regs[i]); \
60 save_gp_reg(0); save_gp_reg(1); save_gp_reg(2);
61 save_gp_reg(3); save_gp_reg(4); save_gp_reg(5);
62 save_gp_reg(6); save_gp_reg(7); save_gp_reg(8);
63 save_gp_reg(9); save_gp_reg(10); save_gp_reg(11);
64 save_gp_reg(12); save_gp_reg(13); save_gp_reg(14);
65 save_gp_reg(15); save_gp_reg(16); save_gp_reg(17);
66 save_gp_reg(18); save_gp_reg(19); save_gp_reg(20);
67 save_gp_reg(21); save_gp_reg(22); save_gp_reg(23);
68 save_gp_reg(24); save_gp_reg(25); save_gp_reg(26);
69 save_gp_reg(27); save_gp_reg(28); save_gp_reg(29);
72 reg = regs->ceh; err |= __put_user(reg, &sc->sc_mdceh);
73 reg = regs->cel; err |= __put_user(reg, &sc->sc_mdcel);
74 err |= __put_user(regs->cp0_ecr, &sc->sc_ecr);
75 err |= __put_user(regs->cp0_ema, &sc->sc_ema);
80 static int restore_sigcontext(struct pt_regs *regs, struct sigcontext __user *sc)
85 err |= __get_user(regs->cp0_epc, &sc->sc_pc);
86 err |= __get_user(regs->cp0_condition, &sc->sc_condition);
88 err |= __get_user(reg, &sc->sc_mdceh);
89 regs->ceh = (int) reg;
90 err |= __get_user(reg, &sc->sc_mdcel);
91 regs->cel = (int) reg;
93 err |= __get_user(reg, &sc->sc_psr);
94 regs->cp0_psr = (int) reg;
95 err |= __get_user(reg, &sc->sc_ecr);
96 regs->cp0_ecr = (int) reg;
97 err |= __get_user(reg, &sc->sc_ema);
98 regs->cp0_ema = (int) reg;
100 #define restore_gp_reg(i) do { \
101 err |= __get_user(reg, &sc->sc_regs[i]); \
102 regs->regs[i] = reg; \
104 restore_gp_reg(0); restore_gp_reg(1); restore_gp_reg(2);
105 restore_gp_reg(3); restore_gp_reg(4); restore_gp_reg(5);
106 restore_gp_reg(6); restore_gp_reg(7); restore_gp_reg(8);
107 restore_gp_reg(9); restore_gp_reg(10); restore_gp_reg(11);
108 restore_gp_reg(12); restore_gp_reg(13); restore_gp_reg(14);
109 restore_gp_reg(15); restore_gp_reg(16); restore_gp_reg(17);
110 restore_gp_reg(18); restore_gp_reg(19); restore_gp_reg(20);
111 restore_gp_reg(21); restore_gp_reg(22); restore_gp_reg(23);
112 restore_gp_reg(24); restore_gp_reg(25); restore_gp_reg(26);
113 restore_gp_reg(27); restore_gp_reg(28); restore_gp_reg(29);
114 #undef restore_gp_reg
120 * Determine which stack to use..
122 static void __user *get_sigframe(struct k_sigaction *ka,
123 struct pt_regs *regs, size_t frame_size)
127 /* Default to using normal stack */
131 /* This is the X/Open sanctioned signal stack switching. */
132 if ((ka->sa.sa_flags & SA_ONSTACK) && (!on_sig_stack(sp)))
133 sp = current->sas_ss_sp + current->sas_ss_size;
135 return (void __user*)((sp - frame_size) & ~7);
139 score_sigaltstack(struct pt_regs *regs)
141 const stack_t __user *uss = (const stack_t __user *) regs->regs[4];
142 stack_t __user *uoss = (stack_t __user *) regs->regs[5];
143 unsigned long usp = regs->regs[0];
145 return do_sigaltstack(uss, uoss, usp);
149 score_rt_sigreturn(struct pt_regs *regs)
151 struct rt_sigframe __user *frame;
156 /* Always make any pending restarted system calls return -EINTR */
157 current_thread_info()->restart_block.fn = do_no_restart_syscall;
159 frame = (struct rt_sigframe __user *) regs->regs[0];
160 if (!access_ok(VERIFY_READ, frame, sizeof(*frame)))
162 if (__copy_from_user(&set, &frame->rs_uc.uc_sigmask, sizeof(set)))
165 sigdelsetmask(&set, ~_BLOCKABLE);
166 set_current_blocked(&set);
168 sig = restore_sigcontext(regs, &frame->rs_uc.uc_mcontext);
172 force_sig(sig, current);
174 if (__copy_from_user(&st, &frame->rs_uc.uc_stack, sizeof(st)))
177 /* It is more difficult to avoid calling this function than to
178 call it and ignore errors. */
179 do_sigaltstack((stack_t __user *)&st, NULL, regs->regs[0]);
181 __asm__ __volatile__(
183 "la\tr8, syscall_exit\n\t"
185 : : "r" (regs) : "r8");
188 force_sig(SIGSEGV, current);
193 static int setup_rt_frame(struct k_sigaction *ka, struct pt_regs *regs,
194 int signr, sigset_t *set, siginfo_t *info)
196 struct rt_sigframe __user *frame;
199 frame = get_sigframe(ka, regs, sizeof(*frame));
200 if (!access_ok(VERIFY_WRITE, frame, sizeof(*frame)))
204 * Set up the return code ...
206 * li v0, __NR_rt_sigreturn
209 err |= __put_user(0x87788000 + __NR_rt_sigreturn*2,
211 err |= __put_user(0x80008002, frame->rs_code + 1);
212 flush_cache_sigtramp((unsigned long) frame->rs_code);
214 err |= copy_siginfo_to_user(&frame->rs_info, info);
215 err |= __put_user(0, &frame->rs_uc.uc_flags);
216 err |= __put_user(NULL, &frame->rs_uc.uc_link);
217 err |= __put_user((void __user *)current->sas_ss_sp,
218 &frame->rs_uc.uc_stack.ss_sp);
219 err |= __put_user(sas_ss_flags(regs->regs[0]),
220 &frame->rs_uc.uc_stack.ss_flags);
221 err |= __put_user(current->sas_ss_size,
222 &frame->rs_uc.uc_stack.ss_size);
223 err |= setup_sigcontext(regs, &frame->rs_uc.uc_mcontext);
224 err |= __copy_to_user(&frame->rs_uc.uc_sigmask, set, sizeof(*set));
229 regs->regs[0] = (unsigned long) frame;
230 regs->regs[3] = (unsigned long) frame->rs_code;
231 regs->regs[4] = signr;
232 regs->regs[5] = (unsigned long) &frame->rs_info;
233 regs->regs[6] = (unsigned long) &frame->rs_uc;
234 regs->regs[29] = (unsigned long) ka->sa.sa_handler;
235 regs->cp0_epc = (unsigned long) ka->sa.sa_handler;
240 force_sigsegv(signr, current);
244 static void handle_signal(unsigned long sig, siginfo_t *info,
245 struct k_sigaction *ka, struct pt_regs *regs)
247 if (regs->is_syscall) {
248 switch (regs->regs[4]) {
249 case ERESTART_RESTARTBLOCK:
251 regs->regs[4] = EINTR;
254 if (!(ka->sa.sa_flags & SA_RESTART)) {
255 regs->regs[4] = EINTR;
259 regs->regs[4] = regs->orig_r4;
260 regs->regs[7] = regs->orig_r7;
264 regs->is_syscall = 0;
268 * Set up the stack frame
270 if (setup_rt_frame(ka, regs, sig, sigmask_to_save(), info) < 0)
273 block_sigmask(ka, sig);
276 static void do_signal(struct pt_regs *regs)
278 struct k_sigaction ka;
283 * We want the common case to go fast, which is why we may in certain
284 * cases get here from kernel mode. Just return without doing anything
287 if (!user_mode(regs))
290 signr = get_signal_to_deliver(&info, &ka, regs, NULL);
292 /* Actually deliver the signal. */
293 handle_signal(signr, &info, &ka, regs);
297 if (regs->is_syscall) {
298 if (regs->regs[4] == ERESTARTNOHAND ||
299 regs->regs[4] == ERESTARTSYS ||
300 regs->regs[4] == ERESTARTNOINTR) {
301 regs->regs[4] = regs->orig_r4;
302 regs->regs[7] = regs->orig_r7;
306 if (regs->regs[4] == ERESTART_RESTARTBLOCK) {
307 regs->regs[27] = __NR_restart_syscall;
308 regs->regs[4] = regs->orig_r4;
309 regs->regs[7] = regs->orig_r7;
313 regs->is_syscall = 0; /* Don't deal with this again. */
317 * If there's no signal to deliver, we just put the saved sigmask
320 restore_saved_sigmask();
324 * notification of userspace execution resumption
325 * - triggered by the TIF_WORK_MASK flags
327 asmlinkage void do_notify_resume(struct pt_regs *regs, void *unused,
328 __u32 thread_info_flags)
330 /* deal with pending signal delivery */
331 if (thread_info_flags & _TIF_SIGPENDING)
333 if (thread_info_flags & _TIF_NOTIFY_RESUME) {
334 clear_thread_flag(TIF_NOTIFY_RESUME);
335 tracehook_notify_resume(regs);