kernel/arch/h8300/kernel/ptrace.c

   1 /*
   2  *  linux/arch/h8300/kernel/ptrace.c
   3  *
   4  *  Copyright 2015 Yoshinori Sato <ysato@users.sourceforge.jp>
   5  *
   6  * This file is subject to the terms and conditions of the GNU General
   7  * Public License.  See the file COPYING in the main directory of
   8  * this archive for more details.
   9  */
  10
  11 #include <linux/kernel.h>
  12 #include <linux/errno.h>
  13 #include <linux/ptrace.h>
  14 #include <linux/audit.h>
  15 #include <linux/tracehook.h>
  16 #include <linux/regset.h>
  17 #include <linux/elf.h>
  18
  19 #define CCR_MASK 0x6f    /* mode/imask not set */
  20 #define EXR_MASK 0x80    /* modify only T */
  21
  22 #define PT_REG(r) offsetof(struct pt_regs, r)
  23
  24 extern void user_disable_single_step(struct task_struct *child);
  25
  26 /* Mapping from PT_xxx to the stack offset at which the register is
  27    saved.  Notice that usp has no stack-slot and needs to be treated
  28    specially (see get_reg/put_reg below). */
  29 static const int register_offset[] = {
  30         PT_REG(er1), PT_REG(er2), PT_REG(er3), PT_REG(er4),
  31         PT_REG(er5), PT_REG(er6), PT_REG(er0), -1,
  32         PT_REG(orig_er0), PT_REG(ccr), PT_REG(pc),
  33 #if defined(CONFIG_CPU_H8S)
  34         PT_REG(exr),
  35 #endif
  36 };
  37
  38 /* read register */
  39 long h8300_get_reg(struct task_struct *task, int regno)
  40 {
  41         switch (regno) {
  42         case PT_USP:
  43                 return task->thread.usp + sizeof(long)*2;
  44         case PT_CCR:
  45         case PT_EXR:
  46             return *(unsigned short *)(task->thread.esp0 +
  47                                        register_offset[regno]);
  48         default:
  49             return *(unsigned long *)(task->thread.esp0 +
  50                                       register_offset[regno]);
  51         }
  52 }
  53
  54 int h8300_put_reg(struct task_struct *task, int regno, unsigned long data)
  55 {
  56         unsigned short oldccr;
  57         unsigned short oldexr;
  58
  59         switch (regno) {
  60         case PT_USP:
  61                 task->thread.usp = data - sizeof(long)*2;
  62         case PT_CCR:
  63                 oldccr = *(unsigned short *)(task->thread.esp0 +
  64                                              register_offset[regno]);
  65                 oldccr &= ~CCR_MASK;
  66                 data &= CCR_MASK;
  67                 data |= oldccr;
  68                 *(unsigned short *)(task->thread.esp0 +
  69                                     register_offset[regno]) = data;
  70                 break;
  71         case PT_EXR:
  72                 oldexr = *(unsigned short *)(task->thread.esp0 +
  73                                              register_offset[regno]);
  74                 oldccr &= ~EXR_MASK;
  75                 data &= EXR_MASK;
  76                 data |= oldexr;
  77                 *(unsigned short *)(task->thread.esp0 +
  78                                     register_offset[regno]) = data;
  79                 break;
  80         default:
  81                 *(unsigned long *)(task->thread.esp0 +
  82                                    register_offset[regno]) = data;
  83                 break;
  84         }
  85         return 0;
  86 }
  87
  88 static int regs_get(struct task_struct *target,
  89                     const struct user_regset *regset,
  90                     unsigned int pos, unsigned int count,
  91                     void *kbuf, void __user *ubuf)
  92 {
  93         int r;
  94         struct user_regs_struct regs;
  95         long *reg = (long *)&regs;
  96
  97         /* build user regs in buffer */
  98         for (r = 0; r < ARRAY_SIZE(register_offset); r++)
  99                 *reg++ = h8300_get_reg(target, r);
 100
 101         return user_regset_copyout(&pos, &count, &kbuf, &ubuf,
 102                                    &regs, 0, sizeof(regs));
 103 }
 104
 105 static int regs_set(struct task_struct *target,
 106                     const struct user_regset *regset,
 107                     unsigned int pos, unsigned int count,
 108                     const void *kbuf, const void __user *ubuf)
 109 {
 110         int r;
 111         int ret;
 112         struct user_regs_struct regs;
 113         long *reg;
 114
 115         /* build user regs in buffer */
 116         for (reg = (long *)&regs, r = 0; r < ARRAY_SIZE(register_offset); r++)
 117                 *reg++ = h8300_get_reg(target, r);
 118
 119         ret = user_regset_copyin(&pos, &count, &kbuf, &ubuf,
 120                                  &regs, 0, sizeof(regs));
 121         if (ret)
 122                 return ret;
 123
 124         /* write back to pt_regs */
 125         for (reg = (long *)&regs, r = 0; r < ARRAY_SIZE(register_offset); r++)
 126                 h8300_put_reg(target, r, *reg++);
 127         return 0;
 128 }
 129
 130 enum h8300_regset {
 131         REGSET_GENERAL,
 132 };
 133
 134 static const struct user_regset h8300_regsets[] = {
 135         [REGSET_GENERAL] = {
 136                 .core_note_type = NT_PRSTATUS,
 137                 .n              = ELF_NGREG,
 138                 .size           = sizeof(long),
 139                 .align          = sizeof(long),
 140                 .get            = regs_get,
 141                 .set            = regs_set,
 142         },
 143 };
 144
 145 static const struct user_regset_view user_h8300_native_view = {
 146         .name = "h8300",
 147         .e_machine = EM_H8_300,
 148         .regsets = h8300_regsets,
 149         .n = ARRAY_SIZE(h8300_regsets),
 150 };
 151
 152 const struct user_regset_view *task_user_regset_view(struct task_struct *task)
 153 {
 154         return &user_h8300_native_view;
 155 }
 156
 157 void ptrace_disable(struct task_struct *child)
 158 {
 159         user_disable_single_step(child);
 160 }
 161
 162 long arch_ptrace(struct task_struct *child, long request,
 163                  unsigned long addr, unsigned long data)
 164 {
 165         int ret;
 166
 167         switch (request) {
 168         default:
 169                 ret = ptrace_request(child, request, addr, data);
 170                 break;
 171         }
 172         return ret;
 173 }
 174
 175 asmlinkage long do_syscall_trace_enter(struct pt_regs *regs)
 176 {
 177         long ret = 0;
 178
 179         if (test_thread_flag(TIF_SYSCALL_TRACE) &&
 180             tracehook_report_syscall_entry(regs))
 181                 /*
 182                  * Tracing decided this syscall should not happen.
 183                  * We'll return a bogus call number to get an ENOSYS
 184                  * error, but leave the original number in regs->regs[0].
 185                  */
 186                 ret = -1L;
 187
 188         audit_syscall_entry(regs->er1, regs->er2, regs->er3,
 189                             regs->er4, regs->er5);
 190
 191         return ret ?: regs->er0;
 192 }
 193
 194 asmlinkage void do_syscall_trace_leave(struct pt_regs *regs)
 195 {
 196         int step;
 197
 198         audit_syscall_exit(regs);
 199
 200         step = test_thread_flag(TIF_SINGLESTEP);
 201         if (step || test_thread_flag(TIF_SYSCALL_TRACE))
 202                 tracehook_report_syscall_exit(regs, step);
 203 }