arm64: fpsimd: Split cpu field out from struct fpsimd_state
[linux-2.6-microblaze.git] / arch / arm64 / kernel / signal.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  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License version 2 as
9  * published by the Free Software Foundation.
10  *
11  * This program is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  * GNU General Public License for more details.
15  *
16  * You should have received a copy of the GNU General Public License
17  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
18  */
19
20 #include <linux/compat.h>
21 #include <linux/errno.h>
22 #include <linux/kernel.h>
23 #include <linux/signal.h>
24 #include <linux/personality.h>
25 #include <linux/freezer.h>
26 #include <linux/stddef.h>
27 #include <linux/uaccess.h>
28 #include <linux/sizes.h>
29 #include <linux/string.h>
30 #include <linux/tracehook.h>
31 #include <linux/ratelimit.h>
32 #include <linux/syscalls.h>
33
34 #include <asm/daifflags.h>
35 #include <asm/debug-monitors.h>
36 #include <asm/elf.h>
37 #include <asm/cacheflush.h>
38 #include <asm/ucontext.h>
39 #include <asm/unistd.h>
40 #include <asm/fpsimd.h>
41 #include <asm/ptrace.h>
42 #include <asm/signal32.h>
43 #include <asm/traps.h>
44 #include <asm/vdso.h>
45
46 /*
47  * Do a signal return; undo the signal stack. These are aligned to 128-bit.
48  */
49 struct rt_sigframe {
50         struct siginfo info;
51         struct ucontext uc;
52 };
53
54 struct frame_record {
55         u64 fp;
56         u64 lr;
57 };
58
59 struct rt_sigframe_user_layout {
60         struct rt_sigframe __user *sigframe;
61         struct frame_record __user *next_frame;
62
63         unsigned long size;     /* size of allocated sigframe data */
64         unsigned long limit;    /* largest allowed size */
65
66         unsigned long fpsimd_offset;
67         unsigned long esr_offset;
68         unsigned long sve_offset;
69         unsigned long extra_offset;
70         unsigned long end_offset;
71 };
72
73 #define BASE_SIGFRAME_SIZE round_up(sizeof(struct rt_sigframe), 16)
74 #define TERMINATOR_SIZE round_up(sizeof(struct _aarch64_ctx), 16)
75 #define EXTRA_CONTEXT_SIZE round_up(sizeof(struct extra_context), 16)
76
77 static void init_user_layout(struct rt_sigframe_user_layout *user)
78 {
79         const size_t reserved_size =
80                 sizeof(user->sigframe->uc.uc_mcontext.__reserved);
81
82         memset(user, 0, sizeof(*user));
83         user->size = offsetof(struct rt_sigframe, uc.uc_mcontext.__reserved);
84
85         user->limit = user->size + reserved_size;
86
87         user->limit -= TERMINATOR_SIZE;
88         user->limit -= EXTRA_CONTEXT_SIZE;
89         /* Reserve space for extension and terminator ^ */
90 }
91
92 static size_t sigframe_size(struct rt_sigframe_user_layout const *user)
93 {
94         return round_up(max(user->size, sizeof(struct rt_sigframe)), 16);
95 }
96
97 /*
98  * Sanity limit on the approximate maximum size of signal frame we'll
99  * try to generate.  Stack alignment padding and the frame record are
100  * not taken into account.  This limit is not a guarantee and is
101  * NOT ABI.
102  */
103 #define SIGFRAME_MAXSZ SZ_64K
104
105 static int __sigframe_alloc(struct rt_sigframe_user_layout *user,
106                             unsigned long *offset, size_t size, bool extend)
107 {
108         size_t padded_size = round_up(size, 16);
109
110         if (padded_size > user->limit - user->size &&
111             !user->extra_offset &&
112             extend) {
113                 int ret;
114
115                 user->limit += EXTRA_CONTEXT_SIZE;
116                 ret = __sigframe_alloc(user, &user->extra_offset,
117                                        sizeof(struct extra_context), false);
118                 if (ret) {
119                         user->limit -= EXTRA_CONTEXT_SIZE;
120                         return ret;
121                 }
122
123                 /* Reserve space for the __reserved[] terminator */
124                 user->size += TERMINATOR_SIZE;
125
126                 /*
127                  * Allow expansion up to SIGFRAME_MAXSZ, ensuring space for
128                  * the terminator:
129                  */
130                 user->limit = SIGFRAME_MAXSZ - TERMINATOR_SIZE;
131         }
132
133         /* Still not enough space?  Bad luck! */
134         if (padded_size > user->limit - user->size)
135                 return -ENOMEM;
136
137         *offset = user->size;
138         user->size += padded_size;
139
140         return 0;
141 }
142
143 /*
144  * Allocate space for an optional record of <size> bytes in the user
145  * signal frame.  The offset from the signal frame base address to the
146  * allocated block is assigned to *offset.
147  */
148 static int sigframe_alloc(struct rt_sigframe_user_layout *user,
149                           unsigned long *offset, size_t size)
150 {
151         return __sigframe_alloc(user, offset, size, true);
152 }
153
154 /* Allocate the null terminator record and prevent further allocations */
155 static int sigframe_alloc_end(struct rt_sigframe_user_layout *user)
156 {
157         int ret;
158
159         /* Un-reserve the space reserved for the terminator: */
160         user->limit += TERMINATOR_SIZE;
161
162         ret = sigframe_alloc(user, &user->end_offset,
163                              sizeof(struct _aarch64_ctx));
164         if (ret)
165                 return ret;
166
167         /* Prevent further allocation: */
168         user->limit = user->size;
169         return 0;
170 }
171
172 static void __user *apply_user_offset(
173         struct rt_sigframe_user_layout const *user, unsigned long offset)
174 {
175         char __user *base = (char __user *)user->sigframe;
176
177         return base + offset;
178 }
179
180 static int preserve_fpsimd_context(struct fpsimd_context __user *ctx)
181 {
182         struct user_fpsimd_state const *fpsimd = &current->thread.fpsimd_state;
183         int err;
184
185         /* copy the FP and status/control registers */
186         err = __copy_to_user(ctx->vregs, fpsimd->vregs, sizeof(fpsimd->vregs));
187         __put_user_error(fpsimd->fpsr, &ctx->fpsr, err);
188         __put_user_error(fpsimd->fpcr, &ctx->fpcr, err);
189
190         /* copy the magic/size information */
191         __put_user_error(FPSIMD_MAGIC, &ctx->head.magic, err);
192         __put_user_error(sizeof(struct fpsimd_context), &ctx->head.size, err);
193
194         return err ? -EFAULT : 0;
195 }
196
197 static int restore_fpsimd_context(struct fpsimd_context __user *ctx)
198 {
199         struct user_fpsimd_state fpsimd;
200         __u32 magic, size;
201         int err = 0;
202
203         /* check the magic/size information */
204         __get_user_error(magic, &ctx->head.magic, err);
205         __get_user_error(size, &ctx->head.size, err);
206         if (err)
207                 return -EFAULT;
208         if (magic != FPSIMD_MAGIC || size != sizeof(struct fpsimd_context))
209                 return -EINVAL;
210
211         /* copy the FP and status/control registers */
212         err = __copy_from_user(fpsimd.vregs, ctx->vregs,
213                                sizeof(fpsimd.vregs));
214         __get_user_error(fpsimd.fpsr, &ctx->fpsr, err);
215         __get_user_error(fpsimd.fpcr, &ctx->fpcr, err);
216
217         clear_thread_flag(TIF_SVE);
218
219         /* load the hardware registers from the fpsimd_state structure */
220         if (!err)
221                 fpsimd_update_current_state(&fpsimd);
222
223         return err ? -EFAULT : 0;
224 }
225
226
227 struct user_ctxs {
228         struct fpsimd_context __user *fpsimd;
229         struct sve_context __user *sve;
230 };
231
232 #ifdef CONFIG_ARM64_SVE
233
234 static int preserve_sve_context(struct sve_context __user *ctx)
235 {
236         int err = 0;
237         u16 reserved[ARRAY_SIZE(ctx->__reserved)];
238         unsigned int vl = current->thread.sve_vl;
239         unsigned int vq = 0;
240
241         if (test_thread_flag(TIF_SVE))
242                 vq = sve_vq_from_vl(vl);
243
244         memset(reserved, 0, sizeof(reserved));
245
246         __put_user_error(SVE_MAGIC, &ctx->head.magic, err);
247         __put_user_error(round_up(SVE_SIG_CONTEXT_SIZE(vq), 16),
248                          &ctx->head.size, err);
249         __put_user_error(vl, &ctx->vl, err);
250         BUILD_BUG_ON(sizeof(ctx->__reserved) != sizeof(reserved));
251         err |= __copy_to_user(&ctx->__reserved, reserved, sizeof(reserved));
252
253         if (vq) {
254                 /*
255                  * This assumes that the SVE state has already been saved to
256                  * the task struct by calling preserve_fpsimd_context().
257                  */
258                 err |= __copy_to_user((char __user *)ctx + SVE_SIG_REGS_OFFSET,
259                                       current->thread.sve_state,
260                                       SVE_SIG_REGS_SIZE(vq));
261         }
262
263         return err ? -EFAULT : 0;
264 }
265
266 static int restore_sve_fpsimd_context(struct user_ctxs *user)
267 {
268         int err;
269         unsigned int vq;
270         struct user_fpsimd_state fpsimd;
271         struct sve_context sve;
272
273         if (__copy_from_user(&sve, user->sve, sizeof(sve)))
274                 return -EFAULT;
275
276         if (sve.vl != current->thread.sve_vl)
277                 return -EINVAL;
278
279         if (sve.head.size <= sizeof(*user->sve)) {
280                 clear_thread_flag(TIF_SVE);
281                 goto fpsimd_only;
282         }
283
284         vq = sve_vq_from_vl(sve.vl);
285
286         if (sve.head.size < SVE_SIG_CONTEXT_SIZE(vq))
287                 return -EINVAL;
288
289         /*
290          * Careful: we are about __copy_from_user() directly into
291          * thread.sve_state with preemption enabled, so protection is
292          * needed to prevent a racing context switch from writing stale
293          * registers back over the new data.
294          */
295
296         fpsimd_flush_task_state(current);
297         barrier();
298         /* From now, fpsimd_thread_switch() won't clear TIF_FOREIGN_FPSTATE */
299
300         set_thread_flag(TIF_FOREIGN_FPSTATE);
301         barrier();
302         /* From now, fpsimd_thread_switch() won't touch thread.sve_state */
303
304         sve_alloc(current);
305         err = __copy_from_user(current->thread.sve_state,
306                                (char __user const *)user->sve +
307                                         SVE_SIG_REGS_OFFSET,
308                                SVE_SIG_REGS_SIZE(vq));
309         if (err)
310                 return -EFAULT;
311
312         set_thread_flag(TIF_SVE);
313
314 fpsimd_only:
315         /* copy the FP and status/control registers */
316         /* restore_sigframe() already checked that user->fpsimd != NULL. */
317         err = __copy_from_user(fpsimd.vregs, user->fpsimd->vregs,
318                                sizeof(fpsimd.vregs));
319         __get_user_error(fpsimd.fpsr, &user->fpsimd->fpsr, err);
320         __get_user_error(fpsimd.fpcr, &user->fpsimd->fpcr, err);
321
322         /* load the hardware registers from the fpsimd_state structure */
323         if (!err)
324                 fpsimd_update_current_state(&fpsimd);
325
326         return err ? -EFAULT : 0;
327 }
328
329 #else /* ! CONFIG_ARM64_SVE */
330
331 /* Turn any non-optimised out attempts to use these into a link error: */
332 extern int preserve_sve_context(void __user *ctx);
333 extern int restore_sve_fpsimd_context(struct user_ctxs *user);
334
335 #endif /* ! CONFIG_ARM64_SVE */
336
337
338 static int parse_user_sigframe(struct user_ctxs *user,
339                                struct rt_sigframe __user *sf)
340 {
341         struct sigcontext __user *const sc = &sf->uc.uc_mcontext;
342         struct _aarch64_ctx __user *head;
343         char __user *base = (char __user *)&sc->__reserved;
344         size_t offset = 0;
345         size_t limit = sizeof(sc->__reserved);
346         bool have_extra_context = false;
347         char const __user *const sfp = (char const __user *)sf;
348
349         user->fpsimd = NULL;
350         user->sve = NULL;
351
352         if (!IS_ALIGNED((unsigned long)base, 16))
353                 goto invalid;
354
355         while (1) {
356                 int err = 0;
357                 u32 magic, size;
358                 char const __user *userp;
359                 struct extra_context const __user *extra;
360                 u64 extra_datap;
361                 u32 extra_size;
362                 struct _aarch64_ctx const __user *end;
363                 u32 end_magic, end_size;
364
365                 if (limit - offset < sizeof(*head))
366                         goto invalid;
367
368                 if (!IS_ALIGNED(offset, 16))
369                         goto invalid;
370
371                 head = (struct _aarch64_ctx __user *)(base + offset);
372                 __get_user_error(magic, &head->magic, err);
373                 __get_user_error(size, &head->size, err);
374                 if (err)
375                         return err;
376
377                 if (limit - offset < size)
378                         goto invalid;
379
380                 switch (magic) {
381                 case 0:
382                         if (size)
383                                 goto invalid;
384
385                         goto done;
386
387                 case FPSIMD_MAGIC:
388                         if (user->fpsimd)
389                                 goto invalid;
390
391                         if (size < sizeof(*user->fpsimd))
392                                 goto invalid;
393
394                         user->fpsimd = (struct fpsimd_context __user *)head;
395                         break;
396
397                 case ESR_MAGIC:
398                         /* ignore */
399                         break;
400
401                 case SVE_MAGIC:
402                         if (!system_supports_sve())
403                                 goto invalid;
404
405                         if (user->sve)
406                                 goto invalid;
407
408                         if (size < sizeof(*user->sve))
409                                 goto invalid;
410
411                         user->sve = (struct sve_context __user *)head;
412                         break;
413
414                 case EXTRA_MAGIC:
415                         if (have_extra_context)
416                                 goto invalid;
417
418                         if (size < sizeof(*extra))
419                                 goto invalid;
420
421                         userp = (char const __user *)head;
422
423                         extra = (struct extra_context const __user *)userp;
424                         userp += size;
425
426                         __get_user_error(extra_datap, &extra->datap, err);
427                         __get_user_error(extra_size, &extra->size, err);
428                         if (err)
429                                 return err;
430
431                         /* Check for the dummy terminator in __reserved[]: */
432
433                         if (limit - offset - size < TERMINATOR_SIZE)
434                                 goto invalid;
435
436                         end = (struct _aarch64_ctx const __user *)userp;
437                         userp += TERMINATOR_SIZE;
438
439                         __get_user_error(end_magic, &end->magic, err);
440                         __get_user_error(end_size, &end->size, err);
441                         if (err)
442                                 return err;
443
444                         if (end_magic || end_size)
445                                 goto invalid;
446
447                         /* Prevent looping/repeated parsing of extra_context */
448                         have_extra_context = true;
449
450                         base = (__force void __user *)extra_datap;
451                         if (!IS_ALIGNED((unsigned long)base, 16))
452                                 goto invalid;
453
454                         if (!IS_ALIGNED(extra_size, 16))
455                                 goto invalid;
456
457                         if (base != userp)
458                                 goto invalid;
459
460                         /* Reject "unreasonably large" frames: */
461                         if (extra_size > sfp + SIGFRAME_MAXSZ - userp)
462                                 goto invalid;
463
464                         /*
465                          * Ignore trailing terminator in __reserved[]
466                          * and start parsing extra data:
467                          */
468                         offset = 0;
469                         limit = extra_size;
470
471                         if (!access_ok(VERIFY_READ, base, limit))
472                                 goto invalid;
473
474                         continue;
475
476                 default:
477                         goto invalid;
478                 }
479
480                 if (size < sizeof(*head))
481                         goto invalid;
482
483                 if (limit - offset < size)
484                         goto invalid;
485
486                 offset += size;
487         }
488
489 done:
490         return 0;
491
492 invalid:
493         return -EINVAL;
494 }
495
496 static int restore_sigframe(struct pt_regs *regs,
497                             struct rt_sigframe __user *sf)
498 {
499         sigset_t set;
500         int i, err;
501         struct user_ctxs user;
502
503         err = __copy_from_user(&set, &sf->uc.uc_sigmask, sizeof(set));
504         if (err == 0)
505                 set_current_blocked(&set);
506
507         for (i = 0; i < 31; i++)
508                 __get_user_error(regs->regs[i], &sf->uc.uc_mcontext.regs[i],
509                                  err);
510         __get_user_error(regs->sp, &sf->uc.uc_mcontext.sp, err);
511         __get_user_error(regs->pc, &sf->uc.uc_mcontext.pc, err);
512         __get_user_error(regs->pstate, &sf->uc.uc_mcontext.pstate, err);
513
514         /*
515          * Avoid sys_rt_sigreturn() restarting.
516          */
517         forget_syscall(regs);
518
519         err |= !valid_user_regs(&regs->user_regs, current);
520         if (err == 0)
521                 err = parse_user_sigframe(&user, sf);
522
523         if (err == 0) {
524                 if (!user.fpsimd)
525                         return -EINVAL;
526
527                 if (user.sve) {
528                         if (!system_supports_sve())
529                                 return -EINVAL;
530
531                         err = restore_sve_fpsimd_context(&user);
532                 } else {
533                         err = restore_fpsimd_context(user.fpsimd);
534                 }
535         }
536
537         return err;
538 }
539
540 asmlinkage long sys_rt_sigreturn(struct pt_regs *regs)
541 {
542         struct rt_sigframe __user *frame;
543
544         /* Always make any pending restarted system calls return -EINTR */
545         current->restart_block.fn = do_no_restart_syscall;
546
547         /*
548          * Since we stacked the signal on a 128-bit boundary, then 'sp' should
549          * be word aligned here.
550          */
551         if (regs->sp & 15)
552                 goto badframe;
553
554         frame = (struct rt_sigframe __user *)regs->sp;
555
556         if (!access_ok(VERIFY_READ, frame, sizeof (*frame)))
557                 goto badframe;
558
559         if (restore_sigframe(regs, frame))
560                 goto badframe;
561
562         if (restore_altstack(&frame->uc.uc_stack))
563                 goto badframe;
564
565         return regs->regs[0];
566
567 badframe:
568         arm64_notify_segfault(regs->sp);
569         return 0;
570 }
571
572 /* Determine the layout of optional records in the signal frame */
573 static int setup_sigframe_layout(struct rt_sigframe_user_layout *user)
574 {
575         int err;
576
577         err = sigframe_alloc(user, &user->fpsimd_offset,
578                              sizeof(struct fpsimd_context));
579         if (err)
580                 return err;
581
582         /* fault information, if valid */
583         if (current->thread.fault_code) {
584                 err = sigframe_alloc(user, &user->esr_offset,
585                                      sizeof(struct esr_context));
586                 if (err)
587                         return err;
588         }
589
590         if (system_supports_sve()) {
591                 unsigned int vq = 0;
592
593                 if (test_thread_flag(TIF_SVE))
594                         vq = sve_vq_from_vl(current->thread.sve_vl);
595
596                 err = sigframe_alloc(user, &user->sve_offset,
597                                      SVE_SIG_CONTEXT_SIZE(vq));
598                 if (err)
599                         return err;
600         }
601
602         return sigframe_alloc_end(user);
603 }
604
605
606 static int setup_sigframe(struct rt_sigframe_user_layout *user,
607                           struct pt_regs *regs, sigset_t *set)
608 {
609         int i, err = 0;
610         struct rt_sigframe __user *sf = user->sigframe;
611
612         /* set up the stack frame for unwinding */
613         __put_user_error(regs->regs[29], &user->next_frame->fp, err);
614         __put_user_error(regs->regs[30], &user->next_frame->lr, err);
615
616         for (i = 0; i < 31; i++)
617                 __put_user_error(regs->regs[i], &sf->uc.uc_mcontext.regs[i],
618                                  err);
619         __put_user_error(regs->sp, &sf->uc.uc_mcontext.sp, err);
620         __put_user_error(regs->pc, &sf->uc.uc_mcontext.pc, err);
621         __put_user_error(regs->pstate, &sf->uc.uc_mcontext.pstate, err);
622
623         __put_user_error(current->thread.fault_address, &sf->uc.uc_mcontext.fault_address, err);
624
625         err |= __copy_to_user(&sf->uc.uc_sigmask, set, sizeof(*set));
626
627         if (err == 0) {
628                 struct fpsimd_context __user *fpsimd_ctx =
629                         apply_user_offset(user, user->fpsimd_offset);
630                 err |= preserve_fpsimd_context(fpsimd_ctx);
631         }
632
633         /* fault information, if valid */
634         if (err == 0 && user->esr_offset) {
635                 struct esr_context __user *esr_ctx =
636                         apply_user_offset(user, user->esr_offset);
637
638                 __put_user_error(ESR_MAGIC, &esr_ctx->head.magic, err);
639                 __put_user_error(sizeof(*esr_ctx), &esr_ctx->head.size, err);
640                 __put_user_error(current->thread.fault_code, &esr_ctx->esr, err);
641         }
642
643         /* Scalable Vector Extension state, if present */
644         if (system_supports_sve() && err == 0 && user->sve_offset) {
645                 struct sve_context __user *sve_ctx =
646                         apply_user_offset(user, user->sve_offset);
647                 err |= preserve_sve_context(sve_ctx);
648         }
649
650         if (err == 0 && user->extra_offset) {
651                 char __user *sfp = (char __user *)user->sigframe;
652                 char __user *userp =
653                         apply_user_offset(user, user->extra_offset);
654
655                 struct extra_context __user *extra;
656                 struct _aarch64_ctx __user *end;
657                 u64 extra_datap;
658                 u32 extra_size;
659
660                 extra = (struct extra_context __user *)userp;
661                 userp += EXTRA_CONTEXT_SIZE;
662
663                 end = (struct _aarch64_ctx __user *)userp;
664                 userp += TERMINATOR_SIZE;
665
666                 /*
667                  * extra_datap is just written to the signal frame.
668                  * The value gets cast back to a void __user *
669                  * during sigreturn.
670                  */
671                 extra_datap = (__force u64)userp;
672                 extra_size = sfp + round_up(user->size, 16) - userp;
673
674                 __put_user_error(EXTRA_MAGIC, &extra->head.magic, err);
675                 __put_user_error(EXTRA_CONTEXT_SIZE, &extra->head.size, err);
676                 __put_user_error(extra_datap, &extra->datap, err);
677                 __put_user_error(extra_size, &extra->size, err);
678
679                 /* Add the terminator */
680                 __put_user_error(0, &end->magic, err);
681                 __put_user_error(0, &end->size, err);
682         }
683
684         /* set the "end" magic */
685         if (err == 0) {
686                 struct _aarch64_ctx __user *end =
687                         apply_user_offset(user, user->end_offset);
688
689                 __put_user_error(0, &end->magic, err);
690                 __put_user_error(0, &end->size, err);
691         }
692
693         return err;
694 }
695
696 static int get_sigframe(struct rt_sigframe_user_layout *user,
697                          struct ksignal *ksig, struct pt_regs *regs)
698 {
699         unsigned long sp, sp_top;
700         int err;
701
702         init_user_layout(user);
703         err = setup_sigframe_layout(user);
704         if (err)
705                 return err;
706
707         sp = sp_top = sigsp(regs->sp, ksig);
708
709         sp = round_down(sp - sizeof(struct frame_record), 16);
710         user->next_frame = (struct frame_record __user *)sp;
711
712         sp = round_down(sp, 16) - sigframe_size(user);
713         user->sigframe = (struct rt_sigframe __user *)sp;
714
715         /*
716          * Check that we can actually write to the signal frame.
717          */
718         if (!access_ok(VERIFY_WRITE, user->sigframe, sp_top - sp))
719                 return -EFAULT;
720
721         return 0;
722 }
723
724 static void setup_return(struct pt_regs *regs, struct k_sigaction *ka,
725                          struct rt_sigframe_user_layout *user, int usig)
726 {
727         __sigrestore_t sigtramp;
728
729         regs->regs[0] = usig;
730         regs->sp = (unsigned long)user->sigframe;
731         regs->regs[29] = (unsigned long)&user->next_frame->fp;
732         regs->pc = (unsigned long)ka->sa.sa_handler;
733
734         if (ka->sa.sa_flags & SA_RESTORER)
735                 sigtramp = ka->sa.sa_restorer;
736         else
737                 sigtramp = VDSO_SYMBOL(current->mm->context.vdso, sigtramp);
738
739         regs->regs[30] = (unsigned long)sigtramp;
740 }
741
742 static int setup_rt_frame(int usig, struct ksignal *ksig, sigset_t *set,
743                           struct pt_regs *regs)
744 {
745         struct rt_sigframe_user_layout user;
746         struct rt_sigframe __user *frame;
747         int err = 0;
748
749         fpsimd_signal_preserve_current_state();
750
751         if (get_sigframe(&user, ksig, regs))
752                 return 1;
753
754         frame = user.sigframe;
755
756         __put_user_error(0, &frame->uc.uc_flags, err);
757         __put_user_error(NULL, &frame->uc.uc_link, err);
758
759         err |= __save_altstack(&frame->uc.uc_stack, regs->sp);
760         err |= setup_sigframe(&user, regs, set);
761         if (err == 0) {
762                 setup_return(regs, &ksig->ka, &user, usig);
763                 if (ksig->ka.sa.sa_flags & SA_SIGINFO) {
764                         err |= copy_siginfo_to_user(&frame->info, &ksig->info);
765                         regs->regs[1] = (unsigned long)&frame->info;
766                         regs->regs[2] = (unsigned long)&frame->uc;
767                 }
768         }
769
770         return err;
771 }
772
773 static void setup_restart_syscall(struct pt_regs *regs)
774 {
775         if (is_compat_task())
776                 compat_setup_restart_syscall(regs);
777         else
778                 regs->regs[8] = __NR_restart_syscall;
779 }
780
781 /*
782  * OK, we're invoking a handler
783  */
784 static void handle_signal(struct ksignal *ksig, struct pt_regs *regs)
785 {
786         struct task_struct *tsk = current;
787         sigset_t *oldset = sigmask_to_save();
788         int usig = ksig->sig;
789         int ret;
790
791         /*
792          * Set up the stack frame
793          */
794         if (is_compat_task()) {
795                 if (ksig->ka.sa.sa_flags & SA_SIGINFO)
796                         ret = compat_setup_rt_frame(usig, ksig, oldset, regs);
797                 else
798                         ret = compat_setup_frame(usig, ksig, oldset, regs);
799         } else {
800                 ret = setup_rt_frame(usig, ksig, oldset, regs);
801         }
802
803         /*
804          * Check that the resulting registers are actually sane.
805          */
806         ret |= !valid_user_regs(&regs->user_regs, current);
807
808         /*
809          * Fast forward the stepping logic so we step into the signal
810          * handler.
811          */
812         if (!ret)
813                 user_fastforward_single_step(tsk);
814
815         signal_setup_done(ret, ksig, 0);
816 }
817
818 /*
819  * Note that 'init' is a special process: it doesn't get signals it doesn't
820  * want to handle. Thus you cannot kill init even with a SIGKILL even by
821  * mistake.
822  *
823  * Note that we go through the signals twice: once to check the signals that
824  * the kernel can handle, and then we build all the user-level signal handling
825  * stack-frames in one go after that.
826  */
827 static void do_signal(struct pt_regs *regs)
828 {
829         unsigned long continue_addr = 0, restart_addr = 0;
830         int retval = 0;
831         struct ksignal ksig;
832
833         /*
834          * If we were from a system call, check for system call restarting...
835          */
836         if (in_syscall(regs)) {
837                 continue_addr = regs->pc;
838                 restart_addr = continue_addr - (compat_thumb_mode(regs) ? 2 : 4);
839                 retval = regs->regs[0];
840
841                 /*
842                  * Avoid additional syscall restarting via ret_to_user.
843                  */
844                 forget_syscall(regs);
845
846                 /*
847                  * Prepare for system call restart. We do this here so that a
848                  * debugger will see the already changed PC.
849                  */
850                 switch (retval) {
851                 case -ERESTARTNOHAND:
852                 case -ERESTARTSYS:
853                 case -ERESTARTNOINTR:
854                 case -ERESTART_RESTARTBLOCK:
855                         regs->regs[0] = regs->orig_x0;
856                         regs->pc = restart_addr;
857                         break;
858                 }
859         }
860
861         /*
862          * Get the signal to deliver. When running under ptrace, at this point
863          * the debugger may change all of our registers.
864          */
865         if (get_signal(&ksig)) {
866                 /*
867                  * Depending on the signal settings, we may need to revert the
868                  * decision to restart the system call, but skip this if a
869                  * debugger has chosen to restart at a different PC.
870                  */
871                 if (regs->pc == restart_addr &&
872                     (retval == -ERESTARTNOHAND ||
873                      retval == -ERESTART_RESTARTBLOCK ||
874                      (retval == -ERESTARTSYS &&
875                       !(ksig.ka.sa.sa_flags & SA_RESTART)))) {
876                         regs->regs[0] = -EINTR;
877                         regs->pc = continue_addr;
878                 }
879
880                 handle_signal(&ksig, regs);
881                 return;
882         }
883
884         /*
885          * Handle restarting a different system call. As above, if a debugger
886          * has chosen to restart at a different PC, ignore the restart.
887          */
888         if (in_syscall(regs) && regs->pc == restart_addr) {
889                 if (retval == -ERESTART_RESTARTBLOCK)
890                         setup_restart_syscall(regs);
891                 user_rewind_single_step(current);
892         }
893
894         restore_saved_sigmask();
895 }
896
897 asmlinkage void do_notify_resume(struct pt_regs *regs,
898                                  unsigned int thread_flags)
899 {
900         /*
901          * The assembly code enters us with IRQs off, but it hasn't
902          * informed the tracing code of that for efficiency reasons.
903          * Update the trace code with the current status.
904          */
905         trace_hardirqs_off();
906
907         do {
908                 /* Check valid user FS if needed */
909                 addr_limit_user_check();
910
911                 if (thread_flags & _TIF_NEED_RESCHED) {
912                         /* Unmask Debug and SError for the next task */
913                         local_daif_restore(DAIF_PROCCTX_NOIRQ);
914
915                         schedule();
916                 } else {
917                         local_daif_restore(DAIF_PROCCTX);
918
919                         if (thread_flags & _TIF_UPROBE)
920                                 uprobe_notify_resume(regs);
921
922                         if (thread_flags & _TIF_SIGPENDING)
923                                 do_signal(regs);
924
925                         if (thread_flags & _TIF_NOTIFY_RESUME) {
926                                 clear_thread_flag(TIF_NOTIFY_RESUME);
927                                 tracehook_notify_resume(regs);
928                         }
929
930                         if (thread_flags & _TIF_FOREIGN_FPSTATE)
931                                 fpsimd_restore_current_state();
932                 }
933
934                 local_daif_mask();
935                 thread_flags = READ_ONCE(current_thread_info()->flags);
936         } while (thread_flags & _TIF_WORK_MASK);
937 }