Linux Audio

Check our new training course

Loading...
v4.17
 
  1/*
  2 * Copyright (C) 2009 Sunplus Core Technology Co., Ltd.
  3 *  Chen Liqin <liqin.chen@sunplusct.com>
  4 *  Lennox Wu <lennox.wu@sunplusct.com>
  5 * Copyright (C) 2012 Regents of the University of California
  6 *
  7 * This program is free software; you can redistribute it and/or modify
  8 * it under the terms of the GNU General Public License as published by
  9 * the Free Software Foundation; either version 2 of the License, or
 10 * (at your option) any later version.
 11 *
 12 * This program is distributed in the hope that it will be useful,
 13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 15 * GNU General Public License for more details.
 16 *
 17 * You should have received a copy of the GNU General Public License
 18 * along with this program; if not, see the file COPYING, or write
 19 * to the Free Software Foundation, Inc.,
 20 */
 21
 
 22#include <linux/signal.h>
 23#include <linux/uaccess.h>
 24#include <linux/syscalls.h>
 25#include <linux/tracehook.h>
 26#include <linux/linkage.h>
 27
 28#include <asm/ucontext.h>
 29#include <asm/vdso.h>
 
 
 30#include <asm/switch_to.h>
 31#include <asm/csr.h>
 32
 
 
 33#define DEBUG_SIG 0
 34
 35struct rt_sigframe {
 36	struct siginfo info;
 37	struct ucontext uc;
 
 
 
 38};
 39
 40static long restore_d_state(struct pt_regs *regs,
 41	struct __riscv_d_ext_state __user *state)
 
 42{
 43	long err;
 
 
 
 44	err = __copy_from_user(&current->thread.fstate, state, sizeof(*state));
 45	if (likely(!err))
 46		fstate_restore(current, regs);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 47	return err;
 48}
 49
 50static long save_d_state(struct pt_regs *regs,
 51	struct __riscv_d_ext_state __user *state)
 52{
 
 
 
 
 53	fstate_save(current, regs);
 54	return __copy_to_user(state, &current->thread.fstate, sizeof(*state));
 
 
 
 
 
 
 
 
 
 
 
 55}
 
 
 
 
 56
 57static long restore_sigcontext(struct pt_regs *regs,
 58	struct sigcontext __user *sc)
 59{
 60	long err;
 61	size_t i;
 62	/* sc_regs is structured the same as the start of pt_regs */
 63	err = __copy_from_user(regs, &sc->sc_regs, sizeof(sc->sc_regs));
 64	if (unlikely(err))
 65		return err;
 66	/* Restore the floating-point state. */
 67	err = restore_d_state(regs, &sc->sc_fpregs.d);
 68	if (unlikely(err))
 69		return err;
 70	/* We support no other extension state at this time. */
 71	for (i = 0; i < ARRAY_SIZE(sc->sc_fpregs.q.reserved); i++) {
 72		u32 value;
 73		err = __get_user(value, &sc->sc_fpregs.q.reserved[i]);
 74		if (unlikely(err))
 75			break;
 76		if (value != 0)
 77			return -EINVAL;
 78	}
 79	return err;
 80}
 81
 82SYSCALL_DEFINE0(rt_sigreturn)
 83{
 84	struct pt_regs *regs = current_pt_regs();
 85	struct rt_sigframe __user *frame;
 86	struct task_struct *task;
 87	sigset_t set;
 88
 89	/* Always make any pending restarted system calls return -EINTR */
 90	current->restart_block.fn = do_no_restart_syscall;
 91
 92	frame = (struct rt_sigframe __user *)regs->sp;
 93
 94	if (!access_ok(VERIFY_READ, frame, sizeof(*frame)))
 95		goto badframe;
 96
 97	if (__copy_from_user(&set, &frame->uc.uc_sigmask, sizeof(set)))
 98		goto badframe;
 99
100	set_current_blocked(&set);
101
102	if (restore_sigcontext(regs, &frame->uc.uc_mcontext))
103		goto badframe;
104
105	if (restore_altstack(&frame->uc.uc_stack))
106		goto badframe;
107
 
 
108	return regs->a0;
109
110badframe:
111	task = current;
112	if (show_unhandled_signals) {
113		pr_info_ratelimited(
114			"%s[%d]: bad frame in %s: frame=%p pc=%p sp=%p\n",
115			task->comm, task_pid_nr(task), __func__,
116			frame, (void *)regs->sepc, (void *)regs->sp);
117	}
118	force_sig(SIGSEGV, task);
119	return 0;
120}
121
122static long setup_sigcontext(struct rt_sigframe __user *frame,
123	struct pt_regs *regs)
124{
125	struct sigcontext __user *sc = &frame->uc.uc_mcontext;
126	long err;
127	size_t i;
128	/* sc_regs is structured the same as the start of pt_regs */
129	err = __copy_to_user(&sc->sc_regs, regs, sizeof(sc->sc_regs));
130	/* Save the floating-point state. */
131	err |= save_d_state(regs, &sc->sc_fpregs.d);
132	/* We support no other extension state at this time. */
133	for (i = 0; i < ARRAY_SIZE(sc->sc_fpregs.q.reserved); i++)
134		err |= __put_user(0, &sc->sc_fpregs.q.reserved[i]);
135	return err;
136}
137
138static inline void __user *get_sigframe(struct ksignal *ksig,
139	struct pt_regs *regs, size_t framesize)
140{
141	unsigned long sp;
142	/* Default to using normal stack */
143	sp = regs->sp;
144
145	/*
146	 * If we are on the alternate signal stack and would overflow it, don't.
147	 * Return an always-bogus address instead so we will die with SIGSEGV.
148	 */
149	if (on_sig_stack(sp) && !likely(on_sig_stack(sp - framesize)))
150		return (void __user __force *)(-1UL);
151
152	/* This is the X/Open sanctioned signal stack switching. */
153	sp = sigsp(sp, ksig) - framesize;
154
155	/* Align the stack frame. */
156	sp &= ~0xfUL;
157
158	return (void __user *)sp;
159}
160
161
162static int setup_rt_frame(struct ksignal *ksig, sigset_t *set,
163	struct pt_regs *regs)
164{
165	struct rt_sigframe __user *frame;
166	long err = 0;
167
168	frame = get_sigframe(ksig, regs, sizeof(*frame));
169	if (!access_ok(VERIFY_WRITE, frame, sizeof(*frame)))
170		return -EFAULT;
171
172	err |= copy_siginfo_to_user(&frame->info, &ksig->info);
173
174	/* Create the ucontext. */
175	err |= __put_user(0, &frame->uc.uc_flags);
176	err |= __put_user(NULL, &frame->uc.uc_link);
177	err |= __save_altstack(&frame->uc.uc_stack, regs->sp);
178	err |= setup_sigcontext(frame, regs);
179	err |= __copy_to_user(&frame->uc.uc_sigmask, set, sizeof(*set));
180	if (err)
181		return -EFAULT;
182
183	/* Set up to return from userspace. */
 
184	regs->ra = (unsigned long)VDSO_SYMBOL(
185		current->mm->context.vdso, rt_sigreturn);
 
 
 
 
 
 
 
 
 
 
186
187	/*
188	 * Set up registers for signal handler.
189	 * Registers that we don't modify keep the value they had from
190	 * user-space at the time we took the signal.
191	 * We always pass siginfo and mcontext, regardless of SA_SIGINFO,
192	 * since some things rely on this (e.g. glibc's debug/segfault.c).
193	 */
194	regs->sepc = (unsigned long)ksig->ka.sa.sa_handler;
195	regs->sp = (unsigned long)frame;
196	regs->a0 = ksig->sig;                     /* a0: signal number */
197	regs->a1 = (unsigned long)(&frame->info); /* a1: siginfo pointer */
198	regs->a2 = (unsigned long)(&frame->uc);   /* a2: ucontext pointer */
199
200#if DEBUG_SIG
201	pr_info("SIG deliver (%s:%d): sig=%d pc=%p ra=%p sp=%p\n",
202		current->comm, task_pid_nr(current), ksig->sig,
203		(void *)regs->sepc, (void *)regs->ra, frame);
204#endif
205
206	return 0;
207}
208
209static void handle_signal(struct ksignal *ksig, struct pt_regs *regs)
210{
211	sigset_t *oldset = sigmask_to_save();
212	int ret;
213
214	/* Are we from a system call? */
215	if (regs->scause == EXC_SYSCALL) {
 
 
216		/* If so, check system call restarting.. */
217		switch (regs->a0) {
218		case -ERESTART_RESTARTBLOCK:
219		case -ERESTARTNOHAND:
220			regs->a0 = -EINTR;
221			break;
222
223		case -ERESTARTSYS:
224			if (!(ksig->ka.sa.sa_flags & SA_RESTART)) {
225				regs->a0 = -EINTR;
226				break;
227			}
228			/* fallthrough */
229		case -ERESTARTNOINTR:
230                        regs->a0 = regs->orig_a0;
231			regs->sepc -= 0x4;
232			break;
233		}
234	}
235
 
 
236	/* Set up the stack frame */
237	ret = setup_rt_frame(ksig, oldset, regs);
 
 
 
238
239	signal_setup_done(ret, ksig, 0);
240}
241
242static void do_signal(struct pt_regs *regs)
243{
244	struct ksignal ksig;
245
246	if (get_signal(&ksig)) {
247		/* Actually deliver the signal */
248		handle_signal(&ksig, regs);
249		return;
250	}
251
252	/* Did we come from a system call? */
253	if (regs->scause == EXC_SYSCALL) {
 
 
 
254		/* Restart the system call - no handlers present */
255		switch (regs->a0) {
256		case -ERESTARTNOHAND:
257		case -ERESTARTSYS:
258		case -ERESTARTNOINTR:
259                        regs->a0 = regs->orig_a0;
260			regs->sepc -= 0x4;
261			break;
262		case -ERESTART_RESTARTBLOCK:
263                        regs->a0 = regs->orig_a0;
264			regs->a7 = __NR_restart_syscall;
265			regs->sepc -= 0x4;
266			break;
267		}
268	}
269
270	/*
271	 * If there is no signal to deliver, we just put the saved
272	 * sigmask back.
273	 */
274	restore_saved_sigmask();
275}
276
277/*
278 * notification of userspace execution resumption
279 * - triggered by the _TIF_WORK_MASK flags
280 */
281asmlinkage void do_notify_resume(struct pt_regs *regs,
282	unsigned long thread_info_flags)
283{
284	/* Handle pending signal delivery */
285	if (thread_info_flags & _TIF_SIGPENDING)
286		do_signal(regs);
287
288	if (thread_info_flags & _TIF_NOTIFY_RESUME) {
289		clear_thread_flag(TIF_NOTIFY_RESUME);
290		tracehook_notify_resume(regs);
291	}
 
 
 
 
 
 
 
 
 
292}
v6.2
  1// SPDX-License-Identifier: GPL-2.0-or-later
  2/*
  3 * Copyright (C) 2009 Sunplus Core Technology Co., Ltd.
  4 *  Chen Liqin <liqin.chen@sunplusct.com>
  5 *  Lennox Wu <lennox.wu@sunplusct.com>
  6 * Copyright (C) 2012 Regents of the University of California
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  7 */
  8
  9#include <linux/compat.h>
 10#include <linux/signal.h>
 11#include <linux/uaccess.h>
 12#include <linux/syscalls.h>
 13#include <linux/resume_user_mode.h>
 14#include <linux/linkage.h>
 15
 16#include <asm/ucontext.h>
 17#include <asm/vdso.h>
 18#include <asm/signal.h>
 19#include <asm/signal32.h>
 20#include <asm/switch_to.h>
 21#include <asm/csr.h>
 22
 23extern u32 __user_rt_sigreturn[2];
 24
 25#define DEBUG_SIG 0
 26
 27struct rt_sigframe {
 28	struct siginfo info;
 29	struct ucontext uc;
 30#ifndef CONFIG_MMU
 31	u32 sigreturn_code[2];
 32#endif
 33};
 34
 35#ifdef CONFIG_FPU
 36static long restore_fp_state(struct pt_regs *regs,
 37			     union __riscv_fp_state __user *sc_fpregs)
 38{
 39	long err;
 40	struct __riscv_d_ext_state __user *state = &sc_fpregs->d;
 41	size_t i;
 42
 43	err = __copy_from_user(&current->thread.fstate, state, sizeof(*state));
 44	if (unlikely(err))
 45		return err;
 46
 47	fstate_restore(current, regs);
 48
 49	/* We support no other extension state at this time. */
 50	for (i = 0; i < ARRAY_SIZE(sc_fpregs->q.reserved); i++) {
 51		u32 value;
 52
 53		err = __get_user(value, &sc_fpregs->q.reserved[i]);
 54		if (unlikely(err))
 55			break;
 56		if (value != 0)
 57			return -EINVAL;
 58	}
 59
 60	return err;
 61}
 62
 63static long save_fp_state(struct pt_regs *regs,
 64			  union __riscv_fp_state __user *sc_fpregs)
 65{
 66	long err;
 67	struct __riscv_d_ext_state __user *state = &sc_fpregs->d;
 68	size_t i;
 69
 70	fstate_save(current, regs);
 71	err = __copy_to_user(state, &current->thread.fstate, sizeof(*state));
 72	if (unlikely(err))
 73		return err;
 74
 75	/* We support no other extension state at this time. */
 76	for (i = 0; i < ARRAY_SIZE(sc_fpregs->q.reserved); i++) {
 77		err = __put_user(0, &sc_fpregs->q.reserved[i]);
 78		if (unlikely(err))
 79			break;
 80	}
 81
 82	return err;
 83}
 84#else
 85#define save_fp_state(task, regs) (0)
 86#define restore_fp_state(task, regs) (0)
 87#endif
 88
 89static long restore_sigcontext(struct pt_regs *regs,
 90	struct sigcontext __user *sc)
 91{
 92	long err;
 
 93	/* sc_regs is structured the same as the start of pt_regs */
 94	err = __copy_from_user(regs, &sc->sc_regs, sizeof(sc->sc_regs));
 
 
 95	/* Restore the floating-point state. */
 96	if (has_fpu())
 97		err |= restore_fp_state(regs, &sc->sc_fpregs);
 
 
 
 
 
 
 
 
 
 
 98	return err;
 99}
100
101SYSCALL_DEFINE0(rt_sigreturn)
102{
103	struct pt_regs *regs = current_pt_regs();
104	struct rt_sigframe __user *frame;
105	struct task_struct *task;
106	sigset_t set;
107
108	/* Always make any pending restarted system calls return -EINTR */
109	current->restart_block.fn = do_no_restart_syscall;
110
111	frame = (struct rt_sigframe __user *)regs->sp;
112
113	if (!access_ok(frame, sizeof(*frame)))
114		goto badframe;
115
116	if (__copy_from_user(&set, &frame->uc.uc_sigmask, sizeof(set)))
117		goto badframe;
118
119	set_current_blocked(&set);
120
121	if (restore_sigcontext(regs, &frame->uc.uc_mcontext))
122		goto badframe;
123
124	if (restore_altstack(&frame->uc.uc_stack))
125		goto badframe;
126
127	regs->cause = -1UL;
128
129	return regs->a0;
130
131badframe:
132	task = current;
133	if (show_unhandled_signals) {
134		pr_info_ratelimited(
135			"%s[%d]: bad frame in %s: frame=%p pc=%p sp=%p\n",
136			task->comm, task_pid_nr(task), __func__,
137			frame, (void *)regs->epc, (void *)regs->sp);
138	}
139	force_sig(SIGSEGV);
140	return 0;
141}
142
143static long setup_sigcontext(struct rt_sigframe __user *frame,
144	struct pt_regs *regs)
145{
146	struct sigcontext __user *sc = &frame->uc.uc_mcontext;
147	long err;
 
148	/* sc_regs is structured the same as the start of pt_regs */
149	err = __copy_to_user(&sc->sc_regs, regs, sizeof(sc->sc_regs));
150	/* Save the floating-point state. */
151	if (has_fpu())
152		err |= save_fp_state(regs, &sc->sc_fpregs);
 
 
153	return err;
154}
155
156static inline void __user *get_sigframe(struct ksignal *ksig,
157	struct pt_regs *regs, size_t framesize)
158{
159	unsigned long sp;
160	/* Default to using normal stack */
161	sp = regs->sp;
162
163	/*
164	 * If we are on the alternate signal stack and would overflow it, don't.
165	 * Return an always-bogus address instead so we will die with SIGSEGV.
166	 */
167	if (on_sig_stack(sp) && !likely(on_sig_stack(sp - framesize)))
168		return (void __user __force *)(-1UL);
169
170	/* This is the X/Open sanctioned signal stack switching. */
171	sp = sigsp(sp, ksig) - framesize;
172
173	/* Align the stack frame. */
174	sp &= ~0xfUL;
175
176	return (void __user *)sp;
177}
178
 
179static int setup_rt_frame(struct ksignal *ksig, sigset_t *set,
180	struct pt_regs *regs)
181{
182	struct rt_sigframe __user *frame;
183	long err = 0;
184
185	frame = get_sigframe(ksig, regs, sizeof(*frame));
186	if (!access_ok(frame, sizeof(*frame)))
187		return -EFAULT;
188
189	err |= copy_siginfo_to_user(&frame->info, &ksig->info);
190
191	/* Create the ucontext. */
192	err |= __put_user(0, &frame->uc.uc_flags);
193	err |= __put_user(NULL, &frame->uc.uc_link);
194	err |= __save_altstack(&frame->uc.uc_stack, regs->sp);
195	err |= setup_sigcontext(frame, regs);
196	err |= __copy_to_user(&frame->uc.uc_sigmask, set, sizeof(*set));
197	if (err)
198		return -EFAULT;
199
200	/* Set up to return from userspace. */
201#ifdef CONFIG_MMU
202	regs->ra = (unsigned long)VDSO_SYMBOL(
203		current->mm->context.vdso, rt_sigreturn);
204#else
205	/*
206	 * For the nommu case we don't have a VDSO.  Instead we push two
207	 * instructions to call the rt_sigreturn syscall onto the user stack.
208	 */
209	if (copy_to_user(&frame->sigreturn_code, __user_rt_sigreturn,
210			 sizeof(frame->sigreturn_code)))
211		return -EFAULT;
212	regs->ra = (unsigned long)&frame->sigreturn_code;
213#endif /* CONFIG_MMU */
214
215	/*
216	 * Set up registers for signal handler.
217	 * Registers that we don't modify keep the value they had from
218	 * user-space at the time we took the signal.
219	 * We always pass siginfo and mcontext, regardless of SA_SIGINFO,
220	 * since some things rely on this (e.g. glibc's debug/segfault.c).
221	 */
222	regs->epc = (unsigned long)ksig->ka.sa.sa_handler;
223	regs->sp = (unsigned long)frame;
224	regs->a0 = ksig->sig;                     /* a0: signal number */
225	regs->a1 = (unsigned long)(&frame->info); /* a1: siginfo pointer */
226	regs->a2 = (unsigned long)(&frame->uc);   /* a2: ucontext pointer */
227
228#if DEBUG_SIG
229	pr_info("SIG deliver (%s:%d): sig=%d pc=%p ra=%p sp=%p\n",
230		current->comm, task_pid_nr(current), ksig->sig,
231		(void *)regs->epc, (void *)regs->ra, frame);
232#endif
233
234	return 0;
235}
236
237static void handle_signal(struct ksignal *ksig, struct pt_regs *regs)
238{
239	sigset_t *oldset = sigmask_to_save();
240	int ret;
241
242	/* Are we from a system call? */
243	if (regs->cause == EXC_SYSCALL) {
244		/* Avoid additional syscall restarting via ret_from_exception */
245		regs->cause = -1UL;
246		/* If so, check system call restarting.. */
247		switch (regs->a0) {
248		case -ERESTART_RESTARTBLOCK:
249		case -ERESTARTNOHAND:
250			regs->a0 = -EINTR;
251			break;
252
253		case -ERESTARTSYS:
254			if (!(ksig->ka.sa.sa_flags & SA_RESTART)) {
255				regs->a0 = -EINTR;
256				break;
257			}
258			fallthrough;
259		case -ERESTARTNOINTR:
260                        regs->a0 = regs->orig_a0;
261			regs->epc -= 0x4;
262			break;
263		}
264	}
265
266	rseq_signal_deliver(ksig, regs);
267
268	/* Set up the stack frame */
269	if (is_compat_task())
270		ret = compat_setup_rt_frame(ksig, oldset, regs);
271	else
272		ret = setup_rt_frame(ksig, oldset, regs);
273
274	signal_setup_done(ret, ksig, 0);
275}
276
277static void do_signal(struct pt_regs *regs)
278{
279	struct ksignal ksig;
280
281	if (get_signal(&ksig)) {
282		/* Actually deliver the signal */
283		handle_signal(&ksig, regs);
284		return;
285	}
286
287	/* Did we come from a system call? */
288	if (regs->cause == EXC_SYSCALL) {
289		/* Avoid additional syscall restarting via ret_from_exception */
290		regs->cause = -1UL;
291
292		/* Restart the system call - no handlers present */
293		switch (regs->a0) {
294		case -ERESTARTNOHAND:
295		case -ERESTARTSYS:
296		case -ERESTARTNOINTR:
297                        regs->a0 = regs->orig_a0;
298			regs->epc -= 0x4;
299			break;
300		case -ERESTART_RESTARTBLOCK:
301                        regs->a0 = regs->orig_a0;
302			regs->a7 = __NR_restart_syscall;
303			regs->epc -= 0x4;
304			break;
305		}
306	}
307
308	/*
309	 * If there is no signal to deliver, we just put the saved
310	 * sigmask back.
311	 */
312	restore_saved_sigmask();
313}
314
315/*
316 * Handle any pending work on the resume-to-userspace path, as indicated by
317 * _TIF_WORK_MASK. Entered from assembly with IRQs off.
318 */
319asmlinkage __visible void do_work_pending(struct pt_regs *regs,
320					  unsigned long thread_info_flags)
321{
322	do {
323		if (thread_info_flags & _TIF_NEED_RESCHED) {
324			schedule();
325		} else {
326			local_irq_enable();
327			if (thread_info_flags & _TIF_UPROBE)
328				uprobe_notify_resume(regs);
329			/* Handle pending signal delivery */
330			if (thread_info_flags & (_TIF_SIGPENDING |
331						 _TIF_NOTIFY_SIGNAL))
332				do_signal(regs);
333			if (thread_info_flags & _TIF_NOTIFY_RESUME)
334				resume_user_mode_work(regs);
335		}
336		local_irq_disable();
337		thread_info_flags = read_thread_flags();
338	} while (thread_info_flags & _TIF_WORK_MASK);
339}