signal.c 12.1 KB
Newer Older
1
/*
2
 * arch/xtensa/kernel/signal.c
3
 *
4
 * Default platform functions.
5
 *
6
7
8
 * This file is subject to the terms and conditions of the GNU General Public
 * License.  See the file "COPYING" in the main directory of this archive
 * for more details.
9
 *
10
11
12
 * Copyright (C) 2005, 2006 Tensilica Inc.
 * Copyright (C) 1991, 1992  Linus Torvalds
 * 1997-11-28  Modified for POSIX.1b signals by Richard Henderson
13
 *
14
15
 * Chris Zankel <chris@zankel.net>
 * Joe Taylor <joe@tensilica.com>
16
17
18
19
20
21
 */

#include <linux/signal.h>
#include <linux/errno.h>
#include <linux/ptrace.h>
#include <linux/personality.h>
22
#include <linux/tracehook.h>
23
#include <linux/sched/task_stack.h>
24

25
#include <asm/ucontext.h>
26
#include <linux/uaccess.h>
27
#include <asm/cacheflush.h>
28
29
#include <asm/coprocessor.h>
#include <asm/unistd.h>
30
31
32

extern struct task_struct *coproc_owners[];

33
34
35
36
struct rt_sigframe
{
	struct siginfo info;
	struct ucontext uc;
37
38
39
40
41
42
43
	struct {
		xtregs_opt_t opt;
		xtregs_user_t user;
#if XTENSA_HAVE_COPROCESSORS
		xtregs_coprocessor_t cp;
#endif
	} xtregs;
44
45
46
47
48
49
50
	unsigned char retcode[6];
	unsigned int window[4];
};

/* 
 * Flush register windows stored in pt_regs to stack.
 * Returns 1 for errors.
51
52
 */

53
54
int
flush_window_regs_user(struct pt_regs *regs)
55
{
56
57
58
59
60
61
	const unsigned long ws = regs->windowstart;
	const unsigned long wb = regs->windowbase;
	unsigned long sp = 0;
	unsigned long wm;
	int err = 1;
	int base;
62

63
	/* Return if no other frames. */
64

65
66
	if (regs->wmask == 1)
		return 0;
67

68
	/* Rotate windowmask and skip empty frames. */
69

70
71
72
73
	wm = (ws >> wb) | (ws << (XCHAL_NUM_AREGS / 4 - wb));
	base = (XCHAL_NUM_AREGS / 4) - (regs->wmask >> 4);
		
	/* For call8 or call12 frames, we need the previous stack pointer. */
74

75
76
77
	if ((regs->wmask & 2) == 0)
		if (__get_user(sp, (int*)(regs->areg[base * 4 + 1] - 12)))
			goto errout;
78

79
	/* Spill frames to stack. */
80

81
	while (base < XCHAL_NUM_AREGS / 4) {
82

83
84
		int m = (wm >> base);
		int inc = 0;
85

86
		/* Save registers a4..a7 (call8) or a4...a11 (call12) */
87

88
89
		if (m & 2) {			/* call4 */
			inc = 1;
90

91
		} else if (m & 4) {		/* call8 */
92
93
			if (copy_to_user(&SPILL_SLOT_CALL8(sp, 4),
					 &regs->areg[(base + 1) * 4], 16))
94
95
				goto errout;
			inc = 2;
96

97
		} else if (m & 8) {	/* call12 */
98
99
			if (copy_to_user(&SPILL_SLOT_CALL12(sp, 4),
					 &regs->areg[(base + 1) * 4], 32))
100
101
102
				goto errout;
			inc = 3;
		}
103

104
		/* Save current frame a0..a3 under next SP */
105

106
		sp = regs->areg[((base + inc) * 4 + 1) % XCHAL_NUM_AREGS];
107
		if (copy_to_user(&SPILL_SLOT(sp, 0), &regs->areg[base * 4], 16))
108
109
110
111
112
113
114
115
			goto errout;

		/* Get current stack pointer for next loop iteration. */

		sp = regs->areg[base * 4 + 1];
		base += inc;
	}

116
117
118
	regs->wmask = 1;
	regs->windowstart = 1 << wb;

119
	return 0;
120

121
122
123
errout:
	return err;
}
124
125

/*
126
127
128
129
130
 * Note: We don't copy double exception 'regs', we have to finish double exc. 
 * first before we return to signal handler! This dbl.exc.handler might cause 
 * another double exception, but I think we are fine as the situation is the 
 * same as if we had returned to the signal handerl and got an interrupt 
 * immediately...
131
132
 */

133
static int
134
setup_sigcontext(struct rt_sigframe __user *frame, struct pt_regs *regs)
135
{
136
137
	struct sigcontext __user *sc = &frame->uc.uc_mcontext;
	struct thread_info *ti = current_thread_info();
138
	int err = 0;
139

140
141
142
143
144
145
146
147
#define COPY(x)	err |= __put_user(regs->x, &sc->sc_##x)
	COPY(pc);
	COPY(ps);
	COPY(lbeg);
	COPY(lend);
	COPY(lcount);
	COPY(sar);
#undef COPY
148

149
150
	err |= flush_window_regs_user(regs);
	err |= __copy_to_user (sc->sc_a, regs->areg, 16 * 4);
151
	err |= __put_user(0, &sc->sc_xtregs);
152

153
154
	if (err)
		return err;
155

156
157
158
159
160
#if XTENSA_HAVE_COPROCESSORS
	coprocessor_flush_all(ti);
	coprocessor_release_all(ti);
	err |= __copy_to_user(&frame->xtregs.cp, &ti->xtregs_cp,
			      sizeof (frame->xtregs.cp));
161
#endif
162
163
164
165
166
167
	err |= __copy_to_user(&frame->xtregs.opt, &regs->xtregs_opt,
			      sizeof (xtregs_opt_t));
	err |= __copy_to_user(&frame->xtregs.user, &ti->xtregs_user,
			      sizeof (xtregs_user_t));

	err |= __put_user(err ? NULL : &frame->xtregs, &sc->sc_xtregs);
168

169
170
	return err;
}
171
172

static int
173
restore_sigcontext(struct pt_regs *regs, struct rt_sigframe __user *frame)
174
{
175
176
	struct sigcontext __user *sc = &frame->uc.uc_mcontext;
	struct thread_info *ti = current_thread_info();
177
178
179
180
181
182
183
184
185
186
187
	unsigned int err = 0;
	unsigned long ps;

#define COPY(x)	err |= __get_user(regs->x, &sc->sc_##x)
	COPY(pc);
	COPY(lbeg);
	COPY(lend);
	COPY(lcount);
	COPY(sar);
#undef COPY

188
	/* All registers were flushed to stack. Start with a pristine frame. */
189
190
191
192
193

	regs->wmask = 1;
	regs->windowbase = 0;
	regs->windowstart = 1;

194
	regs->syscall = NO_SYSCALL;	/* disable syscall checks */
195

196
197
198
199
200
	/* For PS, restore only PS.CALLINC.
	 * Assume that all other bits are either the same as for the signal
	 * handler, or the user mode value doesn't matter (e.g. PS.OWB).
	 */
	err |= __get_user(ps, &sc->sc_ps);
201
	regs->ps = (regs->ps & ~PS_CALLINC_MASK) | (ps & PS_CALLINC_MASK);
202
203
204
205

	/* Additional corruption checks */

	if ((regs->lcount > 0)
206
	    && ((regs->lbeg > TASK_SIZE) || (regs->lend > TASK_SIZE)) )
207
208
		err = 1;

209
	err |= __copy_from_user(regs->areg, sc->sc_a, 16 * 4);
210

211
212
213
	if (err)
		return err;

214
	/* The signal handler may have used coprocessors in which
215
216
217
218
219
	 * case they are still enabled.  We disable them to force a
	 * reloading of the original task's CP state by the lazy
	 * context-switching mechanisms of CP exception handling.
	 * Also, we essentially discard any coprocessor state that the
	 * signal handler created. */
220

221
222
223
224
#if XTENSA_HAVE_COPROCESSORS
	coprocessor_release_all(ti);
	err |= __copy_from_user(&ti->xtregs_cp, &frame->xtregs.cp,
				sizeof (frame->xtregs.cp));
225
#endif
226
227
228
229
	err |= __copy_from_user(&ti->xtregs_user, &frame->xtregs.user,
				sizeof (xtregs_user_t));
	err |= __copy_from_user(&regs->xtregs_opt, &frame->xtregs.opt,
				sizeof (xtregs_opt_t));
230
231
232
233
234

	return err;
}


235
236
237
/*
 * Do a signal return; undo the signal stack.
 */
238

239
240
asmlinkage long xtensa_rt_sigreturn(long a0, long a1, long a2, long a3,
				    long a4, long a5, struct pt_regs *regs)
241
{
242
	struct rt_sigframe __user *frame;
243
244
	sigset_t set;
	int ret;
245

246
	/* Always make any pending restarted system calls return -EINTR */
247
	current->restart_block.fn = do_no_restart_syscall;
248

249
	if (regs->depc > 64)
250
251
252
		panic("rt_sigreturn in double exception!\n");

	frame = (struct rt_sigframe __user *) regs->areg[1];
253

254
	if (!access_ok(frame, sizeof(*frame)))
255
256
257
258
259
		goto badframe;

	if (__copy_from_user(&set, &frame->uc.uc_sigmask, sizeof(set)))
		goto badframe;

260
	set_current_blocked(&set);
261

262
	if (restore_sigcontext(regs, frame))
263
		goto badframe;
264

265
266
	ret = regs->areg[2];

267
	if (restore_altstack(&frame->uc.uc_stack))
268
269
270
271
272
		goto badframe;

	return ret;

badframe:
273
	force_sig(SIGSEGV);
274
275
276
	return 0;
}

277

278
279

/*
280
 * Set up a signal frame.
281
282
283
 */

static int
284
gen_return_code(unsigned char *codemem)
285
286
287
{
	int err = 0;

288
289
290
291
292
	/*
	 * The 12-bit immediate is really split up within the 24-bit MOVI
	 * instruction.  As long as the above system call numbers fit within
	 * 8-bits, the following code works fine. See the Xtensa ISA for
	 * details.
293
294
	 */

295
296
#if __NR_rt_sigreturn > 255
# error Generating the MOVI instruction below breaks!
297
298
299
#endif

#ifdef __XTENSA_EB__   /* Big Endian version */
300
301
302
303
304
305
306
307
	/* Generate instruction:  MOVI a2, __NR_rt_sigreturn */
	err |= __put_user(0x22, &codemem[0]);
	err |= __put_user(0x0a, &codemem[1]);
	err |= __put_user(__NR_rt_sigreturn, &codemem[2]);
	/* Generate instruction:  SYSCALL */
	err |= __put_user(0x00, &codemem[3]);
	err |= __put_user(0x05, &codemem[4]);
	err |= __put_user(0x00, &codemem[5]);
308
309

#elif defined __XTENSA_EL__   /* Little Endian version */
310
311
312
313
314
315
316
317
	/* Generate instruction:  MOVI a2, __NR_rt_sigreturn */
	err |= __put_user(0x22, &codemem[0]);
	err |= __put_user(0xa0, &codemem[1]);
	err |= __put_user(__NR_rt_sigreturn, &codemem[2]);
	/* Generate instruction:  SYSCALL */
	err |= __put_user(0x00, &codemem[3]);
	err |= __put_user(0x50, &codemem[4]);
	err |= __put_user(0x00, &codemem[5]);
318
#else
319
# error Must use compiler for Xtensa processors.
320
321
322
323
#endif

	/* Flush generated code out of the data cache */

324
325
326
327
	if (err == 0) {
		__invalidate_icache_range((unsigned long)codemem, 6UL);
		__flush_invalidate_dcache_range((unsigned long)codemem, 6UL);
	}
328
329
330
331
332

	return err;
}


333
334
static int setup_frame(struct ksignal *ksig, sigset_t *set,
		       struct pt_regs *regs)
335
{
336
	struct rt_sigframe *frame;
337
	int err = 0, sig = ksig->sig;
338
339
	unsigned long sp, ra, tp, ps;
	unsigned int base;
340

341
	sp = regs->areg[1];
342

343
	if ((ksig->ka.sa.sa_flags & SA_ONSTACK) != 0 && sas_ss_flags(sp) == 0) {
344
		sp = current->sas_ss_sp + current->sas_ss_size;
345
346
	}

347
	frame = (void *)((sp - sizeof(*frame)) & -16ul);
348
349
350
351

	if (regs->depc > 64)
		panic ("Double exception sys_sigreturn\n");

352
	if (!access_ok(frame, sizeof(*frame))) {
353
		return -EFAULT;
354
	}
355

356
357
	if (ksig->ka.sa.sa_flags & SA_SIGINFO) {
		err |= copy_siginfo_to_user(&frame->info, &ksig->info);
358
359
360
	}

	/* Create the user context.  */
361
362
363

	err |= __put_user(0, &frame->uc.uc_flags);
	err |= __put_user(0, &frame->uc.uc_link);
364
	err |= __save_altstack(&frame->uc.uc_stack, regs->areg[1]);
365
	err |= setup_sigcontext(frame, regs);
366
367
	err |= __copy_to_user(&frame->uc.uc_sigmask, set, sizeof(*set));

368
369
	if (ksig->ka.sa.sa_flags & SA_RESTORER) {
		ra = (unsigned long)ksig->ka.sa.sa_restorer;
370
	} else {
371

372
		/* Create sys_rt_sigreturn syscall in stack frame */
373

374
375
376
		err |= gen_return_code(frame->retcode);

		if (err) {
377
			return -EFAULT;
378
379
		}
		ra = (unsigned long) frame->retcode;
380
	}
381

382
383
	/* 
	 * Create signal handler execution context.
384
385
	 * Return context not modified until this point.
	 */
386

Chris Zankel's avatar
Chris Zankel committed
387
388
	/* Set up registers for signal handler; preserve the threadptr */
	tp = regs->threadptr;
389
	ps = regs->ps;
390
	start_thread(regs, (unsigned long) ksig->ka.sa.sa_handler,
391
392
		     (unsigned long) frame);

393
394
395
396
397
398
399
400
401
402
403
404
405
406
	/* Set up a stack frame for a call4 if userspace uses windowed ABI */
	if (ps & PS_WOE_MASK) {
		base = 4;
		regs->areg[base] =
			(((unsigned long) ra) & 0x3fffffff) | 0x40000000;
		ps = (ps & ~(PS_CALLINC_MASK | PS_OWB_MASK)) |
			(1 << PS_CALLINC_SHIFT);
	} else {
		base = 0;
		regs->areg[base] = (unsigned long) ra;
	}
	regs->areg[base + 2] = (unsigned long) sig;
	regs->areg[base + 3] = (unsigned long) &frame->info;
	regs->areg[base + 4] = (unsigned long) &frame->uc;
Chris Zankel's avatar
Chris Zankel committed
407
	regs->threadptr = tp;
408
	regs->ps = ps;
409

410
411
	pr_debug("SIG rt deliver (%s:%d): signal=%d sp=%p pc=%08lx\n",
		 current->comm, current->pid, sig, frame, regs->pc);
412

413
	return 0;
414
415
416
417
418
419
420
421
422
423
424
}

/*
 * Note that 'init' is a special process: it doesn't get signals it doesn't
 * want to handle. Thus you cannot kill init even with a SIGKILL even by
 * mistake.
 *
 * Note that we go through the signals twice: once to check the signals that
 * the kernel can handle, and then we build all the user-level signal handling
 * stack-frames in one go after that.
 */
425
static void do_signal(struct pt_regs *regs)
426
{
427
	struct ksignal ksig;
428

429
430
	task_pt_regs(current)->icountlevel = 0;

431
	if (get_signal(&ksig)) {
432
		int ret;
433
434
435

		/* Are we from a system call? */

436
		if (regs->syscall != NO_SYSCALL) {
437

438
439
440
441
442
			/* If so, check system call restarting.. */

			switch (regs->areg[2]) {
				case -ERESTARTNOHAND:
				case -ERESTART_RESTARTBLOCK:
443
444
					regs->areg[2] = -EINTR;
					break;
445
446

				case -ERESTARTSYS:
447
					if (!(ksig.ka.sa.sa_flags & SA_RESTART)) {
448
449
450
451
452
453
454
455
456
457
458
459
460
461
						regs->areg[2] = -EINTR;
						break;
					}
					/* fallthrough */
				case -ERESTARTNOINTR:
					regs->areg[2] = regs->syscall;
					regs->pc -= 3;
					break;

				default:
					/* nothing to do */
					if (regs->areg[2] != 0)
					break;
			}
462
463
		}

464
465
		/* Whee!  Actually deliver the signal.  */
		/* Set up the stack frame */
466
467
		ret = setup_frame(&ksig, sigmask_to_save(), regs);
		signal_setup_done(ret, &ksig, 0);
468
469
		if (current->ptrace & PT_SINGLESTEP)
			task_pt_regs(current)->icountlevel = 1;
470

471
		return;
472
	}
473

474
	/* Did we come from a system call? */
475
	if (regs->syscall != NO_SYSCALL) {
476
477
478
479
480
481
482
483
484
485
486
487
488
489
		/* Restart the system call - no handlers present */
		switch (regs->areg[2]) {
		case -ERESTARTNOHAND:
		case -ERESTARTSYS:
		case -ERESTARTNOINTR:
			regs->areg[2] = regs->syscall;
			regs->pc -= 3;
			break;
		case -ERESTART_RESTARTBLOCK:
			regs->areg[2] = __NR_restart_syscall;
			regs->pc -= 3;
			break;
		}
	}
490
491

	/* If there's no signal to deliver, we just restore the saved mask.  */
Al Viro's avatar
Al Viro committed
492
	restore_saved_sigmask();
493

494
495
	if (current->ptrace & PT_SINGLESTEP)
		task_pt_regs(current)->icountlevel = 1;
496
	return;
497
}
498

499
500
501
502
503
void do_notify_resume(struct pt_regs *regs)
{
	if (test_thread_flag(TIF_SIGPENDING))
		do_signal(regs);

504
	if (test_and_clear_thread_flag(TIF_NOTIFY_RESUME))
505
506
		tracehook_notify_resume(regs);
}