]> git.karo-electronics.de Git - karo-tx-linux.git/blob - arch/powerpc/kernel/ptrace.c
Merge branch 'for-3.13/logitech' into for-next
[karo-tx-linux.git] / arch / powerpc / kernel / ptrace.c
1 /*
2  *  PowerPC version
3  *    Copyright (C) 1995-1996 Gary Thomas (gdt@linuxppc.org)
4  *
5  *  Derived from "arch/m68k/kernel/ptrace.c"
6  *  Copyright (C) 1994 by Hamish Macdonald
7  *  Taken from linux/kernel/ptrace.c and modified for M680x0.
8  *  linux/kernel/ptrace.c is by Ross Biro 1/23/92, edited by Linus Torvalds
9  *
10  * Modified by Cort Dougan (cort@hq.fsmlabs.com)
11  * and Paul Mackerras (paulus@samba.org).
12  *
13  * This file is subject to the terms and conditions of the GNU General
14  * Public License.  See the file README.legal in the main directory of
15  * this archive for more details.
16  */
17
18 #include <linux/kernel.h>
19 #include <linux/sched.h>
20 #include <linux/mm.h>
21 #include <linux/smp.h>
22 #include <linux/errno.h>
23 #include <linux/ptrace.h>
24 #include <linux/regset.h>
25 #include <linux/tracehook.h>
26 #include <linux/elf.h>
27 #include <linux/user.h>
28 #include <linux/security.h>
29 #include <linux/signal.h>
30 #include <linux/seccomp.h>
31 #include <linux/audit.h>
32 #include <trace/syscall.h>
33 #include <linux/hw_breakpoint.h>
34 #include <linux/perf_event.h>
35 #include <linux/context_tracking.h>
36
37 #include <asm/uaccess.h>
38 #include <asm/page.h>
39 #include <asm/pgtable.h>
40 #include <asm/switch_to.h>
41
42 #define CREATE_TRACE_POINTS
43 #include <trace/events/syscalls.h>
44
45 /*
46  * The parameter save area on the stack is used to store arguments being passed
47  * to callee function and is located at fixed offset from stack pointer.
48  */
49 #ifdef CONFIG_PPC32
50 #define PARAMETER_SAVE_AREA_OFFSET      24  /* bytes */
51 #else /* CONFIG_PPC32 */
52 #define PARAMETER_SAVE_AREA_OFFSET      48  /* bytes */
53 #endif
54
55 struct pt_regs_offset {
56         const char *name;
57         int offset;
58 };
59
60 #define STR(s)  #s                      /* convert to string */
61 #define REG_OFFSET_NAME(r) {.name = #r, .offset = offsetof(struct pt_regs, r)}
62 #define GPR_OFFSET_NAME(num)    \
63         {.name = STR(gpr##num), .offset = offsetof(struct pt_regs, gpr[num])}
64 #define REG_OFFSET_END {.name = NULL, .offset = 0}
65
66 static const struct pt_regs_offset regoffset_table[] = {
67         GPR_OFFSET_NAME(0),
68         GPR_OFFSET_NAME(1),
69         GPR_OFFSET_NAME(2),
70         GPR_OFFSET_NAME(3),
71         GPR_OFFSET_NAME(4),
72         GPR_OFFSET_NAME(5),
73         GPR_OFFSET_NAME(6),
74         GPR_OFFSET_NAME(7),
75         GPR_OFFSET_NAME(8),
76         GPR_OFFSET_NAME(9),
77         GPR_OFFSET_NAME(10),
78         GPR_OFFSET_NAME(11),
79         GPR_OFFSET_NAME(12),
80         GPR_OFFSET_NAME(13),
81         GPR_OFFSET_NAME(14),
82         GPR_OFFSET_NAME(15),
83         GPR_OFFSET_NAME(16),
84         GPR_OFFSET_NAME(17),
85         GPR_OFFSET_NAME(18),
86         GPR_OFFSET_NAME(19),
87         GPR_OFFSET_NAME(20),
88         GPR_OFFSET_NAME(21),
89         GPR_OFFSET_NAME(22),
90         GPR_OFFSET_NAME(23),
91         GPR_OFFSET_NAME(24),
92         GPR_OFFSET_NAME(25),
93         GPR_OFFSET_NAME(26),
94         GPR_OFFSET_NAME(27),
95         GPR_OFFSET_NAME(28),
96         GPR_OFFSET_NAME(29),
97         GPR_OFFSET_NAME(30),
98         GPR_OFFSET_NAME(31),
99         REG_OFFSET_NAME(nip),
100         REG_OFFSET_NAME(msr),
101         REG_OFFSET_NAME(ctr),
102         REG_OFFSET_NAME(link),
103         REG_OFFSET_NAME(xer),
104         REG_OFFSET_NAME(ccr),
105 #ifdef CONFIG_PPC64
106         REG_OFFSET_NAME(softe),
107 #else
108         REG_OFFSET_NAME(mq),
109 #endif
110         REG_OFFSET_NAME(trap),
111         REG_OFFSET_NAME(dar),
112         REG_OFFSET_NAME(dsisr),
113         REG_OFFSET_END,
114 };
115
116 /**
117  * regs_query_register_offset() - query register offset from its name
118  * @name:       the name of a register
119  *
120  * regs_query_register_offset() returns the offset of a register in struct
121  * pt_regs from its name. If the name is invalid, this returns -EINVAL;
122  */
123 int regs_query_register_offset(const char *name)
124 {
125         const struct pt_regs_offset *roff;
126         for (roff = regoffset_table; roff->name != NULL; roff++)
127                 if (!strcmp(roff->name, name))
128                         return roff->offset;
129         return -EINVAL;
130 }
131
132 /**
133  * regs_query_register_name() - query register name from its offset
134  * @offset:     the offset of a register in struct pt_regs.
135  *
136  * regs_query_register_name() returns the name of a register from its
137  * offset in struct pt_regs. If the @offset is invalid, this returns NULL;
138  */
139 const char *regs_query_register_name(unsigned int offset)
140 {
141         const struct pt_regs_offset *roff;
142         for (roff = regoffset_table; roff->name != NULL; roff++)
143                 if (roff->offset == offset)
144                         return roff->name;
145         return NULL;
146 }
147
148 /*
149  * does not yet catch signals sent when the child dies.
150  * in exit.c or in signal.c.
151  */
152
153 /*
154  * Set of msr bits that gdb can change on behalf of a process.
155  */
156 #ifdef CONFIG_PPC_ADV_DEBUG_REGS
157 #define MSR_DEBUGCHANGE 0
158 #else
159 #define MSR_DEBUGCHANGE (MSR_SE | MSR_BE)
160 #endif
161
162 /*
163  * Max register writeable via put_reg
164  */
165 #ifdef CONFIG_PPC32
166 #define PT_MAX_PUT_REG  PT_MQ
167 #else
168 #define PT_MAX_PUT_REG  PT_CCR
169 #endif
170
171 static unsigned long get_user_msr(struct task_struct *task)
172 {
173         return task->thread.regs->msr | task->thread.fpexc_mode;
174 }
175
176 static int set_user_msr(struct task_struct *task, unsigned long msr)
177 {
178         task->thread.regs->msr &= ~MSR_DEBUGCHANGE;
179         task->thread.regs->msr |= msr & MSR_DEBUGCHANGE;
180         return 0;
181 }
182
183 #ifdef CONFIG_PPC64
184 static int get_user_dscr(struct task_struct *task, unsigned long *data)
185 {
186         *data = task->thread.dscr;
187         return 0;
188 }
189
190 static int set_user_dscr(struct task_struct *task, unsigned long dscr)
191 {
192         task->thread.dscr = dscr;
193         task->thread.dscr_inherit = 1;
194         return 0;
195 }
196 #else
197 static int get_user_dscr(struct task_struct *task, unsigned long *data)
198 {
199         return -EIO;
200 }
201
202 static int set_user_dscr(struct task_struct *task, unsigned long dscr)
203 {
204         return -EIO;
205 }
206 #endif
207
208 /*
209  * We prevent mucking around with the reserved area of trap
210  * which are used internally by the kernel.
211  */
212 static int set_user_trap(struct task_struct *task, unsigned long trap)
213 {
214         task->thread.regs->trap = trap & 0xfff0;
215         return 0;
216 }
217
218 /*
219  * Get contents of register REGNO in task TASK.
220  */
221 int ptrace_get_reg(struct task_struct *task, int regno, unsigned long *data)
222 {
223         if ((task->thread.regs == NULL) || !data)
224                 return -EIO;
225
226         if (regno == PT_MSR) {
227                 *data = get_user_msr(task);
228                 return 0;
229         }
230
231         if (regno == PT_DSCR)
232                 return get_user_dscr(task, data);
233
234         if (regno < (sizeof(struct pt_regs) / sizeof(unsigned long))) {
235                 *data = ((unsigned long *)task->thread.regs)[regno];
236                 return 0;
237         }
238
239         return -EIO;
240 }
241
242 /*
243  * Write contents of register REGNO in task TASK.
244  */
245 int ptrace_put_reg(struct task_struct *task, int regno, unsigned long data)
246 {
247         if (task->thread.regs == NULL)
248                 return -EIO;
249
250         if (regno == PT_MSR)
251                 return set_user_msr(task, data);
252         if (regno == PT_TRAP)
253                 return set_user_trap(task, data);
254         if (regno == PT_DSCR)
255                 return set_user_dscr(task, data);
256
257         if (regno <= PT_MAX_PUT_REG) {
258                 ((unsigned long *)task->thread.regs)[regno] = data;
259                 return 0;
260         }
261         return -EIO;
262 }
263
264 static int gpr_get(struct task_struct *target, const struct user_regset *regset,
265                    unsigned int pos, unsigned int count,
266                    void *kbuf, void __user *ubuf)
267 {
268         int i, ret;
269
270         if (target->thread.regs == NULL)
271                 return -EIO;
272
273         if (!FULL_REGS(target->thread.regs)) {
274                 /* We have a partial register set.  Fill 14-31 with bogus values */
275                 for (i = 14; i < 32; i++)
276                         target->thread.regs->gpr[i] = NV_REG_POISON;
277         }
278
279         ret = user_regset_copyout(&pos, &count, &kbuf, &ubuf,
280                                   target->thread.regs,
281                                   0, offsetof(struct pt_regs, msr));
282         if (!ret) {
283                 unsigned long msr = get_user_msr(target);
284                 ret = user_regset_copyout(&pos, &count, &kbuf, &ubuf, &msr,
285                                           offsetof(struct pt_regs, msr),
286                                           offsetof(struct pt_regs, msr) +
287                                           sizeof(msr));
288         }
289
290         BUILD_BUG_ON(offsetof(struct pt_regs, orig_gpr3) !=
291                      offsetof(struct pt_regs, msr) + sizeof(long));
292
293         if (!ret)
294                 ret = user_regset_copyout(&pos, &count, &kbuf, &ubuf,
295                                           &target->thread.regs->orig_gpr3,
296                                           offsetof(struct pt_regs, orig_gpr3),
297                                           sizeof(struct pt_regs));
298         if (!ret)
299                 ret = user_regset_copyout_zero(&pos, &count, &kbuf, &ubuf,
300                                                sizeof(struct pt_regs), -1);
301
302         return ret;
303 }
304
305 static int gpr_set(struct task_struct *target, const struct user_regset *regset,
306                    unsigned int pos, unsigned int count,
307                    const void *kbuf, const void __user *ubuf)
308 {
309         unsigned long reg;
310         int ret;
311
312         if (target->thread.regs == NULL)
313                 return -EIO;
314
315         CHECK_FULL_REGS(target->thread.regs);
316
317         ret = user_regset_copyin(&pos, &count, &kbuf, &ubuf,
318                                  target->thread.regs,
319                                  0, PT_MSR * sizeof(reg));
320
321         if (!ret && count > 0) {
322                 ret = user_regset_copyin(&pos, &count, &kbuf, &ubuf, &reg,
323                                          PT_MSR * sizeof(reg),
324                                          (PT_MSR + 1) * sizeof(reg));
325                 if (!ret)
326                         ret = set_user_msr(target, reg);
327         }
328
329         BUILD_BUG_ON(offsetof(struct pt_regs, orig_gpr3) !=
330                      offsetof(struct pt_regs, msr) + sizeof(long));
331
332         if (!ret)
333                 ret = user_regset_copyin(&pos, &count, &kbuf, &ubuf,
334                                          &target->thread.regs->orig_gpr3,
335                                          PT_ORIG_R3 * sizeof(reg),
336                                          (PT_MAX_PUT_REG + 1) * sizeof(reg));
337
338         if (PT_MAX_PUT_REG + 1 < PT_TRAP && !ret)
339                 ret = user_regset_copyin_ignore(
340                         &pos, &count, &kbuf, &ubuf,
341                         (PT_MAX_PUT_REG + 1) * sizeof(reg),
342                         PT_TRAP * sizeof(reg));
343
344         if (!ret && count > 0) {
345                 ret = user_regset_copyin(&pos, &count, &kbuf, &ubuf, &reg,
346                                          PT_TRAP * sizeof(reg),
347                                          (PT_TRAP + 1) * sizeof(reg));
348                 if (!ret)
349                         ret = set_user_trap(target, reg);
350         }
351
352         if (!ret)
353                 ret = user_regset_copyin_ignore(
354                         &pos, &count, &kbuf, &ubuf,
355                         (PT_TRAP + 1) * sizeof(reg), -1);
356
357         return ret;
358 }
359
360 static int fpr_get(struct task_struct *target, const struct user_regset *regset,
361                    unsigned int pos, unsigned int count,
362                    void *kbuf, void __user *ubuf)
363 {
364 #ifdef CONFIG_VSX
365         double buf[33];
366         int i;
367 #endif
368         flush_fp_to_thread(target);
369
370 #ifdef CONFIG_VSX
371         /* copy to local buffer then write that out */
372         for (i = 0; i < 32 ; i++)
373                 buf[i] = target->thread.TS_FPR(i);
374         memcpy(&buf[32], &target->thread.fpscr, sizeof(double));
375         return user_regset_copyout(&pos, &count, &kbuf, &ubuf, buf, 0, -1);
376
377 #else
378         BUILD_BUG_ON(offsetof(struct thread_struct, fpscr) !=
379                      offsetof(struct thread_struct, TS_FPR(32)));
380
381         return user_regset_copyout(&pos, &count, &kbuf, &ubuf,
382                                    &target->thread.fpr, 0, -1);
383 #endif
384 }
385
386 static int fpr_set(struct task_struct *target, const struct user_regset *regset,
387                    unsigned int pos, unsigned int count,
388                    const void *kbuf, const void __user *ubuf)
389 {
390 #ifdef CONFIG_VSX
391         double buf[33];
392         int i;
393 #endif
394         flush_fp_to_thread(target);
395
396 #ifdef CONFIG_VSX
397         /* copy to local buffer then write that out */
398         i = user_regset_copyin(&pos, &count, &kbuf, &ubuf, buf, 0, -1);
399         if (i)
400                 return i;
401         for (i = 0; i < 32 ; i++)
402                 target->thread.TS_FPR(i) = buf[i];
403         memcpy(&target->thread.fpscr, &buf[32], sizeof(double));
404         return 0;
405 #else
406         BUILD_BUG_ON(offsetof(struct thread_struct, fpscr) !=
407                      offsetof(struct thread_struct, TS_FPR(32)));
408
409         return user_regset_copyin(&pos, &count, &kbuf, &ubuf,
410                                   &target->thread.fpr, 0, -1);
411 #endif
412 }
413
414 #ifdef CONFIG_ALTIVEC
415 /*
416  * Get/set all the altivec registers vr0..vr31, vscr, vrsave, in one go.
417  * The transfer totals 34 quadword.  Quadwords 0-31 contain the
418  * corresponding vector registers.  Quadword 32 contains the vscr as the
419  * last word (offset 12) within that quadword.  Quadword 33 contains the
420  * vrsave as the first word (offset 0) within the quadword.
421  *
422  * This definition of the VMX state is compatible with the current PPC32
423  * ptrace interface.  This allows signal handling and ptrace to use the
424  * same structures.  This also simplifies the implementation of a bi-arch
425  * (combined (32- and 64-bit) gdb.
426  */
427
428 static int vr_active(struct task_struct *target,
429                      const struct user_regset *regset)
430 {
431         flush_altivec_to_thread(target);
432         return target->thread.used_vr ? regset->n : 0;
433 }
434
435 static int vr_get(struct task_struct *target, const struct user_regset *regset,
436                   unsigned int pos, unsigned int count,
437                   void *kbuf, void __user *ubuf)
438 {
439         int ret;
440
441         flush_altivec_to_thread(target);
442
443         BUILD_BUG_ON(offsetof(struct thread_struct, vscr) !=
444                      offsetof(struct thread_struct, vr[32]));
445
446         ret = user_regset_copyout(&pos, &count, &kbuf, &ubuf,
447                                   &target->thread.vr, 0,
448                                   33 * sizeof(vector128));
449         if (!ret) {
450                 /*
451                  * Copy out only the low-order word of vrsave.
452                  */
453                 union {
454                         elf_vrreg_t reg;
455                         u32 word;
456                 } vrsave;
457                 memset(&vrsave, 0, sizeof(vrsave));
458                 vrsave.word = target->thread.vrsave;
459                 ret = user_regset_copyout(&pos, &count, &kbuf, &ubuf, &vrsave,
460                                           33 * sizeof(vector128), -1);
461         }
462
463         return ret;
464 }
465
466 static int vr_set(struct task_struct *target, const struct user_regset *regset,
467                   unsigned int pos, unsigned int count,
468                   const void *kbuf, const void __user *ubuf)
469 {
470         int ret;
471
472         flush_altivec_to_thread(target);
473
474         BUILD_BUG_ON(offsetof(struct thread_struct, vscr) !=
475                      offsetof(struct thread_struct, vr[32]));
476
477         ret = user_regset_copyin(&pos, &count, &kbuf, &ubuf,
478                                  &target->thread.vr, 0, 33 * sizeof(vector128));
479         if (!ret && count > 0) {
480                 /*
481                  * We use only the first word of vrsave.
482                  */
483                 union {
484                         elf_vrreg_t reg;
485                         u32 word;
486                 } vrsave;
487                 memset(&vrsave, 0, sizeof(vrsave));
488                 vrsave.word = target->thread.vrsave;
489                 ret = user_regset_copyin(&pos, &count, &kbuf, &ubuf, &vrsave,
490                                          33 * sizeof(vector128), -1);
491                 if (!ret)
492                         target->thread.vrsave = vrsave.word;
493         }
494
495         return ret;
496 }
497 #endif /* CONFIG_ALTIVEC */
498
499 #ifdef CONFIG_VSX
500 /*
501  * Currently to set and and get all the vsx state, you need to call
502  * the fp and VMX calls as well.  This only get/sets the lower 32
503  * 128bit VSX registers.
504  */
505
506 static int vsr_active(struct task_struct *target,
507                       const struct user_regset *regset)
508 {
509         flush_vsx_to_thread(target);
510         return target->thread.used_vsr ? regset->n : 0;
511 }
512
513 static int vsr_get(struct task_struct *target, const struct user_regset *regset,
514                    unsigned int pos, unsigned int count,
515                    void *kbuf, void __user *ubuf)
516 {
517         double buf[32];
518         int ret, i;
519
520         flush_vsx_to_thread(target);
521
522         for (i = 0; i < 32 ; i++)
523                 buf[i] = target->thread.fpr[i][TS_VSRLOWOFFSET];
524         ret = user_regset_copyout(&pos, &count, &kbuf, &ubuf,
525                                   buf, 0, 32 * sizeof(double));
526
527         return ret;
528 }
529
530 static int vsr_set(struct task_struct *target, const struct user_regset *regset,
531                    unsigned int pos, unsigned int count,
532                    const void *kbuf, const void __user *ubuf)
533 {
534         double buf[32];
535         int ret,i;
536
537         flush_vsx_to_thread(target);
538
539         ret = user_regset_copyin(&pos, &count, &kbuf, &ubuf,
540                                  buf, 0, 32 * sizeof(double));
541         for (i = 0; i < 32 ; i++)
542                 target->thread.fpr[i][TS_VSRLOWOFFSET] = buf[i];
543
544
545         return ret;
546 }
547 #endif /* CONFIG_VSX */
548
549 #ifdef CONFIG_SPE
550
551 /*
552  * For get_evrregs/set_evrregs functions 'data' has the following layout:
553  *
554  * struct {
555  *   u32 evr[32];
556  *   u64 acc;
557  *   u32 spefscr;
558  * }
559  */
560
561 static int evr_active(struct task_struct *target,
562                       const struct user_regset *regset)
563 {
564         flush_spe_to_thread(target);
565         return target->thread.used_spe ? regset->n : 0;
566 }
567
568 static int evr_get(struct task_struct *target, const struct user_regset *regset,
569                    unsigned int pos, unsigned int count,
570                    void *kbuf, void __user *ubuf)
571 {
572         int ret;
573
574         flush_spe_to_thread(target);
575
576         ret = user_regset_copyout(&pos, &count, &kbuf, &ubuf,
577                                   &target->thread.evr,
578                                   0, sizeof(target->thread.evr));
579
580         BUILD_BUG_ON(offsetof(struct thread_struct, acc) + sizeof(u64) !=
581                      offsetof(struct thread_struct, spefscr));
582
583         if (!ret)
584                 ret = user_regset_copyout(&pos, &count, &kbuf, &ubuf,
585                                           &target->thread.acc,
586                                           sizeof(target->thread.evr), -1);
587
588         return ret;
589 }
590
591 static int evr_set(struct task_struct *target, const struct user_regset *regset,
592                    unsigned int pos, unsigned int count,
593                    const void *kbuf, const void __user *ubuf)
594 {
595         int ret;
596
597         flush_spe_to_thread(target);
598
599         ret = user_regset_copyin(&pos, &count, &kbuf, &ubuf,
600                                  &target->thread.evr,
601                                  0, sizeof(target->thread.evr));
602
603         BUILD_BUG_ON(offsetof(struct thread_struct, acc) + sizeof(u64) !=
604                      offsetof(struct thread_struct, spefscr));
605
606         if (!ret)
607                 ret = user_regset_copyin(&pos, &count, &kbuf, &ubuf,
608                                          &target->thread.acc,
609                                          sizeof(target->thread.evr), -1);
610
611         return ret;
612 }
613 #endif /* CONFIG_SPE */
614
615
616 /*
617  * These are our native regset flavors.
618  */
619 enum powerpc_regset {
620         REGSET_GPR,
621         REGSET_FPR,
622 #ifdef CONFIG_ALTIVEC
623         REGSET_VMX,
624 #endif
625 #ifdef CONFIG_VSX
626         REGSET_VSX,
627 #endif
628 #ifdef CONFIG_SPE
629         REGSET_SPE,
630 #endif
631 };
632
633 static const struct user_regset native_regsets[] = {
634         [REGSET_GPR] = {
635                 .core_note_type = NT_PRSTATUS, .n = ELF_NGREG,
636                 .size = sizeof(long), .align = sizeof(long),
637                 .get = gpr_get, .set = gpr_set
638         },
639         [REGSET_FPR] = {
640                 .core_note_type = NT_PRFPREG, .n = ELF_NFPREG,
641                 .size = sizeof(double), .align = sizeof(double),
642                 .get = fpr_get, .set = fpr_set
643         },
644 #ifdef CONFIG_ALTIVEC
645         [REGSET_VMX] = {
646                 .core_note_type = NT_PPC_VMX, .n = 34,
647                 .size = sizeof(vector128), .align = sizeof(vector128),
648                 .active = vr_active, .get = vr_get, .set = vr_set
649         },
650 #endif
651 #ifdef CONFIG_VSX
652         [REGSET_VSX] = {
653                 .core_note_type = NT_PPC_VSX, .n = 32,
654                 .size = sizeof(double), .align = sizeof(double),
655                 .active = vsr_active, .get = vsr_get, .set = vsr_set
656         },
657 #endif
658 #ifdef CONFIG_SPE
659         [REGSET_SPE] = {
660                 .n = 35,
661                 .size = sizeof(u32), .align = sizeof(u32),
662                 .active = evr_active, .get = evr_get, .set = evr_set
663         },
664 #endif
665 };
666
667 static const struct user_regset_view user_ppc_native_view = {
668         .name = UTS_MACHINE, .e_machine = ELF_ARCH, .ei_osabi = ELF_OSABI,
669         .regsets = native_regsets, .n = ARRAY_SIZE(native_regsets)
670 };
671
672 #ifdef CONFIG_PPC64
673 #include <linux/compat.h>
674
675 static int gpr32_get(struct task_struct *target,
676                      const struct user_regset *regset,
677                      unsigned int pos, unsigned int count,
678                      void *kbuf, void __user *ubuf)
679 {
680         const unsigned long *regs = &target->thread.regs->gpr[0];
681         compat_ulong_t *k = kbuf;
682         compat_ulong_t __user *u = ubuf;
683         compat_ulong_t reg;
684         int i;
685
686         if (target->thread.regs == NULL)
687                 return -EIO;
688
689         if (!FULL_REGS(target->thread.regs)) {
690                 /* We have a partial register set.  Fill 14-31 with bogus values */
691                 for (i = 14; i < 32; i++)
692                         target->thread.regs->gpr[i] = NV_REG_POISON; 
693         }
694
695         pos /= sizeof(reg);
696         count /= sizeof(reg);
697
698         if (kbuf)
699                 for (; count > 0 && pos < PT_MSR; --count)
700                         *k++ = regs[pos++];
701         else
702                 for (; count > 0 && pos < PT_MSR; --count)
703                         if (__put_user((compat_ulong_t) regs[pos++], u++))
704                                 return -EFAULT;
705
706         if (count > 0 && pos == PT_MSR) {
707                 reg = get_user_msr(target);
708                 if (kbuf)
709                         *k++ = reg;
710                 else if (__put_user(reg, u++))
711                         return -EFAULT;
712                 ++pos;
713                 --count;
714         }
715
716         if (kbuf)
717                 for (; count > 0 && pos < PT_REGS_COUNT; --count)
718                         *k++ = regs[pos++];
719         else
720                 for (; count > 0 && pos < PT_REGS_COUNT; --count)
721                         if (__put_user((compat_ulong_t) regs[pos++], u++))
722                                 return -EFAULT;
723
724         kbuf = k;
725         ubuf = u;
726         pos *= sizeof(reg);
727         count *= sizeof(reg);
728         return user_regset_copyout_zero(&pos, &count, &kbuf, &ubuf,
729                                         PT_REGS_COUNT * sizeof(reg), -1);
730 }
731
732 static int gpr32_set(struct task_struct *target,
733                      const struct user_regset *regset,
734                      unsigned int pos, unsigned int count,
735                      const void *kbuf, const void __user *ubuf)
736 {
737         unsigned long *regs = &target->thread.regs->gpr[0];
738         const compat_ulong_t *k = kbuf;
739         const compat_ulong_t __user *u = ubuf;
740         compat_ulong_t reg;
741
742         if (target->thread.regs == NULL)
743                 return -EIO;
744
745         CHECK_FULL_REGS(target->thread.regs);
746
747         pos /= sizeof(reg);
748         count /= sizeof(reg);
749
750         if (kbuf)
751                 for (; count > 0 && pos < PT_MSR; --count)
752                         regs[pos++] = *k++;
753         else
754                 for (; count > 0 && pos < PT_MSR; --count) {
755                         if (__get_user(reg, u++))
756                                 return -EFAULT;
757                         regs[pos++] = reg;
758                 }
759
760
761         if (count > 0 && pos == PT_MSR) {
762                 if (kbuf)
763                         reg = *k++;
764                 else if (__get_user(reg, u++))
765                         return -EFAULT;
766                 set_user_msr(target, reg);
767                 ++pos;
768                 --count;
769         }
770
771         if (kbuf) {
772                 for (; count > 0 && pos <= PT_MAX_PUT_REG; --count)
773                         regs[pos++] = *k++;
774                 for (; count > 0 && pos < PT_TRAP; --count, ++pos)
775                         ++k;
776         } else {
777                 for (; count > 0 && pos <= PT_MAX_PUT_REG; --count) {
778                         if (__get_user(reg, u++))
779                                 return -EFAULT;
780                         regs[pos++] = reg;
781                 }
782                 for (; count > 0 && pos < PT_TRAP; --count, ++pos)
783                         if (__get_user(reg, u++))
784                                 return -EFAULT;
785         }
786
787         if (count > 0 && pos == PT_TRAP) {
788                 if (kbuf)
789                         reg = *k++;
790                 else if (__get_user(reg, u++))
791                         return -EFAULT;
792                 set_user_trap(target, reg);
793                 ++pos;
794                 --count;
795         }
796
797         kbuf = k;
798         ubuf = u;
799         pos *= sizeof(reg);
800         count *= sizeof(reg);
801         return user_regset_copyin_ignore(&pos, &count, &kbuf, &ubuf,
802                                          (PT_TRAP + 1) * sizeof(reg), -1);
803 }
804
805 /*
806  * These are the regset flavors matching the CONFIG_PPC32 native set.
807  */
808 static const struct user_regset compat_regsets[] = {
809         [REGSET_GPR] = {
810                 .core_note_type = NT_PRSTATUS, .n = ELF_NGREG,
811                 .size = sizeof(compat_long_t), .align = sizeof(compat_long_t),
812                 .get = gpr32_get, .set = gpr32_set
813         },
814         [REGSET_FPR] = {
815                 .core_note_type = NT_PRFPREG, .n = ELF_NFPREG,
816                 .size = sizeof(double), .align = sizeof(double),
817                 .get = fpr_get, .set = fpr_set
818         },
819 #ifdef CONFIG_ALTIVEC
820         [REGSET_VMX] = {
821                 .core_note_type = NT_PPC_VMX, .n = 34,
822                 .size = sizeof(vector128), .align = sizeof(vector128),
823                 .active = vr_active, .get = vr_get, .set = vr_set
824         },
825 #endif
826 #ifdef CONFIG_SPE
827         [REGSET_SPE] = {
828                 .core_note_type = NT_PPC_SPE, .n = 35,
829                 .size = sizeof(u32), .align = sizeof(u32),
830                 .active = evr_active, .get = evr_get, .set = evr_set
831         },
832 #endif
833 };
834
835 static const struct user_regset_view user_ppc_compat_view = {
836         .name = "ppc", .e_machine = EM_PPC, .ei_osabi = ELF_OSABI,
837         .regsets = compat_regsets, .n = ARRAY_SIZE(compat_regsets)
838 };
839 #endif  /* CONFIG_PPC64 */
840
841 const struct user_regset_view *task_user_regset_view(struct task_struct *task)
842 {
843 #ifdef CONFIG_PPC64
844         if (test_tsk_thread_flag(task, TIF_32BIT))
845                 return &user_ppc_compat_view;
846 #endif
847         return &user_ppc_native_view;
848 }
849
850
851 void user_enable_single_step(struct task_struct *task)
852 {
853         struct pt_regs *regs = task->thread.regs;
854
855         if (regs != NULL) {
856 #ifdef CONFIG_PPC_ADV_DEBUG_REGS
857                 task->thread.dbcr0 &= ~DBCR0_BT;
858                 task->thread.dbcr0 |= DBCR0_IDM | DBCR0_IC;
859                 regs->msr |= MSR_DE;
860 #else
861                 regs->msr &= ~MSR_BE;
862                 regs->msr |= MSR_SE;
863 #endif
864         }
865         set_tsk_thread_flag(task, TIF_SINGLESTEP);
866 }
867
868 void user_enable_block_step(struct task_struct *task)
869 {
870         struct pt_regs *regs = task->thread.regs;
871
872         if (regs != NULL) {
873 #ifdef CONFIG_PPC_ADV_DEBUG_REGS
874                 task->thread.dbcr0 &= ~DBCR0_IC;
875                 task->thread.dbcr0 = DBCR0_IDM | DBCR0_BT;
876                 regs->msr |= MSR_DE;
877 #else
878                 regs->msr &= ~MSR_SE;
879                 regs->msr |= MSR_BE;
880 #endif
881         }
882         set_tsk_thread_flag(task, TIF_SINGLESTEP);
883 }
884
885 void user_disable_single_step(struct task_struct *task)
886 {
887         struct pt_regs *regs = task->thread.regs;
888
889         if (regs != NULL) {
890 #ifdef CONFIG_PPC_ADV_DEBUG_REGS
891                 /*
892                  * The logic to disable single stepping should be as
893                  * simple as turning off the Instruction Complete flag.
894                  * And, after doing so, if all debug flags are off, turn
895                  * off DBCR0(IDM) and MSR(DE) .... Torez
896                  */
897                 task->thread.dbcr0 &= ~DBCR0_IC;
898                 /*
899                  * Test to see if any of the DBCR_ACTIVE_EVENTS bits are set.
900                  */
901                 if (!DBCR_ACTIVE_EVENTS(task->thread.dbcr0,
902                                         task->thread.dbcr1)) {
903                         /*
904                          * All debug events were off.....
905                          */
906                         task->thread.dbcr0 &= ~DBCR0_IDM;
907                         regs->msr &= ~MSR_DE;
908                 }
909 #else
910                 regs->msr &= ~(MSR_SE | MSR_BE);
911 #endif
912         }
913         clear_tsk_thread_flag(task, TIF_SINGLESTEP);
914 }
915
916 #ifdef CONFIG_HAVE_HW_BREAKPOINT
917 void ptrace_triggered(struct perf_event *bp,
918                       struct perf_sample_data *data, struct pt_regs *regs)
919 {
920         struct perf_event_attr attr;
921
922         /*
923          * Disable the breakpoint request here since ptrace has defined a
924          * one-shot behaviour for breakpoint exceptions in PPC64.
925          * The SIGTRAP signal is generated automatically for us in do_dabr().
926          * We don't have to do anything about that here
927          */
928         attr = bp->attr;
929         attr.disabled = true;
930         modify_user_hw_breakpoint(bp, &attr);
931 }
932 #endif /* CONFIG_HAVE_HW_BREAKPOINT */
933
934 int ptrace_set_debugreg(struct task_struct *task, unsigned long addr,
935                                unsigned long data)
936 {
937 #ifdef CONFIG_HAVE_HW_BREAKPOINT
938         int ret;
939         struct thread_struct *thread = &(task->thread);
940         struct perf_event *bp;
941         struct perf_event_attr attr;
942 #endif /* CONFIG_HAVE_HW_BREAKPOINT */
943 #ifndef CONFIG_PPC_ADV_DEBUG_REGS
944         struct arch_hw_breakpoint hw_brk;
945 #endif
946
947         /* For ppc64 we support one DABR and no IABR's at the moment (ppc64).
948          *  For embedded processors we support one DAC and no IAC's at the
949          *  moment.
950          */
951         if (addr > 0)
952                 return -EINVAL;
953
954         /* The bottom 3 bits in dabr are flags */
955         if ((data & ~0x7UL) >= TASK_SIZE)
956                 return -EIO;
957
958 #ifndef CONFIG_PPC_ADV_DEBUG_REGS
959         /* For processors using DABR (i.e. 970), the bottom 3 bits are flags.
960          *  It was assumed, on previous implementations, that 3 bits were
961          *  passed together with the data address, fitting the design of the
962          *  DABR register, as follows:
963          *
964          *  bit 0: Read flag
965          *  bit 1: Write flag
966          *  bit 2: Breakpoint translation
967          *
968          *  Thus, we use them here as so.
969          */
970
971         /* Ensure breakpoint translation bit is set */
972         if (data && !(data & HW_BRK_TYPE_TRANSLATE))
973                 return -EIO;
974         hw_brk.address = data & (~HW_BRK_TYPE_DABR);
975         hw_brk.type = (data & HW_BRK_TYPE_DABR) | HW_BRK_TYPE_PRIV_ALL;
976         hw_brk.len = 8;
977 #ifdef CONFIG_HAVE_HW_BREAKPOINT
978         bp = thread->ptrace_bps[0];
979         if ((!data) || !(hw_brk.type & HW_BRK_TYPE_RDWR)) {
980                 if (bp) {
981                         unregister_hw_breakpoint(bp);
982                         thread->ptrace_bps[0] = NULL;
983                 }
984                 return 0;
985         }
986         if (bp) {
987                 attr = bp->attr;
988                 attr.bp_addr = hw_brk.address;
989                 arch_bp_generic_fields(hw_brk.type, &attr.bp_type);
990
991                 /* Enable breakpoint */
992                 attr.disabled = false;
993
994                 ret =  modify_user_hw_breakpoint(bp, &attr);
995                 if (ret) {
996                         return ret;
997                 }
998                 thread->ptrace_bps[0] = bp;
999                 thread->hw_brk = hw_brk;
1000                 return 0;
1001         }
1002
1003         /* Create a new breakpoint request if one doesn't exist already */
1004         hw_breakpoint_init(&attr);
1005         attr.bp_addr = hw_brk.address;
1006         arch_bp_generic_fields(hw_brk.type,
1007                                &attr.bp_type);
1008
1009         thread->ptrace_bps[0] = bp = register_user_hw_breakpoint(&attr,
1010                                                ptrace_triggered, NULL, task);
1011         if (IS_ERR(bp)) {
1012                 thread->ptrace_bps[0] = NULL;
1013                 return PTR_ERR(bp);
1014         }
1015
1016 #endif /* CONFIG_HAVE_HW_BREAKPOINT */
1017         task->thread.hw_brk = hw_brk;
1018 #else /* CONFIG_PPC_ADV_DEBUG_REGS */
1019         /* As described above, it was assumed 3 bits were passed with the data
1020          *  address, but we will assume only the mode bits will be passed
1021          *  as to not cause alignment restrictions for DAC-based processors.
1022          */
1023
1024         /* DAC's hold the whole address without any mode flags */
1025         task->thread.dac1 = data & ~0x3UL;
1026
1027         if (task->thread.dac1 == 0) {
1028                 dbcr_dac(task) &= ~(DBCR_DAC1R | DBCR_DAC1W);
1029                 if (!DBCR_ACTIVE_EVENTS(task->thread.dbcr0,
1030                                         task->thread.dbcr1)) {
1031                         task->thread.regs->msr &= ~MSR_DE;
1032                         task->thread.dbcr0 &= ~DBCR0_IDM;
1033                 }
1034                 return 0;
1035         }
1036
1037         /* Read or Write bits must be set */
1038
1039         if (!(data & 0x3UL))
1040                 return -EINVAL;
1041
1042         /* Set the Internal Debugging flag (IDM bit 1) for the DBCR0
1043            register */
1044         task->thread.dbcr0 |= DBCR0_IDM;
1045
1046         /* Check for write and read flags and set DBCR0
1047            accordingly */
1048         dbcr_dac(task) &= ~(DBCR_DAC1R|DBCR_DAC1W);
1049         if (data & 0x1UL)
1050                 dbcr_dac(task) |= DBCR_DAC1R;
1051         if (data & 0x2UL)
1052                 dbcr_dac(task) |= DBCR_DAC1W;
1053         task->thread.regs->msr |= MSR_DE;
1054 #endif /* CONFIG_PPC_ADV_DEBUG_REGS */
1055         return 0;
1056 }
1057
1058 /*
1059  * Called by kernel/ptrace.c when detaching..
1060  *
1061  * Make sure single step bits etc are not set.
1062  */
1063 void ptrace_disable(struct task_struct *child)
1064 {
1065         /* make sure the single step bit is not set. */
1066         user_disable_single_step(child);
1067 }
1068
1069 #ifdef CONFIG_PPC_ADV_DEBUG_REGS
1070 static long set_instruction_bp(struct task_struct *child,
1071                               struct ppc_hw_breakpoint *bp_info)
1072 {
1073         int slot;
1074         int slot1_in_use = ((child->thread.dbcr0 & DBCR0_IAC1) != 0);
1075         int slot2_in_use = ((child->thread.dbcr0 & DBCR0_IAC2) != 0);
1076         int slot3_in_use = ((child->thread.dbcr0 & DBCR0_IAC3) != 0);
1077         int slot4_in_use = ((child->thread.dbcr0 & DBCR0_IAC4) != 0);
1078
1079         if (dbcr_iac_range(child) & DBCR_IAC12MODE)
1080                 slot2_in_use = 1;
1081         if (dbcr_iac_range(child) & DBCR_IAC34MODE)
1082                 slot4_in_use = 1;
1083
1084         if (bp_info->addr >= TASK_SIZE)
1085                 return -EIO;
1086
1087         if (bp_info->addr_mode != PPC_BREAKPOINT_MODE_EXACT) {
1088
1089                 /* Make sure range is valid. */
1090                 if (bp_info->addr2 >= TASK_SIZE)
1091                         return -EIO;
1092
1093                 /* We need a pair of IAC regsisters */
1094                 if ((!slot1_in_use) && (!slot2_in_use)) {
1095                         slot = 1;
1096                         child->thread.iac1 = bp_info->addr;
1097                         child->thread.iac2 = bp_info->addr2;
1098                         child->thread.dbcr0 |= DBCR0_IAC1;
1099                         if (bp_info->addr_mode ==
1100                                         PPC_BREAKPOINT_MODE_RANGE_EXCLUSIVE)
1101                                 dbcr_iac_range(child) |= DBCR_IAC12X;
1102                         else
1103                                 dbcr_iac_range(child) |= DBCR_IAC12I;
1104 #if CONFIG_PPC_ADV_DEBUG_IACS > 2
1105                 } else if ((!slot3_in_use) && (!slot4_in_use)) {
1106                         slot = 3;
1107                         child->thread.iac3 = bp_info->addr;
1108                         child->thread.iac4 = bp_info->addr2;
1109                         child->thread.dbcr0 |= DBCR0_IAC3;
1110                         if (bp_info->addr_mode ==
1111                                         PPC_BREAKPOINT_MODE_RANGE_EXCLUSIVE)
1112                                 dbcr_iac_range(child) |= DBCR_IAC34X;
1113                         else
1114                                 dbcr_iac_range(child) |= DBCR_IAC34I;
1115 #endif
1116                 } else
1117                         return -ENOSPC;
1118         } else {
1119                 /* We only need one.  If possible leave a pair free in
1120                  * case a range is needed later
1121                  */
1122                 if (!slot1_in_use) {
1123                         /*
1124                          * Don't use iac1 if iac1-iac2 are free and either
1125                          * iac3 or iac4 (but not both) are free
1126                          */
1127                         if (slot2_in_use || (slot3_in_use == slot4_in_use)) {
1128                                 slot = 1;
1129                                 child->thread.iac1 = bp_info->addr;
1130                                 child->thread.dbcr0 |= DBCR0_IAC1;
1131                                 goto out;
1132                         }
1133                 }
1134                 if (!slot2_in_use) {
1135                         slot = 2;
1136                         child->thread.iac2 = bp_info->addr;
1137                         child->thread.dbcr0 |= DBCR0_IAC2;
1138 #if CONFIG_PPC_ADV_DEBUG_IACS > 2
1139                 } else if (!slot3_in_use) {
1140                         slot = 3;
1141                         child->thread.iac3 = bp_info->addr;
1142                         child->thread.dbcr0 |= DBCR0_IAC3;
1143                 } else if (!slot4_in_use) {
1144                         slot = 4;
1145                         child->thread.iac4 = bp_info->addr;
1146                         child->thread.dbcr0 |= DBCR0_IAC4;
1147 #endif
1148                 } else
1149                         return -ENOSPC;
1150         }
1151 out:
1152         child->thread.dbcr0 |= DBCR0_IDM;
1153         child->thread.regs->msr |= MSR_DE;
1154
1155         return slot;
1156 }
1157
1158 static int del_instruction_bp(struct task_struct *child, int slot)
1159 {
1160         switch (slot) {
1161         case 1:
1162                 if ((child->thread.dbcr0 & DBCR0_IAC1) == 0)
1163                         return -ENOENT;
1164
1165                 if (dbcr_iac_range(child) & DBCR_IAC12MODE) {
1166                         /* address range - clear slots 1 & 2 */
1167                         child->thread.iac2 = 0;
1168                         dbcr_iac_range(child) &= ~DBCR_IAC12MODE;
1169                 }
1170                 child->thread.iac1 = 0;
1171                 child->thread.dbcr0 &= ~DBCR0_IAC1;
1172                 break;
1173         case 2:
1174                 if ((child->thread.dbcr0 & DBCR0_IAC2) == 0)
1175                         return -ENOENT;
1176
1177                 if (dbcr_iac_range(child) & DBCR_IAC12MODE)
1178                         /* used in a range */
1179                         return -EINVAL;
1180                 child->thread.iac2 = 0;
1181                 child->thread.dbcr0 &= ~DBCR0_IAC2;
1182                 break;
1183 #if CONFIG_PPC_ADV_DEBUG_IACS > 2
1184         case 3:
1185                 if ((child->thread.dbcr0 & DBCR0_IAC3) == 0)
1186                         return -ENOENT;
1187
1188                 if (dbcr_iac_range(child) & DBCR_IAC34MODE) {
1189                         /* address range - clear slots 3 & 4 */
1190                         child->thread.iac4 = 0;
1191                         dbcr_iac_range(child) &= ~DBCR_IAC34MODE;
1192                 }
1193                 child->thread.iac3 = 0;
1194                 child->thread.dbcr0 &= ~DBCR0_IAC3;
1195                 break;
1196         case 4:
1197                 if ((child->thread.dbcr0 & DBCR0_IAC4) == 0)
1198                         return -ENOENT;
1199
1200                 if (dbcr_iac_range(child) & DBCR_IAC34MODE)
1201                         /* Used in a range */
1202                         return -EINVAL;
1203                 child->thread.iac4 = 0;
1204                 child->thread.dbcr0 &= ~DBCR0_IAC4;
1205                 break;
1206 #endif
1207         default:
1208                 return -EINVAL;
1209         }
1210         return 0;
1211 }
1212
1213 static int set_dac(struct task_struct *child, struct ppc_hw_breakpoint *bp_info)
1214 {
1215         int byte_enable =
1216                 (bp_info->condition_mode >> PPC_BREAKPOINT_CONDITION_BE_SHIFT)
1217                 & 0xf;
1218         int condition_mode =
1219                 bp_info->condition_mode & PPC_BREAKPOINT_CONDITION_MODE;
1220         int slot;
1221
1222         if (byte_enable && (condition_mode == 0))
1223                 return -EINVAL;
1224
1225         if (bp_info->addr >= TASK_SIZE)
1226                 return -EIO;
1227
1228         if ((dbcr_dac(child) & (DBCR_DAC1R | DBCR_DAC1W)) == 0) {
1229                 slot = 1;
1230                 if (bp_info->trigger_type & PPC_BREAKPOINT_TRIGGER_READ)
1231                         dbcr_dac(child) |= DBCR_DAC1R;
1232                 if (bp_info->trigger_type & PPC_BREAKPOINT_TRIGGER_WRITE)
1233                         dbcr_dac(child) |= DBCR_DAC1W;
1234                 child->thread.dac1 = (unsigned long)bp_info->addr;
1235 #if CONFIG_PPC_ADV_DEBUG_DVCS > 0
1236                 if (byte_enable) {
1237                         child->thread.dvc1 =
1238                                 (unsigned long)bp_info->condition_value;
1239                         child->thread.dbcr2 |=
1240                                 ((byte_enable << DBCR2_DVC1BE_SHIFT) |
1241                                  (condition_mode << DBCR2_DVC1M_SHIFT));
1242                 }
1243 #endif
1244 #ifdef CONFIG_PPC_ADV_DEBUG_DAC_RANGE
1245         } else if (child->thread.dbcr2 & DBCR2_DAC12MODE) {
1246                 /* Both dac1 and dac2 are part of a range */
1247                 return -ENOSPC;
1248 #endif
1249         } else if ((dbcr_dac(child) & (DBCR_DAC2R | DBCR_DAC2W)) == 0) {
1250                 slot = 2;
1251                 if (bp_info->trigger_type & PPC_BREAKPOINT_TRIGGER_READ)
1252                         dbcr_dac(child) |= DBCR_DAC2R;
1253                 if (bp_info->trigger_type & PPC_BREAKPOINT_TRIGGER_WRITE)
1254                         dbcr_dac(child) |= DBCR_DAC2W;
1255                 child->thread.dac2 = (unsigned long)bp_info->addr;
1256 #if CONFIG_PPC_ADV_DEBUG_DVCS > 0
1257                 if (byte_enable) {
1258                         child->thread.dvc2 =
1259                                 (unsigned long)bp_info->condition_value;
1260                         child->thread.dbcr2 |=
1261                                 ((byte_enable << DBCR2_DVC2BE_SHIFT) |
1262                                  (condition_mode << DBCR2_DVC2M_SHIFT));
1263                 }
1264 #endif
1265         } else
1266                 return -ENOSPC;
1267         child->thread.dbcr0 |= DBCR0_IDM;
1268         child->thread.regs->msr |= MSR_DE;
1269
1270         return slot + 4;
1271 }
1272
1273 static int del_dac(struct task_struct *child, int slot)
1274 {
1275         if (slot == 1) {
1276                 if ((dbcr_dac(child) & (DBCR_DAC1R | DBCR_DAC1W)) == 0)
1277                         return -ENOENT;
1278
1279                 child->thread.dac1 = 0;
1280                 dbcr_dac(child) &= ~(DBCR_DAC1R | DBCR_DAC1W);
1281 #ifdef CONFIG_PPC_ADV_DEBUG_DAC_RANGE
1282                 if (child->thread.dbcr2 & DBCR2_DAC12MODE) {
1283                         child->thread.dac2 = 0;
1284                         child->thread.dbcr2 &= ~DBCR2_DAC12MODE;
1285                 }
1286                 child->thread.dbcr2 &= ~(DBCR2_DVC1M | DBCR2_DVC1BE);
1287 #endif
1288 #if CONFIG_PPC_ADV_DEBUG_DVCS > 0
1289                 child->thread.dvc1 = 0;
1290 #endif
1291         } else if (slot == 2) {
1292                 if ((dbcr_dac(child) & (DBCR_DAC2R | DBCR_DAC2W)) == 0)
1293                         return -ENOENT;
1294
1295 #ifdef CONFIG_PPC_ADV_DEBUG_DAC_RANGE
1296                 if (child->thread.dbcr2 & DBCR2_DAC12MODE)
1297                         /* Part of a range */
1298                         return -EINVAL;
1299                 child->thread.dbcr2 &= ~(DBCR2_DVC2M | DBCR2_DVC2BE);
1300 #endif
1301 #if CONFIG_PPC_ADV_DEBUG_DVCS > 0
1302                 child->thread.dvc2 = 0;
1303 #endif
1304                 child->thread.dac2 = 0;
1305                 dbcr_dac(child) &= ~(DBCR_DAC2R | DBCR_DAC2W);
1306         } else
1307                 return -EINVAL;
1308
1309         return 0;
1310 }
1311 #endif /* CONFIG_PPC_ADV_DEBUG_REGS */
1312
1313 #ifdef CONFIG_PPC_ADV_DEBUG_DAC_RANGE
1314 static int set_dac_range(struct task_struct *child,
1315                          struct ppc_hw_breakpoint *bp_info)
1316 {
1317         int mode = bp_info->addr_mode & PPC_BREAKPOINT_MODE_MASK;
1318
1319         /* We don't allow range watchpoints to be used with DVC */
1320         if (bp_info->condition_mode)
1321                 return -EINVAL;
1322
1323         /*
1324          * Best effort to verify the address range.  The user/supervisor bits
1325          * prevent trapping in kernel space, but let's fail on an obvious bad
1326          * range.  The simple test on the mask is not fool-proof, and any
1327          * exclusive range will spill over into kernel space.
1328          */
1329         if (bp_info->addr >= TASK_SIZE)
1330                 return -EIO;
1331         if (mode == PPC_BREAKPOINT_MODE_MASK) {
1332                 /*
1333                  * dac2 is a bitmask.  Don't allow a mask that makes a
1334                  * kernel space address from a valid dac1 value
1335                  */
1336                 if (~((unsigned long)bp_info->addr2) >= TASK_SIZE)
1337                         return -EIO;
1338         } else {
1339                 /*
1340                  * For range breakpoints, addr2 must also be a valid address
1341                  */
1342                 if (bp_info->addr2 >= TASK_SIZE)
1343                         return -EIO;
1344         }
1345
1346         if (child->thread.dbcr0 &
1347             (DBCR0_DAC1R | DBCR0_DAC1W | DBCR0_DAC2R | DBCR0_DAC2W))
1348                 return -ENOSPC;
1349
1350         if (bp_info->trigger_type & PPC_BREAKPOINT_TRIGGER_READ)
1351                 child->thread.dbcr0 |= (DBCR0_DAC1R | DBCR0_IDM);
1352         if (bp_info->trigger_type & PPC_BREAKPOINT_TRIGGER_WRITE)
1353                 child->thread.dbcr0 |= (DBCR0_DAC1W | DBCR0_IDM);
1354         child->thread.dac1 = bp_info->addr;
1355         child->thread.dac2 = bp_info->addr2;
1356         if (mode == PPC_BREAKPOINT_MODE_RANGE_INCLUSIVE)
1357                 child->thread.dbcr2  |= DBCR2_DAC12M;
1358         else if (mode == PPC_BREAKPOINT_MODE_RANGE_EXCLUSIVE)
1359                 child->thread.dbcr2  |= DBCR2_DAC12MX;
1360         else    /* PPC_BREAKPOINT_MODE_MASK */
1361                 child->thread.dbcr2  |= DBCR2_DAC12MM;
1362         child->thread.regs->msr |= MSR_DE;
1363
1364         return 5;
1365 }
1366 #endif /* CONFIG_PPC_ADV_DEBUG_DAC_RANGE */
1367
1368 static long ppc_set_hwdebug(struct task_struct *child,
1369                      struct ppc_hw_breakpoint *bp_info)
1370 {
1371 #ifdef CONFIG_HAVE_HW_BREAKPOINT
1372         int len = 0;
1373         struct thread_struct *thread = &(child->thread);
1374         struct perf_event *bp;
1375         struct perf_event_attr attr;
1376 #endif /* CONFIG_HAVE_HW_BREAKPOINT */
1377 #ifndef CONFIG_PPC_ADV_DEBUG_REGS
1378         struct arch_hw_breakpoint brk;
1379 #endif
1380
1381         if (bp_info->version != 1)
1382                 return -ENOTSUPP;
1383 #ifdef CONFIG_PPC_ADV_DEBUG_REGS
1384         /*
1385          * Check for invalid flags and combinations
1386          */
1387         if ((bp_info->trigger_type == 0) ||
1388             (bp_info->trigger_type & ~(PPC_BREAKPOINT_TRIGGER_EXECUTE |
1389                                        PPC_BREAKPOINT_TRIGGER_RW)) ||
1390             (bp_info->addr_mode & ~PPC_BREAKPOINT_MODE_MASK) ||
1391             (bp_info->condition_mode &
1392              ~(PPC_BREAKPOINT_CONDITION_MODE |
1393                PPC_BREAKPOINT_CONDITION_BE_ALL)))
1394                 return -EINVAL;
1395 #if CONFIG_PPC_ADV_DEBUG_DVCS == 0
1396         if (bp_info->condition_mode != PPC_BREAKPOINT_CONDITION_NONE)
1397                 return -EINVAL;
1398 #endif
1399
1400         if (bp_info->trigger_type & PPC_BREAKPOINT_TRIGGER_EXECUTE) {
1401                 if ((bp_info->trigger_type != PPC_BREAKPOINT_TRIGGER_EXECUTE) ||
1402                     (bp_info->condition_mode != PPC_BREAKPOINT_CONDITION_NONE))
1403                         return -EINVAL;
1404                 return set_instruction_bp(child, bp_info);
1405         }
1406         if (bp_info->addr_mode == PPC_BREAKPOINT_MODE_EXACT)
1407                 return set_dac(child, bp_info);
1408
1409 #ifdef CONFIG_PPC_ADV_DEBUG_DAC_RANGE
1410         return set_dac_range(child, bp_info);
1411 #else
1412         return -EINVAL;
1413 #endif
1414 #else /* !CONFIG_PPC_ADV_DEBUG_DVCS */
1415         /*
1416          * We only support one data breakpoint
1417          */
1418         if ((bp_info->trigger_type & PPC_BREAKPOINT_TRIGGER_RW) == 0 ||
1419             (bp_info->trigger_type & ~PPC_BREAKPOINT_TRIGGER_RW) != 0 ||
1420             bp_info->condition_mode != PPC_BREAKPOINT_CONDITION_NONE)
1421                 return -EINVAL;
1422
1423         if ((unsigned long)bp_info->addr >= TASK_SIZE)
1424                 return -EIO;
1425
1426         brk.address = bp_info->addr & ~7UL;
1427         brk.type = HW_BRK_TYPE_TRANSLATE;
1428         brk.len = 8;
1429         if (bp_info->trigger_type & PPC_BREAKPOINT_TRIGGER_READ)
1430                 brk.type |= HW_BRK_TYPE_READ;
1431         if (bp_info->trigger_type & PPC_BREAKPOINT_TRIGGER_WRITE)
1432                 brk.type |= HW_BRK_TYPE_WRITE;
1433 #ifdef CONFIG_HAVE_HW_BREAKPOINT
1434         /*
1435          * Check if the request is for 'range' breakpoints. We can
1436          * support it if range < 8 bytes.
1437          */
1438         if (bp_info->addr_mode == PPC_BREAKPOINT_MODE_RANGE_INCLUSIVE)
1439                 len = bp_info->addr2 - bp_info->addr;
1440         else if (bp_info->addr_mode == PPC_BREAKPOINT_MODE_EXACT)
1441                 len = 1;
1442         else
1443                 return -EINVAL;
1444         bp = thread->ptrace_bps[0];
1445         if (bp)
1446                 return -ENOSPC;
1447
1448         /* Create a new breakpoint request if one doesn't exist already */
1449         hw_breakpoint_init(&attr);
1450         attr.bp_addr = (unsigned long)bp_info->addr & ~HW_BREAKPOINT_ALIGN;
1451         attr.bp_len = len;
1452         arch_bp_generic_fields(brk.type, &attr.bp_type);
1453
1454         thread->ptrace_bps[0] = bp = register_user_hw_breakpoint(&attr,
1455                                                ptrace_triggered, NULL, child);
1456         if (IS_ERR(bp)) {
1457                 thread->ptrace_bps[0] = NULL;
1458                 return PTR_ERR(bp);
1459         }
1460
1461         return 1;
1462 #endif /* CONFIG_HAVE_HW_BREAKPOINT */
1463
1464         if (bp_info->addr_mode != PPC_BREAKPOINT_MODE_EXACT)
1465                 return -EINVAL;
1466
1467         if (child->thread.hw_brk.address)
1468                 return -ENOSPC;
1469
1470         child->thread.hw_brk = brk;
1471
1472         return 1;
1473 #endif /* !CONFIG_PPC_ADV_DEBUG_DVCS */
1474 }
1475
1476 static long ppc_del_hwdebug(struct task_struct *child, long data)
1477 {
1478 #ifdef CONFIG_HAVE_HW_BREAKPOINT
1479         int ret = 0;
1480         struct thread_struct *thread = &(child->thread);
1481         struct perf_event *bp;
1482 #endif /* CONFIG_HAVE_HW_BREAKPOINT */
1483 #ifdef CONFIG_PPC_ADV_DEBUG_REGS
1484         int rc;
1485
1486         if (data <= 4)
1487                 rc = del_instruction_bp(child, (int)data);
1488         else
1489                 rc = del_dac(child, (int)data - 4);
1490
1491         if (!rc) {
1492                 if (!DBCR_ACTIVE_EVENTS(child->thread.dbcr0,
1493                                         child->thread.dbcr1)) {
1494                         child->thread.dbcr0 &= ~DBCR0_IDM;
1495                         child->thread.regs->msr &= ~MSR_DE;
1496                 }
1497         }
1498         return rc;
1499 #else
1500         if (data != 1)
1501                 return -EINVAL;
1502
1503 #ifdef CONFIG_HAVE_HW_BREAKPOINT
1504         bp = thread->ptrace_bps[0];
1505         if (bp) {
1506                 unregister_hw_breakpoint(bp);
1507                 thread->ptrace_bps[0] = NULL;
1508         } else
1509                 ret = -ENOENT;
1510         return ret;
1511 #else /* CONFIG_HAVE_HW_BREAKPOINT */
1512         if (child->thread.hw_brk.address == 0)
1513                 return -ENOENT;
1514
1515         child->thread.hw_brk.address = 0;
1516         child->thread.hw_brk.type = 0;
1517 #endif /* CONFIG_HAVE_HW_BREAKPOINT */
1518
1519         return 0;
1520 #endif
1521 }
1522
1523 long arch_ptrace(struct task_struct *child, long request,
1524                  unsigned long addr, unsigned long data)
1525 {
1526         int ret = -EPERM;
1527         void __user *datavp = (void __user *) data;
1528         unsigned long __user *datalp = datavp;
1529
1530         switch (request) {
1531         /* read the word at location addr in the USER area. */
1532         case PTRACE_PEEKUSR: {
1533                 unsigned long index, tmp;
1534
1535                 ret = -EIO;
1536                 /* convert to index and check */
1537 #ifdef CONFIG_PPC32
1538                 index = addr >> 2;
1539                 if ((addr & 3) || (index > PT_FPSCR)
1540                     || (child->thread.regs == NULL))
1541 #else
1542                 index = addr >> 3;
1543                 if ((addr & 7) || (index > PT_FPSCR))
1544 #endif
1545                         break;
1546
1547                 CHECK_FULL_REGS(child->thread.regs);
1548                 if (index < PT_FPR0) {
1549                         ret = ptrace_get_reg(child, (int) index, &tmp);
1550                         if (ret)
1551                                 break;
1552                 } else {
1553                         unsigned int fpidx = index - PT_FPR0;
1554
1555                         flush_fp_to_thread(child);
1556                         if (fpidx < (PT_FPSCR - PT_FPR0))
1557                                 tmp = ((unsigned long *)child->thread.fpr)
1558                                         [fpidx * TS_FPRWIDTH];
1559                         else
1560                                 tmp = child->thread.fpscr.val;
1561                 }
1562                 ret = put_user(tmp, datalp);
1563                 break;
1564         }
1565
1566         /* write the word at location addr in the USER area */
1567         case PTRACE_POKEUSR: {
1568                 unsigned long index;
1569
1570                 ret = -EIO;
1571                 /* convert to index and check */
1572 #ifdef CONFIG_PPC32
1573                 index = addr >> 2;
1574                 if ((addr & 3) || (index > PT_FPSCR)
1575                     || (child->thread.regs == NULL))
1576 #else
1577                 index = addr >> 3;
1578                 if ((addr & 7) || (index > PT_FPSCR))
1579 #endif
1580                         break;
1581
1582                 CHECK_FULL_REGS(child->thread.regs);
1583                 if (index < PT_FPR0) {
1584                         ret = ptrace_put_reg(child, index, data);
1585                 } else {
1586                         unsigned int fpidx = index - PT_FPR0;
1587
1588                         flush_fp_to_thread(child);
1589                         if (fpidx < (PT_FPSCR - PT_FPR0))
1590                                 ((unsigned long *)child->thread.fpr)
1591                                         [fpidx * TS_FPRWIDTH] = data;
1592                         else
1593                                 child->thread.fpscr.val = data;
1594                         ret = 0;
1595                 }
1596                 break;
1597         }
1598
1599         case PPC_PTRACE_GETHWDBGINFO: {
1600                 struct ppc_debug_info dbginfo;
1601
1602                 dbginfo.version = 1;
1603 #ifdef CONFIG_PPC_ADV_DEBUG_REGS
1604                 dbginfo.num_instruction_bps = CONFIG_PPC_ADV_DEBUG_IACS;
1605                 dbginfo.num_data_bps = CONFIG_PPC_ADV_DEBUG_DACS;
1606                 dbginfo.num_condition_regs = CONFIG_PPC_ADV_DEBUG_DVCS;
1607                 dbginfo.data_bp_alignment = 4;
1608                 dbginfo.sizeof_condition = 4;
1609                 dbginfo.features = PPC_DEBUG_FEATURE_INSN_BP_RANGE |
1610                                    PPC_DEBUG_FEATURE_INSN_BP_MASK;
1611 #ifdef CONFIG_PPC_ADV_DEBUG_DAC_RANGE
1612                 dbginfo.features |=
1613                                    PPC_DEBUG_FEATURE_DATA_BP_RANGE |
1614                                    PPC_DEBUG_FEATURE_DATA_BP_MASK;
1615 #endif
1616 #else /* !CONFIG_PPC_ADV_DEBUG_REGS */
1617                 dbginfo.num_instruction_bps = 0;
1618                 dbginfo.num_data_bps = 1;
1619                 dbginfo.num_condition_regs = 0;
1620 #ifdef CONFIG_PPC64
1621                 dbginfo.data_bp_alignment = 8;
1622 #else
1623                 dbginfo.data_bp_alignment = 4;
1624 #endif
1625                 dbginfo.sizeof_condition = 0;
1626 #ifdef CONFIG_HAVE_HW_BREAKPOINT
1627                 dbginfo.features = PPC_DEBUG_FEATURE_DATA_BP_RANGE;
1628                 if (cpu_has_feature(CPU_FTR_DAWR))
1629                         dbginfo.features |= PPC_DEBUG_FEATURE_DATA_BP_DAWR;
1630 #else
1631                 dbginfo.features = 0;
1632 #endif /* CONFIG_HAVE_HW_BREAKPOINT */
1633 #endif /* CONFIG_PPC_ADV_DEBUG_REGS */
1634
1635                 if (!access_ok(VERIFY_WRITE, datavp,
1636                                sizeof(struct ppc_debug_info)))
1637                         return -EFAULT;
1638                 ret = __copy_to_user(datavp, &dbginfo,
1639                                      sizeof(struct ppc_debug_info)) ?
1640                       -EFAULT : 0;
1641                 break;
1642         }
1643
1644         case PPC_PTRACE_SETHWDEBUG: {
1645                 struct ppc_hw_breakpoint bp_info;
1646
1647                 if (!access_ok(VERIFY_READ, datavp,
1648                                sizeof(struct ppc_hw_breakpoint)))
1649                         return -EFAULT;
1650                 ret = __copy_from_user(&bp_info, datavp,
1651                                        sizeof(struct ppc_hw_breakpoint)) ?
1652                       -EFAULT : 0;
1653                 if (!ret)
1654                         ret = ppc_set_hwdebug(child, &bp_info);
1655                 break;
1656         }
1657
1658         case PPC_PTRACE_DELHWDEBUG: {
1659                 ret = ppc_del_hwdebug(child, data);
1660                 break;
1661         }
1662
1663         case PTRACE_GET_DEBUGREG: {
1664 #ifndef CONFIG_PPC_ADV_DEBUG_REGS
1665                 unsigned long dabr_fake;
1666 #endif
1667                 ret = -EINVAL;
1668                 /* We only support one DABR and no IABRS at the moment */
1669                 if (addr > 0)
1670                         break;
1671 #ifdef CONFIG_PPC_ADV_DEBUG_REGS
1672                 ret = put_user(child->thread.dac1, datalp);
1673 #else
1674                 dabr_fake = ((child->thread.hw_brk.address & (~HW_BRK_TYPE_DABR)) |
1675                              (child->thread.hw_brk.type & HW_BRK_TYPE_DABR));
1676                 ret = put_user(dabr_fake, datalp);
1677 #endif
1678                 break;
1679         }
1680
1681         case PTRACE_SET_DEBUGREG:
1682                 ret = ptrace_set_debugreg(child, addr, data);
1683                 break;
1684
1685 #ifdef CONFIG_PPC64
1686         case PTRACE_GETREGS64:
1687 #endif
1688         case PTRACE_GETREGS:    /* Get all pt_regs from the child. */
1689                 return copy_regset_to_user(child, &user_ppc_native_view,
1690                                            REGSET_GPR,
1691                                            0, sizeof(struct pt_regs),
1692                                            datavp);
1693
1694 #ifdef CONFIG_PPC64
1695         case PTRACE_SETREGS64:
1696 #endif
1697         case PTRACE_SETREGS:    /* Set all gp regs in the child. */
1698                 return copy_regset_from_user(child, &user_ppc_native_view,
1699                                              REGSET_GPR,
1700                                              0, sizeof(struct pt_regs),
1701                                              datavp);
1702
1703         case PTRACE_GETFPREGS: /* Get the child FPU state (FPR0...31 + FPSCR) */
1704                 return copy_regset_to_user(child, &user_ppc_native_view,
1705                                            REGSET_FPR,
1706                                            0, sizeof(elf_fpregset_t),
1707                                            datavp);
1708
1709         case PTRACE_SETFPREGS: /* Set the child FPU state (FPR0...31 + FPSCR) */
1710                 return copy_regset_from_user(child, &user_ppc_native_view,
1711                                              REGSET_FPR,
1712                                              0, sizeof(elf_fpregset_t),
1713                                              datavp);
1714
1715 #ifdef CONFIG_ALTIVEC
1716         case PTRACE_GETVRREGS:
1717                 return copy_regset_to_user(child, &user_ppc_native_view,
1718                                            REGSET_VMX,
1719                                            0, (33 * sizeof(vector128) +
1720                                                sizeof(u32)),
1721                                            datavp);
1722
1723         case PTRACE_SETVRREGS:
1724                 return copy_regset_from_user(child, &user_ppc_native_view,
1725                                              REGSET_VMX,
1726                                              0, (33 * sizeof(vector128) +
1727                                                  sizeof(u32)),
1728                                              datavp);
1729 #endif
1730 #ifdef CONFIG_VSX
1731         case PTRACE_GETVSRREGS:
1732                 return copy_regset_to_user(child, &user_ppc_native_view,
1733                                            REGSET_VSX,
1734                                            0, 32 * sizeof(double),
1735                                            datavp);
1736
1737         case PTRACE_SETVSRREGS:
1738                 return copy_regset_from_user(child, &user_ppc_native_view,
1739                                              REGSET_VSX,
1740                                              0, 32 * sizeof(double),
1741                                              datavp);
1742 #endif
1743 #ifdef CONFIG_SPE
1744         case PTRACE_GETEVRREGS:
1745                 /* Get the child spe register state. */
1746                 return copy_regset_to_user(child, &user_ppc_native_view,
1747                                            REGSET_SPE, 0, 35 * sizeof(u32),
1748                                            datavp);
1749
1750         case PTRACE_SETEVRREGS:
1751                 /* Set the child spe register state. */
1752                 return copy_regset_from_user(child, &user_ppc_native_view,
1753                                              REGSET_SPE, 0, 35 * sizeof(u32),
1754                                              datavp);
1755 #endif
1756
1757         default:
1758                 ret = ptrace_request(child, request, addr, data);
1759                 break;
1760         }
1761         return ret;
1762 }
1763
1764 /*
1765  * We must return the syscall number to actually look up in the table.
1766  * This can be -1L to skip running any syscall at all.
1767  */
1768 long do_syscall_trace_enter(struct pt_regs *regs)
1769 {
1770         long ret = 0;
1771
1772         user_exit();
1773
1774         secure_computing_strict(regs->gpr[0]);
1775
1776         if (test_thread_flag(TIF_SYSCALL_TRACE) &&
1777             tracehook_report_syscall_entry(regs))
1778                 /*
1779                  * Tracing decided this syscall should not happen.
1780                  * We'll return a bogus call number to get an ENOSYS
1781                  * error, but leave the original number in regs->gpr[0].
1782                  */
1783                 ret = -1L;
1784
1785         if (unlikely(test_thread_flag(TIF_SYSCALL_TRACEPOINT)))
1786                 trace_sys_enter(regs, regs->gpr[0]);
1787
1788 #ifdef CONFIG_PPC64
1789         if (!is_32bit_task())
1790                 audit_syscall_entry(AUDIT_ARCH_PPC64,
1791                                     regs->gpr[0],
1792                                     regs->gpr[3], regs->gpr[4],
1793                                     regs->gpr[5], regs->gpr[6]);
1794         else
1795 #endif
1796                 audit_syscall_entry(AUDIT_ARCH_PPC,
1797                                     regs->gpr[0],
1798                                     regs->gpr[3] & 0xffffffff,
1799                                     regs->gpr[4] & 0xffffffff,
1800                                     regs->gpr[5] & 0xffffffff,
1801                                     regs->gpr[6] & 0xffffffff);
1802
1803         return ret ?: regs->gpr[0];
1804 }
1805
1806 void do_syscall_trace_leave(struct pt_regs *regs)
1807 {
1808         int step;
1809
1810         audit_syscall_exit(regs);
1811
1812         if (unlikely(test_thread_flag(TIF_SYSCALL_TRACEPOINT)))
1813                 trace_sys_exit(regs, regs->result);
1814
1815         step = test_thread_flag(TIF_SINGLESTEP);
1816         if (step || test_thread_flag(TIF_SYSCALL_TRACE))
1817                 tracehook_report_syscall_exit(regs, step);
1818
1819         user_enter();
1820 }