Quelle  ptrace32.c   Sprache: C

/*
 * ptrace for 32-bit processes running on a 64-bit kernel.
 *
 *  PowerPC version
 *    Copyright (C) 1995-1996 Gary Thomas (gdt@linuxppc.org)
 *
 *  Derived from "arch/m68k/kernel/ptrace.c"
 *  Copyright (C) 1994 by Hamish Macdonald
 *  Taken from linux/kernel/ptrace.c and modified for M680x0.
 *  linux/kernel/ptrace.c is by Ross Biro 1/23/92, edited by Linus Torvalds
 *
 * Modified by Cort Dougan (cort@hq.fsmlabs.com)
 * and Paul Mackerras (paulus@samba.org).
 *
 * This file is subject to the terms and conditions of the GNU General
 * Public License.  See the file COPYING in the main directory of
 * this archive for more details.
 */

#include <linux/ptrace.h>
#include <linux/regset.h>
#include <linux/compat.h>

#include <asm/switch_to.h>

#include "ptrace-decl.h"

/*
 * does not yet catch signals sent when the child dies.
 * in exit.c or in signal.c.
 */

/* Macros to workout the correct index for the FPR in the thread struct */
#define FPRNUMBER(i) (((i) - PT_FPR0) >> 1)
#define FPRHALF(i) (((i) - PT_FPR0) & 1)
#define FPRINDEX(i) TS_FPRWIDTH * FPRNUMBER(i) * 2 + FPRHALF(i)

long compat_arch_ptrace(struct task_struct *child, compat_long_t request,
   compat_ulong_t caddr, compat_ulong_t cdata)
{
 unsigned long addr = caddr;
 unsigned long data = cdata;
 int ret;

 switch (request) {
 /*
  * Read 4 bytes of the other process' storage
  *  data is a pointer specifying where the user wants the
  * 4 bytes copied into
  *  addr is a pointer in the user's storage that contains an 8 byte
  * address in the other process of the 4 bytes that is to be read
  * (this is run in a 32-bit process looking at a 64-bit process)
  * when I and D space are separate, these will need to be fixed.
 */
 case PPC_PTRACE_PEEKTEXT_3264:
 case PPC_PTRACE_PEEKDATA_3264: {
  u32 tmp;
  int copied;
  u32 __user * addrOthers;

  ret = -EIO;

  /* Get the addr in the other process that we want to read */
  if (get_user(addrOthers, (u32 __user * __user *)addr) != 0)
   break;

  copied = ptrace_access_vm(child, (u64)addrOthers, &tmp,
    sizeof(tmp), FOLL_FORCE);
  if (copied != sizeof(tmp))
   break;
  ret = put_user(tmp, (u32 __user *)data);
  break;
 }

 /* Read a register (specified by ADDR) out of the "user area" */
 case PTRACE_PEEKUSR: {
  int index;
  unsigned long tmp;

  ret = -EIO;
  /* convert to index and check */
  index = (unsigned long) addr >> 2;
  if ((addr & 3) || (index > PT_FPSCR32))
   break;

  if (index < PT_FPR0) {
   ret = ptrace_get_reg(child, index, &tmp);
   if (ret)
    break;
  } else {
   flush_fp_to_thread(child);
   /*
    * the user space code considers the floating point
    * to be an array of unsigned int (32 bits) - the
    * index passed in is based on this assumption.
 */
   tmp = ((unsigned int *)child->thread.fp_state.fpr)
    [FPRINDEX(index)];
  }
  ret = put_user((unsigned int)tmp, (u32 __user *)data);
  break;
 }
  
 /*
  * Read 4 bytes out of the other process' pt_regs area
  *  data is a pointer specifying where the user wants the
  * 4 bytes copied into
  *  addr is the offset into the other process' pt_regs structure
  * that is to be read
  * (this is run in a 32-bit process looking at a 64-bit process)
 */
 case PPC_PTRACE_PEEKUSR_3264: {
  u32 index;
  u32 reg32bits;
  u64 tmp;
  u32 numReg;
  u32 part;

  ret = -EIO;
  /* Determine which register the user wants */
  index = (u64)addr >> 2;
  numReg = index / 2;
  /* Determine which part of the register the user wants */
  if (index % 2)
   part = 1;  /* want the 2nd half of the register (right-most). */
  else
   part = 0;  /* want the 1st half of the register (left-most). */

  /* Validate the input - check to see if address is on the wrong boundary
   * or beyond the end of the user area
 */
  if ((addr & 3) || numReg > PT_FPSCR)
   break;

  if (numReg >= PT_FPR0) {
   flush_fp_to_thread(child);
   /* get 64 bit FPR */
   tmp = child->thread.fp_state.fpr[numReg - PT_FPR0][0];
  } else { /* register within PT_REGS struct */
   unsigned long tmp2;
   ret = ptrace_get_reg(child, numReg, &tmp2);
   if (ret)
    break;
   tmp = tmp2;
  } 
  reg32bits = ((u32*)&tmp)[part];
  ret = put_user(reg32bits, (u32 __user *)data);
  break;
 }

 /*
  * Write 4 bytes into the other process' storage
  *  data is the 4 bytes that the user wants written
  *  addr is a pointer in the user's storage that contains an
  * 8 byte address in the other process where the 4 bytes
  * that is to be written
  * (this is run in a 32-bit process looking at a 64-bit process)
  * when I and D space are separate, these will need to be fixed.
 */
 case PPC_PTRACE_POKETEXT_3264:
 case PPC_PTRACE_POKEDATA_3264: {
  u32 tmp = data;
  u32 __user * addrOthers;

  /* Get the addr in the other process that we want to write into */
  ret = -EIO;
  if (get_user(addrOthers, (u32 __user * __user *)addr) != 0)
   break;
  ret = 0;
  if (ptrace_access_vm(child, (u64)addrOthers, &tmp,
     sizeof(tmp),
     FOLL_FORCE | FOLL_WRITE) == sizeof(tmp))
   break;
  ret = -EIO;
  break;
 }

 /* write the word at location addr in the USER area */
 case PTRACE_POKEUSR: {
  unsigned long index;

  ret = -EIO;
  /* convert to index and check */
  index = (unsigned long) addr >> 2;
  if ((addr & 3) || (index > PT_FPSCR32))
   break;

  if (index < PT_FPR0) {
   ret = ptrace_put_reg(child, index, data);
  } else {
   flush_fp_to_thread(child);
   /*
    * the user space code considers the floating point
    * to be an array of unsigned int (32 bits) - the
    * index passed in is based on this assumption.
 */
   ((unsigned int *)child->thread.fp_state.fpr)
    [FPRINDEX(index)] = data;
   ret = 0;
  }
  break;
 }

 /*
  * Write 4 bytes into the other process' pt_regs area
  *  data is the 4 bytes that the user wants written
  *  addr is the offset into the other process' pt_regs structure
  * that is to be written into
  * (this is run in a 32-bit process looking at a 64-bit process)
 */
 case PPC_PTRACE_POKEUSR_3264: {
  u32 index;
  u32 numReg;

  ret = -EIO;
  /* Determine which register the user wants */
  index = (u64)addr >> 2;
  numReg = index / 2;

  /*
   * Validate the input - check to see if address is on the
   * wrong boundary or beyond the end of the user area
 */
  if ((addr & 3) || (numReg > PT_FPSCR))
   break;
  if (numReg < PT_FPR0) {
   unsigned long freg;
   ret = ptrace_get_reg(child, numReg, &freg);
   if (ret)
    break;
   if (index % 2)
    freg = (freg & ~0xfffffffful) | (data & 0xfffffffful);
   else
    freg = (freg & 0xfffffffful) | (data << 32);
   ret = ptrace_put_reg(child, numReg, freg);
  } else {
   u64 *tmp;
   flush_fp_to_thread(child);
   /* get 64 bit FPR ... */
   tmp = &child->thread.fp_state.fpr[numReg - PT_FPR0][0];
   /* ... write the 32 bit part we want */
   ((u32 *)tmp)[index % 2] = data;
   ret = 0;
  }
  break;
 }

 case PTRACE_GET_DEBUGREG: {
#ifndef CONFIG_PPC_ADV_DEBUG_REGS
  unsigned long dabr_fake;
#endif
  ret = -EINVAL;
  /* We only support one DABR and no IABRS at the moment */
  if (addr > 0)
   break;
#ifdef CONFIG_PPC_ADV_DEBUG_REGS
  ret = put_user(child->thread.debug.dac1, (u32 __user *)data);
#else
  dabr_fake = (
   (child->thread.hw_brk[0].address & (~HW_BRK_TYPE_DABR)) |
   (child->thread.hw_brk[0].type & HW_BRK_TYPE_DABR));
  ret = put_user(dabr_fake, (u32 __user *)data);
#endif
  break;
 }

 case PTRACE_GETREGS: /* Get all pt_regs from the child. */
  return copy_regset_to_user(
   child, task_user_regset_view(current), 0,
   0, PT_REGS_COUNT * sizeof(compat_long_t),
   compat_ptr(data));

 case PTRACE_SETREGS: /* Set all gp regs in the child. */
  return copy_regset_from_user(
   child, task_user_regset_view(current), 0,
   0, PT_REGS_COUNT * sizeof(compat_long_t),
   compat_ptr(data));

 case PTRACE_GETFPREGS:
 case PTRACE_SETFPREGS:
 case PTRACE_GETVRREGS:
 case PTRACE_SETVRREGS:
 case PTRACE_GETVSRREGS:
 case PTRACE_SETVSRREGS:
 case PTRACE_GETREGS64:
 case PTRACE_SETREGS64:
 case PTRACE_KILL:
 case PTRACE_SINGLESTEP:
 case PTRACE_DETACH:
 case PTRACE_SET_DEBUGREG:
 case PTRACE_SYSCALL:
 case PTRACE_CONT:
 case PPC_PTRACE_GETHWDBGINFO:
 case PPC_PTRACE_SETHWDEBUG:
 case PPC_PTRACE_DELHWDEBUG:
  ret = arch_ptrace(child, request, addr, data);
  break;

 default:
  ret = compat_ptrace_request(child, request, addr, data);
  break;
 }

 return ret;
}