1
2
3
4
5
6
7
8
9
10
11
12
13
14#include <linux/sched.h>
15#include <linux/mm.h>
16#include <linux/smp.h>
17#include <linux/kernel.h>
18#include <linux/signal.h>
19#include <linux/errno.h>
20#include <linux/wait.h>
21#include <linux/ptrace.h>
22#include <linux/unistd.h>
23#include <linux/stddef.h>
24#include <linux/tracehook.h>
25
26#include <asm/processor.h>
27#include <asm/syscall.h>
28#include <asm/ucontext.h>
29#include <linux/uaccess.h>
30
31#define DEBUG_SIG 0
32
33struct rt_sigframe {
34 struct siginfo info;
35 struct ucontext uc;
36 unsigned char retcode[16];
37};
38
39static int restore_sigcontext(struct pt_regs *regs,
40 struct sigcontext __user *sc)
41{
42 int err = 0;
43
44
45 current->restart_block.fn = do_no_restart_syscall;
46
47
48
49
50
51
52 err |= __copy_from_user(regs, sc->regs.gpr, 32 * sizeof(unsigned long));
53 err |= __copy_from_user(®s->pc, &sc->regs.pc, sizeof(unsigned long));
54 err |= __copy_from_user(®s->sr, &sc->regs.sr, sizeof(unsigned long));
55
56
57 regs->sr &= ~SPR_SR_SM;
58
59 regs->orig_gpr11 = -1;
60
61
62
63
64
65
66 return err;
67}
68
69asmlinkage long _sys_rt_sigreturn(struct pt_regs *regs)
70{
71 struct rt_sigframe __user *frame = (struct rt_sigframe __user *)regs->sp;
72 sigset_t set;
73
74
75
76
77
78
79 if (((unsigned long)frame) & 3)
80 goto badframe;
81
82 if (!access_ok(frame, sizeof(*frame)))
83 goto badframe;
84 if (__copy_from_user(&set, &frame->uc.uc_sigmask, sizeof(set)))
85 goto badframe;
86
87 set_current_blocked(&set);
88
89 if (restore_sigcontext(regs, &frame->uc.uc_mcontext))
90 goto badframe;
91
92 if (restore_altstack(&frame->uc.uc_stack))
93 goto badframe;
94
95 return regs->gpr[11];
96
97badframe:
98 force_sig(SIGSEGV);
99 return 0;
100}
101
102
103
104
105
106static int setup_sigcontext(struct pt_regs *regs, struct sigcontext __user *sc)
107{
108 int err = 0;
109
110
111
112
113
114 err |= __copy_to_user(sc->regs.gpr, regs, 32 * sizeof(unsigned long));
115 err |= __copy_to_user(&sc->regs.pc, ®s->pc, sizeof(unsigned long));
116 err |= __copy_to_user(&sc->regs.sr, ®s->sr, sizeof(unsigned long));
117
118 return err;
119}
120
121static inline unsigned long align_sigframe(unsigned long sp)
122{
123 return sp & ~3UL;
124}
125
126
127
128
129
130
131static inline void __user *get_sigframe(struct ksignal *ksig,
132 struct pt_regs *regs, size_t frame_size)
133{
134 unsigned long sp = regs->sp;
135
136
137 sp -= STACK_FRAME_OVERHEAD;
138 sp = sigsp(sp, ksig);
139 sp = align_sigframe(sp - frame_size);
140
141 return (void __user *)sp;
142}
143
144
145
146
147
148
149
150
151static int setup_rt_frame(struct ksignal *ksig, sigset_t *set,
152 struct pt_regs *regs)
153{
154 struct rt_sigframe __user *frame;
155 unsigned long return_ip;
156 int err = 0;
157
158 frame = get_sigframe(ksig, regs, sizeof(*frame));
159
160 if (!access_ok(frame, sizeof(*frame)))
161 return -EFAULT;
162
163
164 if (ksig->ka.sa.sa_flags & SA_SIGINFO)
165 err |= copy_siginfo_to_user(&frame->info, &ksig->info);
166
167
168 err |= __put_user(0, &frame->uc.uc_flags);
169 err |= __put_user(NULL, &frame->uc.uc_link);
170 err |= __save_altstack(&frame->uc.uc_stack, regs->sp);
171 err |= setup_sigcontext(regs, &frame->uc.uc_mcontext);
172
173 err |= __copy_to_user(&frame->uc.uc_sigmask, set, sizeof(*set));
174
175 if (err)
176 return -EFAULT;
177
178
179 return_ip = (unsigned long)&frame->retcode;
180
181
182
183
184 err |= __put_user(0xa960, (short __user *)(frame->retcode + 0));
185 err |= __put_user(__NR_rt_sigreturn, (short __user *)(frame->retcode + 2));
186 err |= __put_user(0x20000001, (unsigned long __user *)(frame->retcode + 4));
187 err |= __put_user(0x15000000, (unsigned long __user *)(frame->retcode + 8));
188
189 if (err)
190 return -EFAULT;
191
192
193 regs->pc = (unsigned long)ksig->ka.sa.sa_handler;
194 regs->gpr[9] = (unsigned long)return_ip;
195 regs->gpr[3] = (unsigned long)ksig->sig;
196 regs->gpr[4] = (unsigned long)&frame->info;
197 regs->gpr[5] = (unsigned long)&frame->uc;
198
199
200 regs->sp = (unsigned long)frame;
201
202 return 0;
203}
204
205static inline void
206handle_signal(struct ksignal *ksig, struct pt_regs *regs)
207{
208 int ret;
209
210 ret = setup_rt_frame(ksig, sigmask_to_save(), regs);
211
212 signal_setup_done(ret, ksig, test_thread_flag(TIF_SINGLESTEP));
213}
214
215
216
217
218
219
220
221
222
223
224
225
226
227int do_signal(struct pt_regs *regs, int syscall)
228{
229 struct ksignal ksig;
230 unsigned long continue_addr = 0;
231 unsigned long restart_addr = 0;
232 unsigned long retval = 0;
233 int restart = 0;
234
235 if (syscall) {
236 continue_addr = regs->pc;
237 restart_addr = continue_addr - 4;
238 retval = regs->gpr[11];
239
240
241
242
243
244 switch (retval) {
245 case -ERESTART_RESTARTBLOCK:
246 restart = -2;
247 fallthrough;
248 case -ERESTARTNOHAND:
249 case -ERESTARTSYS:
250 case -ERESTARTNOINTR:
251 restart++;
252 regs->gpr[11] = regs->orig_gpr11;
253 regs->pc = restart_addr;
254 break;
255 }
256 }
257
258
259
260
261
262
263
264 if (get_signal(&ksig)) {
265 if (unlikely(restart) && regs->pc == restart_addr) {
266 if (retval == -ERESTARTNOHAND ||
267 retval == -ERESTART_RESTARTBLOCK
268 || (retval == -ERESTARTSYS
269 && !(ksig.ka.sa.sa_flags & SA_RESTART))) {
270
271 regs->gpr[11] = -EINTR;
272 regs->pc = continue_addr;
273 }
274 }
275 handle_signal(&ksig, regs);
276 } else {
277
278 restore_saved_sigmask();
279
280
281
282
283 if (unlikely(restart) && regs->pc == restart_addr) {
284 regs->pc = continue_addr;
285 return restart;
286 }
287 }
288
289 return 0;
290}
291
292asmlinkage int
293do_work_pending(struct pt_regs *regs, unsigned int thread_flags, int syscall)
294{
295 do {
296 if (likely(thread_flags & _TIF_NEED_RESCHED)) {
297 schedule();
298 } else {
299 if (unlikely(!user_mode(regs)))
300 return 0;
301 local_irq_enable();
302 if (thread_flags & (_TIF_SIGPENDING|_TIF_NOTIFY_SIGNAL)) {
303 int restart = do_signal(regs, syscall);
304 if (unlikely(restart)) {
305
306
307
308
309
310 return restart;
311 }
312 syscall = 0;
313 } else {
314 tracehook_notify_resume(regs);
315 }
316 }
317 local_irq_disable();
318 thread_flags = current_thread_info()->flags;
319 } while (thread_flags & _TIF_WORK_MASK);
320 return 0;
321}
322