b9564b8d6bab4bb3132c5aa1f2615208f873cb6e
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / arch / arm64 / kernel / signal32.c
1 /*
2 * Based on arch/arm/kernel/signal.c
3 *
4 * Copyright (C) 1995-2009 Russell King
5 * Copyright (C) 2012 ARM Ltd.
6 * Modified by Will Deacon <will.deacon@arm.com>
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation.
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 <http://www.gnu.org/licenses/>.
19 */
20
21 #include <linux/compat.h>
22 #include <linux/signal.h>
23 #include <linux/syscalls.h>
24 #include <linux/ratelimit.h>
25
26 #include <asm/fpsimd.h>
27 #include <asm/signal32.h>
28 #include <asm/uaccess.h>
29 #include <asm/unistd32.h>
30
31 struct compat_sigcontext {
32 /* We always set these two fields to 0 */
33 compat_ulong_t trap_no;
34 compat_ulong_t error_code;
35
36 compat_ulong_t oldmask;
37 compat_ulong_t arm_r0;
38 compat_ulong_t arm_r1;
39 compat_ulong_t arm_r2;
40 compat_ulong_t arm_r3;
41 compat_ulong_t arm_r4;
42 compat_ulong_t arm_r5;
43 compat_ulong_t arm_r6;
44 compat_ulong_t arm_r7;
45 compat_ulong_t arm_r8;
46 compat_ulong_t arm_r9;
47 compat_ulong_t arm_r10;
48 compat_ulong_t arm_fp;
49 compat_ulong_t arm_ip;
50 compat_ulong_t arm_sp;
51 compat_ulong_t arm_lr;
52 compat_ulong_t arm_pc;
53 compat_ulong_t arm_cpsr;
54 compat_ulong_t fault_address;
55 };
56
57 struct compat_ucontext {
58 compat_ulong_t uc_flags;
59 compat_uptr_t uc_link;
60 compat_stack_t uc_stack;
61 struct compat_sigcontext uc_mcontext;
62 compat_sigset_t uc_sigmask;
63 int __unused[32 - (sizeof (compat_sigset_t) / sizeof (int))];
64 compat_ulong_t uc_regspace[128] __attribute__((__aligned__(8)));
65 };
66
67 struct compat_vfp_sigframe {
68 compat_ulong_t magic;
69 compat_ulong_t size;
70 struct compat_user_vfp {
71 compat_u64 fpregs[32];
72 compat_ulong_t fpscr;
73 } ufp;
74 struct compat_user_vfp_exc {
75 compat_ulong_t fpexc;
76 compat_ulong_t fpinst;
77 compat_ulong_t fpinst2;
78 } ufp_exc;
79 } __attribute__((__aligned__(8)));
80
81 #define VFP_MAGIC 0x56465001
82 #define VFP_STORAGE_SIZE sizeof(struct compat_vfp_sigframe)
83
84 struct compat_aux_sigframe {
85 struct compat_vfp_sigframe vfp;
86
87 /* Something that isn't a valid magic number for any coprocessor. */
88 unsigned long end_magic;
89 } __attribute__((__aligned__(8)));
90
91 struct compat_sigframe {
92 struct compat_ucontext uc;
93 compat_ulong_t retcode[2];
94 };
95
96 struct compat_rt_sigframe {
97 struct compat_siginfo info;
98 struct compat_sigframe sig;
99 };
100
101 #define _BLOCKABLE (~(sigmask(SIGKILL) | sigmask(SIGSTOP)))
102
103 /*
104 * For ARM syscalls, the syscall number has to be loaded into r7.
105 * We do not support an OABI userspace.
106 */
107 #define MOV_R7_NR_SIGRETURN (0xe3a07000 | __NR_compat_sigreturn)
108 #define SVC_SYS_SIGRETURN (0xef000000 | __NR_compat_sigreturn)
109 #define MOV_R7_NR_RT_SIGRETURN (0xe3a07000 | __NR_compat_rt_sigreturn)
110 #define SVC_SYS_RT_SIGRETURN (0xef000000 | __NR_compat_rt_sigreturn)
111
112 /*
113 * For Thumb syscalls, we also pass the syscall number via r7. We therefore
114 * need two 16-bit instructions.
115 */
116 #define SVC_THUMB_SIGRETURN (((0xdf00 | __NR_compat_sigreturn) << 16) | \
117 0x2700 | __NR_compat_sigreturn)
118 #define SVC_THUMB_RT_SIGRETURN (((0xdf00 | __NR_compat_rt_sigreturn) << 16) | \
119 0x2700 | __NR_compat_rt_sigreturn)
120
121 const compat_ulong_t aarch32_sigret_code[6] = {
122 /*
123 * AArch32 sigreturn code.
124 * We don't construct an OABI SWI - instead we just set the imm24 field
125 * to the EABI syscall number so that we create a sane disassembly.
126 */
127 MOV_R7_NR_SIGRETURN, SVC_SYS_SIGRETURN, SVC_THUMB_SIGRETURN,
128 MOV_R7_NR_RT_SIGRETURN, SVC_SYS_RT_SIGRETURN, SVC_THUMB_RT_SIGRETURN,
129 };
130
131 static inline int put_sigset_t(compat_sigset_t __user *uset, sigset_t *set)
132 {
133 compat_sigset_t cset;
134
135 cset.sig[0] = set->sig[0] & 0xffffffffull;
136 cset.sig[1] = set->sig[0] >> 32;
137
138 return copy_to_user(uset, &cset, sizeof(*uset));
139 }
140
141 static inline int get_sigset_t(sigset_t *set,
142 const compat_sigset_t __user *uset)
143 {
144 compat_sigset_t s32;
145
146 if (copy_from_user(&s32, uset, sizeof(*uset)))
147 return -EFAULT;
148
149 set->sig[0] = s32.sig[0] | (((long)s32.sig[1]) << 32);
150 return 0;
151 }
152
153 int copy_siginfo_to_user32(compat_siginfo_t __user *to, siginfo_t *from)
154 {
155 int err;
156
157 if (!access_ok(VERIFY_WRITE, to, sizeof(*to)))
158 return -EFAULT;
159
160 /* If you change siginfo_t structure, please be sure
161 * this code is fixed accordingly.
162 * It should never copy any pad contained in the structure
163 * to avoid security leaks, but must copy the generic
164 * 3 ints plus the relevant union member.
165 * This routine must convert siginfo from 64bit to 32bit as well
166 * at the same time.
167 */
168 err = __put_user(from->si_signo, &to->si_signo);
169 err |= __put_user(from->si_errno, &to->si_errno);
170 err |= __put_user((short)from->si_code, &to->si_code);
171 if (from->si_code < 0)
172 err |= __copy_to_user(&to->_sifields._pad, &from->_sifields._pad,
173 SI_PAD_SIZE);
174 else switch (from->si_code & __SI_MASK) {
175 case __SI_KILL:
176 err |= __put_user(from->si_pid, &to->si_pid);
177 err |= __put_user(from->si_uid, &to->si_uid);
178 break;
179 case __SI_TIMER:
180 err |= __put_user(from->si_tid, &to->si_tid);
181 err |= __put_user(from->si_overrun, &to->si_overrun);
182 err |= __put_user(from->si_int, &to->si_int);
183 break;
184 case __SI_POLL:
185 err |= __put_user(from->si_band, &to->si_band);
186 err |= __put_user(from->si_fd, &to->si_fd);
187 break;
188 case __SI_FAULT:
189 err |= __put_user((compat_uptr_t)(unsigned long)from->si_addr,
190 &to->si_addr);
191 #ifdef BUS_MCEERR_AO
192 /*
193 * Other callers might not initialize the si_lsb field,
194 * so check explicitely for the right codes here.
195 */
196 if (from->si_signo == SIGBUS &&
197 (from->si_code == BUS_MCEERR_AR || from->si_code == BUS_MCEERR_AO))
198 err |= __put_user(from->si_addr_lsb, &to->si_addr_lsb);
199 #endif
200 break;
201 case __SI_CHLD:
202 err |= __put_user(from->si_pid, &to->si_pid);
203 err |= __put_user(from->si_uid, &to->si_uid);
204 err |= __put_user(from->si_status, &to->si_status);
205 err |= __put_user(from->si_utime, &to->si_utime);
206 err |= __put_user(from->si_stime, &to->si_stime);
207 break;
208 case __SI_RT: /* This is not generated by the kernel as of now. */
209 case __SI_MESGQ: /* But this is */
210 err |= __put_user(from->si_pid, &to->si_pid);
211 err |= __put_user(from->si_uid, &to->si_uid);
212 err |= __put_user(from->si_int, &to->si_int);
213 break;
214 default: /* this is just in case for now ... */
215 err |= __put_user(from->si_pid, &to->si_pid);
216 err |= __put_user(from->si_uid, &to->si_uid);
217 break;
218 }
219 return err;
220 }
221
222 int copy_siginfo_from_user32(siginfo_t *to, compat_siginfo_t __user *from)
223 {
224 if (copy_from_user(to, from, __ARCH_SI_PREAMBLE_SIZE) ||
225 copy_from_user(to->_sifields._pad,
226 from->_sifields._pad, SI_PAD_SIZE))
227 return -EFAULT;
228
229 return 0;
230 }
231
232 /*
233 * VFP save/restore code.
234 */
235 static int compat_preserve_vfp_context(struct compat_vfp_sigframe __user *frame)
236 {
237 struct fpsimd_state *fpsimd = &current->thread.fpsimd_state;
238 compat_ulong_t magic = VFP_MAGIC;
239 compat_ulong_t size = VFP_STORAGE_SIZE;
240 compat_ulong_t fpscr, fpexc;
241 int err = 0;
242
243 /*
244 * Save the hardware registers to the fpsimd_state structure.
245 * Note that this also saves V16-31, which aren't visible
246 * in AArch32.
247 */
248 fpsimd_save_state(fpsimd);
249
250 /* Place structure header on the stack */
251 __put_user_error(magic, &frame->magic, err);
252 __put_user_error(size, &frame->size, err);
253
254 /*
255 * Now copy the FP registers. Since the registers are packed,
256 * we can copy the prefix we want (V0-V15) as it is.
257 * FIXME: Won't work if big endian.
258 */
259 err |= __copy_to_user(&frame->ufp.fpregs, fpsimd->vregs,
260 sizeof(frame->ufp.fpregs));
261
262 /* Create an AArch32 fpscr from the fpsr and the fpcr. */
263 fpscr = (fpsimd->fpsr & VFP_FPSCR_STAT_MASK) |
264 (fpsimd->fpcr & VFP_FPSCR_CTRL_MASK);
265 __put_user_error(fpscr, &frame->ufp.fpscr, err);
266
267 /*
268 * The exception register aren't available so we fake up a
269 * basic FPEXC and zero everything else.
270 */
271 fpexc = (1 << 30);
272 __put_user_error(fpexc, &frame->ufp_exc.fpexc, err);
273 __put_user_error(0, &frame->ufp_exc.fpinst, err);
274 __put_user_error(0, &frame->ufp_exc.fpinst2, err);
275
276 return err ? -EFAULT : 0;
277 }
278
279 static int compat_restore_vfp_context(struct compat_vfp_sigframe __user *frame)
280 {
281 struct fpsimd_state fpsimd;
282 compat_ulong_t magic = VFP_MAGIC;
283 compat_ulong_t size = VFP_STORAGE_SIZE;
284 compat_ulong_t fpscr;
285 int err = 0;
286
287 __get_user_error(magic, &frame->magic, err);
288 __get_user_error(size, &frame->size, err);
289
290 if (err)
291 return -EFAULT;
292 if (magic != VFP_MAGIC || size != VFP_STORAGE_SIZE)
293 return -EINVAL;
294
295 /*
296 * Copy the FP registers into the start of the fpsimd_state.
297 * FIXME: Won't work if big endian.
298 */
299 err |= __copy_from_user(fpsimd.vregs, frame->ufp.fpregs,
300 sizeof(frame->ufp.fpregs));
301
302 /* Extract the fpsr and the fpcr from the fpscr */
303 __get_user_error(fpscr, &frame->ufp.fpscr, err);
304 fpsimd.fpsr = fpscr & VFP_FPSCR_STAT_MASK;
305 fpsimd.fpcr = fpscr & VFP_FPSCR_CTRL_MASK;
306
307 /*
308 * We don't need to touch the exception register, so
309 * reload the hardware state.
310 */
311 if (!err) {
312 preempt_disable();
313 fpsimd_load_state(&fpsimd);
314 preempt_enable();
315 }
316
317 return err ? -EFAULT : 0;
318 }
319
320 static int compat_restore_sigframe(struct pt_regs *regs,
321 struct compat_sigframe __user *sf)
322 {
323 int err;
324 sigset_t set;
325 struct compat_aux_sigframe __user *aux;
326
327 err = get_sigset_t(&set, &sf->uc.uc_sigmask);
328 if (err == 0) {
329 sigdelsetmask(&set, ~_BLOCKABLE);
330 set_current_blocked(&set);
331 }
332
333 __get_user_error(regs->regs[0], &sf->uc.uc_mcontext.arm_r0, err);
334 __get_user_error(regs->regs[1], &sf->uc.uc_mcontext.arm_r1, err);
335 __get_user_error(regs->regs[2], &sf->uc.uc_mcontext.arm_r2, err);
336 __get_user_error(regs->regs[3], &sf->uc.uc_mcontext.arm_r3, err);
337 __get_user_error(regs->regs[4], &sf->uc.uc_mcontext.arm_r4, err);
338 __get_user_error(regs->regs[5], &sf->uc.uc_mcontext.arm_r5, err);
339 __get_user_error(regs->regs[6], &sf->uc.uc_mcontext.arm_r6, err);
340 __get_user_error(regs->regs[7], &sf->uc.uc_mcontext.arm_r7, err);
341 __get_user_error(regs->regs[8], &sf->uc.uc_mcontext.arm_r8, err);
342 __get_user_error(regs->regs[9], &sf->uc.uc_mcontext.arm_r9, err);
343 __get_user_error(regs->regs[10], &sf->uc.uc_mcontext.arm_r10, err);
344 __get_user_error(regs->regs[11], &sf->uc.uc_mcontext.arm_fp, err);
345 __get_user_error(regs->regs[12], &sf->uc.uc_mcontext.arm_ip, err);
346 __get_user_error(regs->compat_sp, &sf->uc.uc_mcontext.arm_sp, err);
347 __get_user_error(regs->compat_lr, &sf->uc.uc_mcontext.arm_lr, err);
348 __get_user_error(regs->pc, &sf->uc.uc_mcontext.arm_pc, err);
349 __get_user_error(regs->pstate, &sf->uc.uc_mcontext.arm_cpsr, err);
350
351 /*
352 * Avoid compat_sys_sigreturn() restarting.
353 */
354 regs->syscallno = ~0UL;
355
356 err |= !valid_user_regs(&regs->user_regs);
357
358 aux = (struct compat_aux_sigframe __user *) sf->uc.uc_regspace;
359 if (err == 0)
360 err |= compat_restore_vfp_context(&aux->vfp);
361
362 return err;
363 }
364
365 asmlinkage int compat_sys_sigreturn(struct pt_regs *regs)
366 {
367 struct compat_sigframe __user *frame;
368
369 /* Always make any pending restarted system calls return -EINTR */
370 current_thread_info()->restart_block.fn = do_no_restart_syscall;
371
372 /*
373 * Since we stacked the signal on a 64-bit boundary,
374 * then 'sp' should be word aligned here. If it's
375 * not, then the user is trying to mess with us.
376 */
377 if (regs->compat_sp & 7)
378 goto badframe;
379
380 frame = (struct compat_sigframe __user *)regs->compat_sp;
381
382 if (!access_ok(VERIFY_READ, frame, sizeof (*frame)))
383 goto badframe;
384
385 if (compat_restore_sigframe(regs, frame))
386 goto badframe;
387
388 return regs->regs[0];
389
390 badframe:
391 if (show_unhandled_signals)
392 pr_info_ratelimited("%s[%d]: bad frame in %s: pc=%08llx sp=%08llx\n",
393 current->comm, task_pid_nr(current), __func__,
394 regs->pc, regs->sp);
395 force_sig(SIGSEGV, current);
396 return 0;
397 }
398
399 asmlinkage int compat_sys_rt_sigreturn(struct pt_regs *regs)
400 {
401 struct compat_rt_sigframe __user *frame;
402
403 /* Always make any pending restarted system calls return -EINTR */
404 current_thread_info()->restart_block.fn = do_no_restart_syscall;
405
406 /*
407 * Since we stacked the signal on a 64-bit boundary,
408 * then 'sp' should be word aligned here. If it's
409 * not, then the user is trying to mess with us.
410 */
411 if (regs->compat_sp & 7)
412 goto badframe;
413
414 frame = (struct compat_rt_sigframe __user *)regs->compat_sp;
415
416 if (!access_ok(VERIFY_READ, frame, sizeof (*frame)))
417 goto badframe;
418
419 if (compat_restore_sigframe(regs, &frame->sig))
420 goto badframe;
421
422 if (compat_restore_altstack(&frame->sig.uc.uc_stack))
423 goto badframe;
424
425 return regs->regs[0];
426
427 badframe:
428 if (show_unhandled_signals)
429 pr_info_ratelimited("%s[%d]: bad frame in %s: pc=%08llx sp=%08llx\n",
430 current->comm, task_pid_nr(current), __func__,
431 regs->pc, regs->sp);
432 force_sig(SIGSEGV, current);
433 return 0;
434 }
435
436 static void __user *compat_get_sigframe(struct k_sigaction *ka,
437 struct pt_regs *regs,
438 int framesize)
439 {
440 compat_ulong_t sp = regs->compat_sp;
441 void __user *frame;
442
443 /*
444 * This is the X/Open sanctioned signal stack switching.
445 */
446 if ((ka->sa.sa_flags & SA_ONSTACK) && !sas_ss_flags(sp))
447 sp = current->sas_ss_sp + current->sas_ss_size;
448
449 /*
450 * ATPCS B01 mandates 8-byte alignment
451 */
452 frame = compat_ptr((compat_uptr_t)((sp - framesize) & ~7));
453
454 /*
455 * Check that we can actually write to the signal frame.
456 */
457 if (!access_ok(VERIFY_WRITE, frame, framesize))
458 frame = NULL;
459
460 return frame;
461 }
462
463 static void compat_setup_return(struct pt_regs *regs, struct k_sigaction *ka,
464 compat_ulong_t __user *rc, void __user *frame,
465 int usig)
466 {
467 compat_ulong_t handler = ptr_to_compat(ka->sa.sa_handler);
468 compat_ulong_t retcode;
469 compat_ulong_t spsr = regs->pstate & ~PSR_f;
470 int thumb;
471
472 /* Check if the handler is written for ARM or Thumb */
473 thumb = handler & 1;
474
475 if (thumb) {
476 spsr |= COMPAT_PSR_T_BIT;
477 spsr &= ~COMPAT_PSR_IT_MASK;
478 } else {
479 spsr &= ~COMPAT_PSR_T_BIT;
480 }
481
482 if (ka->sa.sa_flags & SA_RESTORER) {
483 retcode = ptr_to_compat(ka->sa.sa_restorer);
484 } else {
485 /* Set up sigreturn pointer */
486 unsigned int idx = thumb << 1;
487
488 if (ka->sa.sa_flags & SA_SIGINFO)
489 idx += 3;
490
491 retcode = AARCH32_VECTORS_BASE +
492 AARCH32_KERN_SIGRET_CODE_OFFSET +
493 (idx << 2) + thumb;
494 }
495
496 regs->regs[0] = usig;
497 regs->compat_sp = ptr_to_compat(frame);
498 regs->compat_lr = retcode;
499 regs->pc = handler;
500 regs->pstate = spsr;
501 }
502
503 static int compat_setup_sigframe(struct compat_sigframe __user *sf,
504 struct pt_regs *regs, sigset_t *set)
505 {
506 struct compat_aux_sigframe __user *aux;
507 int err = 0;
508
509 __put_user_error(regs->regs[0], &sf->uc.uc_mcontext.arm_r0, err);
510 __put_user_error(regs->regs[1], &sf->uc.uc_mcontext.arm_r1, err);
511 __put_user_error(regs->regs[2], &sf->uc.uc_mcontext.arm_r2, err);
512 __put_user_error(regs->regs[3], &sf->uc.uc_mcontext.arm_r3, err);
513 __put_user_error(regs->regs[4], &sf->uc.uc_mcontext.arm_r4, err);
514 __put_user_error(regs->regs[5], &sf->uc.uc_mcontext.arm_r5, err);
515 __put_user_error(regs->regs[6], &sf->uc.uc_mcontext.arm_r6, err);
516 __put_user_error(regs->regs[7], &sf->uc.uc_mcontext.arm_r7, err);
517 __put_user_error(regs->regs[8], &sf->uc.uc_mcontext.arm_r8, err);
518 __put_user_error(regs->regs[9], &sf->uc.uc_mcontext.arm_r9, err);
519 __put_user_error(regs->regs[10], &sf->uc.uc_mcontext.arm_r10, err);
520 __put_user_error(regs->regs[11], &sf->uc.uc_mcontext.arm_fp, err);
521 __put_user_error(regs->regs[12], &sf->uc.uc_mcontext.arm_ip, err);
522 __put_user_error(regs->compat_sp, &sf->uc.uc_mcontext.arm_sp, err);
523 __put_user_error(regs->compat_lr, &sf->uc.uc_mcontext.arm_lr, err);
524 __put_user_error(regs->pc, &sf->uc.uc_mcontext.arm_pc, err);
525 __put_user_error(regs->pstate, &sf->uc.uc_mcontext.arm_cpsr, err);
526
527 __put_user_error((compat_ulong_t)0, &sf->uc.uc_mcontext.trap_no, err);
528 __put_user_error((compat_ulong_t)0, &sf->uc.uc_mcontext.error_code, err);
529 __put_user_error(current->thread.fault_address, &sf->uc.uc_mcontext.fault_address, err);
530 __put_user_error(set->sig[0], &sf->uc.uc_mcontext.oldmask, err);
531
532 err |= put_sigset_t(&sf->uc.uc_sigmask, set);
533
534 aux = (struct compat_aux_sigframe __user *) sf->uc.uc_regspace;
535
536 if (err == 0)
537 err |= compat_preserve_vfp_context(&aux->vfp);
538 __put_user_error(0, &aux->end_magic, err);
539
540 return err;
541 }
542
543 /*
544 * 32-bit signal handling routines called from signal.c
545 */
546 int compat_setup_rt_frame(int usig, struct k_sigaction *ka, siginfo_t *info,
547 sigset_t *set, struct pt_regs *regs)
548 {
549 struct compat_rt_sigframe __user *frame;
550 int err = 0;
551
552 frame = compat_get_sigframe(ka, regs, sizeof(*frame));
553
554 if (!frame)
555 return 1;
556
557 err |= copy_siginfo_to_user32(&frame->info, info);
558
559 __put_user_error(0, &frame->sig.uc.uc_flags, err);
560 __put_user_error(0, &frame->sig.uc.uc_link, err);
561
562 err |= __compat_save_altstack(&frame->sig.uc.uc_stack, regs->compat_sp);
563
564 err |= compat_setup_sigframe(&frame->sig, regs, set);
565
566 if (err == 0) {
567 compat_setup_return(regs, ka, frame->sig.retcode, frame, usig);
568 regs->regs[1] = (compat_ulong_t)(unsigned long)&frame->info;
569 regs->regs[2] = (compat_ulong_t)(unsigned long)&frame->sig.uc;
570 }
571
572 return err;
573 }
574
575 int compat_setup_frame(int usig, struct k_sigaction *ka, sigset_t *set,
576 struct pt_regs *regs)
577 {
578 struct compat_sigframe __user *frame;
579 int err = 0;
580
581 frame = compat_get_sigframe(ka, regs, sizeof(*frame));
582
583 if (!frame)
584 return 1;
585
586 __put_user_error(0x5ac3c35a, &frame->uc.uc_flags, err);
587
588 err |= compat_setup_sigframe(frame, regs, set);
589 if (err == 0)
590 compat_setup_return(regs, ka, frame->retcode, frame, usig);
591
592 return err;
593 }
594
595 void compat_setup_restart_syscall(struct pt_regs *regs)
596 {
597 regs->regs[7] = __NR_compat_restart_syscall;
598 }