arch/v850/kernel/ptrace.c

   1 /*
   2  * arch/v850/kernel/ptrace.c -- `ptrace' system call
   3  *
   4  *  Copyright (C) 2002,03  NEC Electronics Corporation
   5  *  Copyright (C) 2002,03  Miles Bader <miles@gnu.org>
   6  *
   7  * Derived from arch/mips/kernel/ptrace.c:
   8  *
   9  *  Copyright (C) 1992 Ross Biro
  10  *  Copyright (C) Linus Torvalds
  11  *  Copyright (C) 1994, 95, 96, 97, 98, 2000 Ralf Baechle
  12  *  Copyright (C) 1996 David S. Miller
  13  *  Kevin D. Kissell, kevink@mips.com and Carsten Langgaard, carstenl@mips.com
  14  *  Copyright (C) 1999 MIPS Technologies, Inc.
  15  *
  16  * This file is subject to the terms and conditions of the GNU General
  17  * Public License.  See the file COPYING in the main directory of this
  18  * archive for more details.
  19  */
  20
  21 #include <linux/kernel.h>
  22 #include <linux/mm.h>
  23 #include <linux/sched.h>
  24 #include <linux/smp_lock.h>
  25 #include <linux/ptrace.h>
  26
  27 #include <asm/errno.h>
  28 #include <asm/ptrace.h>
  29 #include <asm/processor.h>
  30 #include <asm/uaccess.h>
  31
  32 /* Returns the address where the register at REG_OFFS in P is stashed away.  */
  33 static v850_reg_t *reg_save_addr (unsigned reg_offs, struct task_struct *t)
  34 {
  35         struct pt_regs *regs;
  36
  37         /* Three basic cases:
  38
  39            (1) A register normally saved before calling the scheduler, is
  40                available in the kernel entry pt_regs structure at the top
  41                of the kernel stack.  The kernel trap/irq exit path takes
  42                care to save/restore almost all registers for ptrace'd
  43                processes.
  44
  45            (2) A call-clobbered register, where the process P entered the
  46                kernel via [syscall] trap, is not stored anywhere; that's
  47                OK, because such registers are not expected to be preserved
  48                when the trap returns anyway (so we don't actually bother to
  49                test for this case).
  50
  51            (3) A few registers not used at all by the kernel, and so
  52                normally never saved except by context-switches, are in the
  53                context switch state.  */
  54
  55         if (reg_offs == PT_CTPC || reg_offs == PT_CTPSW || reg_offs == PT_CTBP)
  56                 /* Register saved during context switch.  */
  57                 regs = thread_saved_regs (t);
  58         else
  59                 /* Register saved during kernel entry (or not available).  */
  60                 regs = task_regs (t);
  61
  62         return (v850_reg_t *)((char *)regs + reg_offs);
  63 }
  64
  65 /* Set the bits SET and clear the bits CLEAR in the v850e DIR
  66    (`debug information register').  Returns the new value of DIR.  */
  67 static inline v850_reg_t set_dir (v850_reg_t set, v850_reg_t clear)
  68 {
  69         register v850_reg_t rval asm ("r10");
  70         register v850_reg_t arg0 asm ("r6") = set;
  71         register v850_reg_t arg1 asm ("r7") = clear;
  72
  73         /* The dbtrap handler has exactly this functionality when called
  74            from kernel mode.  0xf840 is a `dbtrap' insn.  */
  75         asm (".short 0xf840" : "=r" (rval) : "r" (arg0), "r" (arg1));
  76
  77         return rval;
  78 }
  79
  80 /* Makes sure hardware single-stepping is (globally) enabled.
  81    Returns true if successful.  */
  82 static inline int enable_single_stepping (void)
  83 {
  84         static int enabled = 0; /* Remember whether we already did it.  */
  85         if (! enabled) {
  86                 /* Turn on the SE (`single-step enable') bit, 0x100, in the
  87                    DIR (`debug information register').  This may fail if a
  88                    processor doesn't support it or something.  We also try
  89                    to clear bit 0x40 (`INI'), which is necessary to use the
  90                    debug stuff on the v850e2; on the v850e, clearing 0x40
  91                    shouldn't cause any problem.  */
  92                 v850_reg_t dir = set_dir (0x100, 0x40);
  93                 /* Make sure it really got set.  */
  94                 if (dir & 0x100)
  95                         enabled = 1;
  96         }
  97         return enabled;
  98 }
  99
 100 /* Try to set CHILD's single-step flag to VAL.  Returns true if successful.  */
 101 static int set_single_step (struct task_struct *t, int val)
 102 {
 103         v850_reg_t *psw_addr = reg_save_addr(PT_PSW, t);
 104         if (val) {
 105                 /* Make sure single-stepping is enabled.  */
 106                 if (! enable_single_stepping ())
 107                         return 0;
 108                 /* Set T's single-step flag.  */
 109                 *psw_addr |= 0x800;
 110         } else
 111                 *psw_addr &= ~0x800;
 112         return 1;
 113 }
 114
 115 int sys_ptrace(long request, long pid, long addr, long data)
 116 {
 117         struct task_struct *child;
 118         int rval;
 119
 120         lock_kernel();
 121
 122         if (request == PTRACE_TRACEME) {
 123                 /* are we already being traced? */
 124                 if (current->ptrace & PT_PTRACED) {
 125                         rval = -EPERM;
 126                         goto out;
 127                 }
 128                 /* set the ptrace bit in the process flags. */
 129                 current->ptrace |= PT_PTRACED;
 130                 rval = 0;
 131                 goto out;
 132         }
 133         rval = -ESRCH;
 134         read_lock(&tasklist_lock);
 135         child = find_task_by_pid(pid);
 136         if (child)
 137                 get_task_struct(child);
 138         read_unlock(&tasklist_lock);
 139         if (!child)
 140                 goto out;
 141         if (!vx_check(vx_task_xid(child), VX_WATCH|VX_IDENT))
 142                 goto out_tsk;
 143
 144         rval = -EPERM;
 145         if (pid == 1)           /* you may not mess with init */
 146                 goto out_tsk;
 147
 148         if (request == PTRACE_ATTACH) {
 149                 rval = ptrace_attach(child);
 150                 goto out_tsk;
 151         }
 152         rval = -ESRCH;
 153         if (!(child->ptrace & PT_PTRACED))
 154                 goto out_tsk;
 155         if (child->state != TASK_STOPPED) {
 156                 if (request != PTRACE_KILL)
 157                         goto out_tsk;
 158         }
 159         if (child->parent != current)
 160                 goto out_tsk;
 161
 162         switch (request) {
 163                 unsigned long val, copied;
 164
 165         case PTRACE_PEEKTEXT: /* read word at location addr. */
 166         case PTRACE_PEEKDATA:
 167                 copied = access_process_vm(child, addr, &val, sizeof(val), 0);
 168                 rval = -EIO;
 169                 if (copied != sizeof(val))
 170                         break;
 171                 rval = put_user(val, (unsigned long *)data);
 172                 goto out;
 173
 174         case PTRACE_POKETEXT: /* write the word at location addr. */
 175         case PTRACE_POKEDATA:
 176                 rval = 0;
 177                 if (access_process_vm(child, addr, &data, sizeof(data), 1)
 178                     == sizeof(data))
 179                         break;
 180                 rval = -EIO;
 181                 goto out;
 182
 183         /* Read/write the word at location ADDR in the registers.  */
 184         case PTRACE_PEEKUSR:
 185         case PTRACE_POKEUSR:
 186                 rval = 0;
 187                 if (addr >= PT_SIZE && request == PTRACE_PEEKUSR) {
 188                         /* Special requests that don't actually correspond
 189                            to offsets in struct pt_regs.  */
 190                         if (addr == PT_TEXT_ADDR)
 191                                 val = child->mm->start_code;
 192                         else if (addr == PT_DATA_ADDR)
 193                                 val = child->mm->start_data;
 194                         else if (addr == PT_TEXT_LEN)
 195                                 val = child->mm->end_code
 196                                         - child->mm->start_code;
 197                         else
 198                                 rval = -EIO;
 199                 } else if (addr >= 0 && addr < PT_SIZE && (addr & 0x3) == 0) {
 200                         v850_reg_t *reg_addr = reg_save_addr(addr, child);
 201                         if (request == PTRACE_PEEKUSR)
 202                                 val = *reg_addr;
 203                         else
 204                                 *reg_addr = data;
 205                 } else
 206                         rval = -EIO;
 207
 208                 if (rval == 0 && request == PTRACE_PEEKUSR)
 209                         rval = put_user (val, (unsigned long *)data);
 210                 goto out;
 211
 212         /* Continue and stop at next (return from) syscall */
 213         case PTRACE_SYSCALL:
 214         /* Restart after a signal.  */
 215         case PTRACE_CONT:
 216         /* Execute a single instruction. */
 217         case PTRACE_SINGLESTEP:
 218                 rval = -EIO;
 219                 if ((unsigned long) data > _NSIG)
 220                         break;
 221
 222                 /* Turn CHILD's single-step flag on or off.  */
 223                 if (! set_single_step (child, request == PTRACE_SINGLESTEP))
 224                         break;
 225
 226                 if (request == PTRACE_SYSCALL)
 227                         set_tsk_thread_flag(child, TIF_SYSCALL_TRACE);
 228                 else
 229                         clear_tsk_thread_flag(child, TIF_SYSCALL_TRACE);
 230
 231                 child->exit_code = data;
 232                 wake_up_process(child);
 233                 rval = 0;
 234                 break;
 235
 236         /*
 237          * make the child exit.  Best I can do is send it a sigkill.
 238          * perhaps it should be put in the status that it wants to
 239          * exit.
 240          */
 241         case PTRACE_KILL:
 242                 rval = 0;
 243                 if (child->state == TASK_ZOMBIE)        /* already dead */
 244                         break;
 245                 child->exit_code = SIGKILL;
 246                 wake_up_process(child);
 247                 break;
 248
 249         case PTRACE_DETACH: /* detach a process that was attached. */
 250                 set_single_step (child, 0);  /* Clear single-step flag */
 251                 rval = ptrace_detach(child, data);
 252                 break;
 253
 254         default:
 255                 rval = -EIO;
 256                 goto out;
 257         }
 258
 259 out_tsk:
 260         put_task_struct(child);
 261 out:
 262         unlock_kernel();
 263         return rval;
 264 }
 265
 266 asmlinkage void syscall_trace(void)
 267 {
 268         if (!test_thread_flag(TIF_SYSCALL_TRACE))
 269                 return;
 270         if (!(current->ptrace & PT_PTRACED))
 271                 return;
 272         /* The 0x80 provides a way for the tracing parent to distinguish
 273            between a syscall stop and SIGTRAP delivery */
 274         current->exit_code = SIGTRAP | ((current->ptrace & PT_TRACESYSGOOD)
 275                                         ? 0x80 : 0);
 276         current->state = TASK_STOPPED;
 277         notify_parent(current, SIGCHLD);
 278         schedule();
 279         /*
 280          * this isn't the same as continuing with a signal, but it will do
 281          * for normal use.  strace only continues with a signal if the
 282          * stopping signal is not SIGTRAP.  -brl
 283          */
 284         if (current->exit_code) {
 285                 send_sig(current->exit_code, current, 1);
 286                 current->exit_code = 0;
 287         }
 288 }
 289
 290 void ptrace_disable (struct task_struct *child)
 291 {
 292         /* nothing to do */
 293 }