arch/xtensa/kernel/ptrace.c

   1 /*
   2  * This file is subject to the terms and conditions of the GNU General Public
   3  * License.  See the file "COPYING" in the main directory of this archive
   4  * for more details.
   5  *
   6  * Copyright (C) 2001 - 2007  Tensilica Inc.
   7  *
   8  * Joe Taylor   <[email protected], [email protected]>
   9  * Chris Zankel <[email protected]>
  10  * Scott Foehner<[email protected]>,
  11  * Kevin Chea
  12  * Marc Gauthier<[email protected]> <[email protected]>
  13  */
  14
  15 #include <linux/errno.h>
  16 #include <linux/hw_breakpoint.h>
  17 #include <linux/kernel.h>
  18 #include <linux/mm.h>
  19 #include <linux/perf_event.h>
  20 #include <linux/ptrace.h>
  21 #include <linux/regset.h>
  22 #include <linux/sched.h>
  23 #include <linux/sched/task_stack.h>
  24 #include <linux/security.h>
  25 #include <linux/signal.h>
  26 #include <linux/smp.h>
  27 #include <linux/tracehook.h>
  28 #include <linux/uaccess.h>
  29
  30 #define CREATE_TRACE_POINTS
  31 #include <trace/events/syscalls.h>
  32
  33 #include <asm/coprocessor.h>
  34 #include <asm/elf.h>
  35 #include <asm/page.h>
  36 #include <asm/pgtable.h>
  37 #include <asm/ptrace.h>
  38
  39 static int gpr_get(struct task_struct *target,
  40                    const struct user_regset *regset,
  41                    unsigned int pos, unsigned int count,
  42                    void *kbuf, void __user *ubuf)
  43 {
  44         struct pt_regs *regs = task_pt_regs(target);
  45         struct user_pt_regs newregs = {
  46                 .pc = regs->pc,
  47                 .ps = regs->ps & ~(1 << PS_EXCM_BIT),
  48                 .lbeg = regs->lbeg,
  49                 .lend = regs->lend,
  50                 .lcount = regs->lcount,
  51                 .sar = regs->sar,
  52                 .threadptr = regs->threadptr,
  53                 .windowbase = regs->windowbase,
  54                 .windowstart = regs->windowstart,
  55         };
  56
  57         memcpy(newregs.a,
  58                regs->areg + XCHAL_NUM_AREGS - regs->windowbase * 4,
  59                regs->windowbase * 16);
  60         memcpy(newregs.a + regs->windowbase * 4,
  61                regs->areg,
  62                (WSBITS - regs->windowbase) * 16);
  63
  64         return user_regset_copyout(&pos, &count, &kbuf, &ubuf,
  65                                    &newregs, 0, -1);
  66 }
  67
  68 static int gpr_set(struct task_struct *target,
  69                    const struct user_regset *regset,
  70                    unsigned int pos, unsigned int count,
  71                    const void *kbuf, const void __user *ubuf)
  72 {
  73         int ret;
  74         struct user_pt_regs newregs = {0};
  75         struct pt_regs *regs;
  76         const u32 ps_mask = PS_CALLINC_MASK | PS_OWB_MASK;
  77
  78         ret = user_regset_copyin(&pos, &count, &kbuf, &ubuf, &newregs, 0, -1);
  79         if (ret)
  80                 return ret;
  81
  82         if (newregs.windowbase >= XCHAL_NUM_AREGS / 4)
  83                 return -EINVAL;
  84
  85         regs = task_pt_regs(target);
  86         regs->pc = newregs.pc;
  87         regs->ps = (regs->ps & ~ps_mask) | (newregs.ps & ps_mask);
  88         regs->lbeg = newregs.lbeg;
  89         regs->lend = newregs.lend;
  90         regs->lcount = newregs.lcount;
  91         regs->sar = newregs.sar;
  92         regs->threadptr = newregs.threadptr;
  93
  94         if (newregs.windowbase != regs->windowbase ||
  95             newregs.windowstart != regs->windowstart) {
  96                 u32 rotws, wmask;
  97
  98                 rotws = (((newregs.windowstart |
  99                            (newregs.windowstart << WSBITS)) >>
 100                           newregs.windowbase) &
 101                          ((1 << WSBITS) - 1)) & ~1;
 102                 wmask = ((rotws ? WSBITS + 1 - ffs(rotws) : 0) << 4) |
 103                         (rotws & 0xF) | 1;
 104                 regs->windowbase = newregs.windowbase;
 105                 regs->windowstart = newregs.windowstart;
 106                 regs->wmask = wmask;
 107         }
 108
 109         memcpy(regs->areg + XCHAL_NUM_AREGS - newregs.windowbase * 4,
 110                newregs.a, newregs.windowbase * 16);
 111         memcpy(regs->areg, newregs.a + newregs.windowbase * 4,
 112                (WSBITS - newregs.windowbase) * 16);
 113
 114         return 0;
 115 }
 116
 117 static int tie_get(struct task_struct *target,
 118                    const struct user_regset *regset,
 119                    unsigned int pos, unsigned int count,
 120                    void *kbuf, void __user *ubuf)
 121 {
 122         int ret;
 123         struct pt_regs *regs = task_pt_regs(target);
 124         struct thread_info *ti = task_thread_info(target);
 125         elf_xtregs_t *newregs = kzalloc(sizeof(elf_xtregs_t), GFP_KERNEL);
 126
 127         if (!newregs)
 128                 return -ENOMEM;
 129
 130         newregs->opt = regs->xtregs_opt;
 131         newregs->user = ti->xtregs_user;
 132
 133 #if XTENSA_HAVE_COPROCESSORS
 134         /* Flush all coprocessor registers to memory. */
 135         coprocessor_flush_all(ti);
 136         newregs->cp0 = ti->xtregs_cp.cp0;
 137         newregs->cp1 = ti->xtregs_cp.cp1;
 138         newregs->cp2 = ti->xtregs_cp.cp2;
 139         newregs->cp3 = ti->xtregs_cp.cp3;
 140         newregs->cp4 = ti->xtregs_cp.cp4;
 141         newregs->cp5 = ti->xtregs_cp.cp5;
 142         newregs->cp6 = ti->xtregs_cp.cp6;
 143         newregs->cp7 = ti->xtregs_cp.cp7;
 144 #endif
 145         ret = user_regset_copyout(&pos, &count, &kbuf, &ubuf,
 146                                   newregs, 0, -1);
 147         kfree(newregs);
 148         return ret;
 149 }
 150
 151 static int tie_set(struct task_struct *target,
 152                    const struct user_regset *regset,
 153                    unsigned int pos, unsigned int count,
 154                    const void *kbuf, const void __user *ubuf)
 155 {
 156         int ret;
 157         struct pt_regs *regs = task_pt_regs(target);
 158         struct thread_info *ti = task_thread_info(target);
 159         elf_xtregs_t *newregs = kzalloc(sizeof(elf_xtregs_t), GFP_KERNEL);
 160
 161         if (!newregs)
 162                 return -ENOMEM;
 163
 164         ret = user_regset_copyin(&pos, &count, &kbuf, &ubuf,
 165                                  newregs, 0, -1);
 166
 167         if (ret)
 168                 goto exit;
 169         regs->xtregs_opt = newregs->opt;
 170         ti->xtregs_user = newregs->user;
 171
 172 #if XTENSA_HAVE_COPROCESSORS
 173         /* Flush all coprocessors before we overwrite them. */
 174         coprocessor_flush_all(ti);
 175         coprocessor_release_all(ti);
 176         ti->xtregs_cp.cp0 = newregs->cp0;
 177         ti->xtregs_cp.cp1 = newregs->cp1;
 178         ti->xtregs_cp.cp2 = newregs->cp2;
 179         ti->xtregs_cp.cp3 = newregs->cp3;
 180         ti->xtregs_cp.cp4 = newregs->cp4;
 181         ti->xtregs_cp.cp5 = newregs->cp5;
 182         ti->xtregs_cp.cp6 = newregs->cp6;
 183         ti->xtregs_cp.cp7 = newregs->cp7;
 184 #endif
 185 exit:
 186         kfree(newregs);
 187         return ret;
 188 }
 189
 190 enum xtensa_regset {
 191         REGSET_GPR,
 192         REGSET_TIE,
 193 };
 194
 195 static const struct user_regset xtensa_regsets[] = {
 196         [REGSET_GPR] = {
 197                 .core_note_type = NT_PRSTATUS,
 198                 .n = sizeof(struct user_pt_regs) / sizeof(u32),
 199                 .size = sizeof(u32),
 200                 .align = sizeof(u32),
 201                 .get = gpr_get,
 202                 .set = gpr_set,
 203         },
 204         [REGSET_TIE] = {
 205                 .core_note_type = NT_PRFPREG,
 206                 .n = sizeof(elf_xtregs_t) / sizeof(u32),
 207                 .size = sizeof(u32),
 208                 .align = sizeof(u32),
 209                 .get = tie_get,
 210                 .set = tie_set,
 211         },
 212 };
 213
 214 static const struct user_regset_view user_xtensa_view = {
 215         .name = "xtensa",
 216         .e_machine = EM_XTENSA,
 217         .regsets = xtensa_regsets,
 218         .n = ARRAY_SIZE(xtensa_regsets)
 219 };
 220
 221 const struct user_regset_view *task_user_regset_view(struct task_struct *task)
 222 {
 223         return &user_xtensa_view;
 224 }
 225
 226 void user_enable_single_step(struct task_struct *child)
 227 {
 228         child->ptrace |= PT_SINGLESTEP;
 229 }
 230
 231 void user_disable_single_step(struct task_struct *child)
 232 {
 233         child->ptrace &= ~PT_SINGLESTEP;
 234 }
 235
 236 /*
 237  * Called by kernel/ptrace.c when detaching to disable single stepping.
 238  */
 239
 240 void ptrace_disable(struct task_struct *child)
 241 {
 242         /* Nothing to do.. */
 243 }
 244
 245 static int ptrace_getregs(struct task_struct *child, void __user *uregs)
 246 {
 247         return copy_regset_to_user(child, &user_xtensa_view, REGSET_GPR,
 248                                    0, sizeof(xtensa_gregset_t), uregs);
 249 }
 250
 251 static int ptrace_setregs(struct task_struct *child, void __user *uregs)
 252 {
 253         return copy_regset_from_user(child, &user_xtensa_view, REGSET_GPR,
 254                                      0, sizeof(xtensa_gregset_t), uregs);
 255 }
 256
 257 static int ptrace_getxregs(struct task_struct *child, void __user *uregs)
 258 {
 259         return copy_regset_to_user(child, &user_xtensa_view, REGSET_TIE,
 260                                    0, sizeof(elf_xtregs_t), uregs);
 261 }
 262
 263 static int ptrace_setxregs(struct task_struct *child, void __user *uregs)
 264 {
 265         return copy_regset_from_user(child, &user_xtensa_view, REGSET_TIE,
 266                                      0, sizeof(elf_xtregs_t), uregs);
 267 }
 268
 269 static int ptrace_peekusr(struct task_struct *child, long regno,
 270                           long __user *ret)
 271 {
 272         struct pt_regs *regs;
 273         unsigned long tmp;
 274
 275         regs = task_pt_regs(child);
 276         tmp = 0;  /* Default return value. */
 277
 278         switch(regno) {
 279         case REG_AR_BASE ... REG_AR_BASE + XCHAL_NUM_AREGS - 1:
 280                 tmp = regs->areg[regno - REG_AR_BASE];
 281                 break;
 282
 283         case REG_A_BASE ... REG_A_BASE + 15:
 284                 tmp = regs->areg[regno - REG_A_BASE];
 285                 break;
 286
 287         case REG_PC:
 288                 tmp = regs->pc;
 289                 break;
 290
 291         case REG_PS:
 292                 /* Note: PS.EXCM is not set while user task is running;
 293                  * its being set in regs is for exception handling
 294                  * convenience.
 295                  */
 296                 tmp = (regs->ps & ~(1 << PS_EXCM_BIT));
 297                 break;
 298
 299         case REG_WB:
 300                 break;          /* tmp = 0 */
 301
 302         case REG_WS:
 303                 {
 304                         unsigned long wb = regs->windowbase;
 305                         unsigned long ws = regs->windowstart;
 306                         tmp = ((ws >> wb) | (ws << (WSBITS - wb))) &
 307                                 ((1 << WSBITS) - 1);
 308                         break;
 309                 }
 310         case REG_LBEG:
 311                 tmp = regs->lbeg;
 312                 break;
 313
 314         case REG_LEND:
 315                 tmp = regs->lend;
 316                 break;
 317
 318         case REG_LCOUNT:
 319                 tmp = regs->lcount;
 320                 break;
 321
 322         case REG_SAR:
 323                 tmp = regs->sar;
 324                 break;
 325
 326         case SYSCALL_NR:
 327                 tmp = regs->syscall;
 328                 break;
 329
 330         default:
 331                 return -EIO;
 332         }
 333         return put_user(tmp, ret);
 334 }
 335
 336 static int ptrace_pokeusr(struct task_struct *child, long regno, long val)
 337 {
 338         struct pt_regs *regs;
 339         regs = task_pt_regs(child);
 340
 341         switch (regno) {
 342         case REG_AR_BASE ... REG_AR_BASE + XCHAL_NUM_AREGS - 1:
 343                 regs->areg[regno - REG_AR_BASE] = val;
 344                 break;
 345
 346         case REG_A_BASE ... REG_A_BASE + 15:
 347                 regs->areg[regno - REG_A_BASE] = val;
 348                 break;
 349
 350         case REG_PC:
 351                 regs->pc = val;
 352                 break;
 353
 354         case SYSCALL_NR:
 355                 regs->syscall = val;
 356                 break;
 357
 358         default:
 359                 return -EIO;
 360         }
 361         return 0;
 362 }
 363
 364 #ifdef CONFIG_HAVE_HW_BREAKPOINT
 365 static void ptrace_hbptriggered(struct perf_event *bp,
 366                                 struct perf_sample_data *data,
 367                                 struct pt_regs *regs)
 368 {
 369         int i;
 370         struct arch_hw_breakpoint *bkpt = counter_arch_bp(bp);
 371
 372         if (bp->attr.bp_type & HW_BREAKPOINT_X) {
 373                 for (i = 0; i < XCHAL_NUM_IBREAK; ++i)
 374                         if (current->thread.ptrace_bp[i] == bp)
 375                                 break;
 376                 i <<= 1;
 377         } else {
 378                 for (i = 0; i < XCHAL_NUM_DBREAK; ++i)
 379                         if (current->thread.ptrace_wp[i] == bp)
 380                                 break;
 381                 i = (i << 1) | 1;
 382         }
 383
 384         force_sig_ptrace_errno_trap(i, (void __user *)bkpt->address);
 385 }
 386
 387 static struct perf_event *ptrace_hbp_create(struct task_struct *tsk, int type)
 388 {
 389         struct perf_event_attr attr;
 390
 391         ptrace_breakpoint_init(&attr);
 392
 393         /* Initialise fields to sane defaults. */
 394         attr.bp_addr    = 0;
 395         attr.bp_len     = 1;
 396         attr.bp_type    = type;
 397         attr.disabled   = 1;
 398
 399         return register_user_hw_breakpoint(&attr, ptrace_hbptriggered, NULL,
 400                                            tsk);
 401 }
 402
 403 /*
 404  * Address bit 0 choose instruction (0) or data (1) break register, bits
 405  * 31..1 are the register number.
 406  * Both PTRACE_GETHBPREGS and PTRACE_SETHBPREGS transfer two 32-bit words:
 407  * address (0) and control (1).
 408  * Instruction breakpoint contorl word is 0 to clear breakpoint, 1 to set.
 409  * Data breakpoint control word bit 31 is 'trigger on store', bit 30 is
 410  * 'trigger on load, bits 29..0 are length. Length 0 is used to clear a
 411  * breakpoint. To set a breakpoint length must be a power of 2 in the range
 412  * 1..64 and the address must be length-aligned.
 413  */
 414
 415 static long ptrace_gethbpregs(struct task_struct *child, long addr,
 416                               long __user *datap)
 417 {
 418         struct perf_event *bp;
 419         u32 user_data[2] = {0};
 420         bool dbreak = addr & 1;
 421         unsigned idx = addr >> 1;
 422
 423         if ((!dbreak && idx >= XCHAL_NUM_IBREAK) ||
 424             (dbreak && idx >= XCHAL_NUM_DBREAK))
 425                 return -EINVAL;
 426
 427         if (dbreak)
 428                 bp = child->thread.ptrace_wp[idx];
 429         else
 430                 bp = child->thread.ptrace_bp[idx];
 431
 432         if (bp) {
 433                 user_data[0] = bp->attr.bp_addr;
 434                 user_data[1] = bp->attr.disabled ? 0 : bp->attr.bp_len;
 435                 if (dbreak) {
 436                         if (bp->attr.bp_type & HW_BREAKPOINT_R)
 437                                 user_data[1] |= DBREAKC_LOAD_MASK;
 438                         if (bp->attr.bp_type & HW_BREAKPOINT_W)
 439                                 user_data[1] |= DBREAKC_STOR_MASK;
 440                 }
 441         }
 442
 443         if (copy_to_user(datap, user_data, sizeof(user_data)))
 444                 return -EFAULT;
 445
 446         return 0;
 447 }
 448
 449 static long ptrace_sethbpregs(struct task_struct *child, long addr,
 450                               long __user *datap)
 451 {
 452         struct perf_event *bp;
 453         struct perf_event_attr attr;
 454         u32 user_data[2];
 455         bool dbreak = addr & 1;
 456         unsigned idx = addr >> 1;
 457         int bp_type = 0;
 458
 459         if ((!dbreak && idx >= XCHAL_NUM_IBREAK) ||
 460             (dbreak && idx >= XCHAL_NUM_DBREAK))
 461                 return -EINVAL;
 462
 463         if (copy_from_user(user_data, datap, sizeof(user_data)))
 464                 return -EFAULT;
 465
 466         if (dbreak) {
 467                 bp = child->thread.ptrace_wp[idx];
 468                 if (user_data[1] & DBREAKC_LOAD_MASK)
 469                         bp_type |= HW_BREAKPOINT_R;
 470                 if (user_data[1] & DBREAKC_STOR_MASK)
 471                         bp_type |= HW_BREAKPOINT_W;
 472         } else {
 473                 bp = child->thread.ptrace_bp[idx];
 474                 bp_type = HW_BREAKPOINT_X;
 475         }
 476
 477         if (!bp) {
 478                 bp = ptrace_hbp_create(child,
 479                                        bp_type ? bp_type : HW_BREAKPOINT_RW);
 480                 if (IS_ERR(bp))
 481                         return PTR_ERR(bp);
 482                 if (dbreak)
 483                         child->thread.ptrace_wp[idx] = bp;
 484                 else
 485                         child->thread.ptrace_bp[idx] = bp;
 486         }
 487
 488         attr = bp->attr;
 489         attr.bp_addr = user_data[0];
 490         attr.bp_len = user_data[1] & ~(DBREAKC_LOAD_MASK | DBREAKC_STOR_MASK);
 491         attr.bp_type = bp_type;
 492         attr.disabled = !attr.bp_len;
 493
 494         return modify_user_hw_breakpoint(bp, &attr);
 495 }
 496 #endif
 497
 498 long arch_ptrace(struct task_struct *child, long request,
 499                  unsigned long addr, unsigned long data)
 500 {
 501         int ret = -EPERM;
 502         void __user *datap = (void __user *) data;
 503
 504         switch (request) {
 505         case PTRACE_PEEKUSR:    /* read register specified by addr. */
 506                 ret = ptrace_peekusr(child, addr, datap);
 507                 break;
 508
 509         case PTRACE_POKEUSR:    /* write register specified by addr. */
 510                 ret = ptrace_pokeusr(child, addr, data);
 511                 break;
 512
 513         case PTRACE_GETREGS:
 514                 ret = ptrace_getregs(child, datap);
 515                 break;
 516
 517         case PTRACE_SETREGS:
 518                 ret = ptrace_setregs(child, datap);
 519                 break;
 520
 521         case PTRACE_GETXTREGS:
 522                 ret = ptrace_getxregs(child, datap);
 523                 break;
 524
 525         case PTRACE_SETXTREGS:
 526                 ret = ptrace_setxregs(child, datap);
 527                 break;
 528 #ifdef CONFIG_HAVE_HW_BREAKPOINT
 529         case PTRACE_GETHBPREGS:
 530                 ret = ptrace_gethbpregs(child, addr, datap);
 531                 break;
 532
 533         case PTRACE_SETHBPREGS:
 534                 ret = ptrace_sethbpregs(child, addr, datap);
 535                 break;
 536 #endif
 537         default:
 538                 ret = ptrace_request(child, request, addr, data);
 539                 break;
 540         }
 541
 542         return ret;
 543 }
 544
 545 void do_syscall_trace_leave(struct pt_regs *regs);
 546 int do_syscall_trace_enter(struct pt_regs *regs)
 547 {
 548         if (regs->syscall == NO_SYSCALL)
 549                 regs->areg[2] = -ENOSYS;
 550
 551         if (test_thread_flag(TIF_SYSCALL_TRACE) &&
 552             tracehook_report_syscall_entry(regs)) {
 553                 regs->areg[2] = -ENOSYS;
 554                 regs->syscall = NO_SYSCALL;
 555                 return 0;
 556         }
 557
 558         if (regs->syscall == NO_SYSCALL) {
 559                 do_syscall_trace_leave(regs);
 560                 return 0;
 561         }
 562
 563         if (test_thread_flag(TIF_SYSCALL_TRACEPOINT))
 564                 trace_sys_enter(regs, syscall_get_nr(current, regs));
 565
 566         return 1;
 567 }
 568
 569 void do_syscall_trace_leave(struct pt_regs *regs)
 570 {
 571         int step;
 572
 573         if (test_thread_flag(TIF_SYSCALL_TRACEPOINT))
 574                 trace_sys_exit(regs, regs_return_value(regs));
 575
 576         step = test_thread_flag(TIF_SINGLESTEP);
 577
 578         if (step || test_thread_flag(TIF_SYSCALL_TRACE))
 579                 tracehook_report_syscall_exit(regs, step);
 580 }