mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
266 lines
5.5 KiB
266 lines
5.5 KiB
/* |
|
* Copyright 2003 PathScale, Inc. |
|
* Copyright (C) 2003 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com) |
|
* |
|
* Licensed under the GPL |
|
*/ |
|
|
|
#include <linux/mm.h> |
|
#include <linux/sched.h> |
|
#include <linux/errno.h> |
|
#define __FRAME_OFFSETS |
|
#include <asm/ptrace.h> |
|
#include <linux/uaccess.h> |
|
#include <asm/ptrace-abi.h> |
|
|
|
/* |
|
* determines which flags the user has access to. |
|
* 1 = access 0 = no access |
|
*/ |
|
#define FLAG_MASK 0x44dd5UL |
|
|
|
static const int reg_offsets[] = |
|
{ |
|
[R8 >> 3] = HOST_R8, |
|
[R9 >> 3] = HOST_R9, |
|
[R10 >> 3] = HOST_R10, |
|
[R11 >> 3] = HOST_R11, |
|
[R12 >> 3] = HOST_R12, |
|
[R13 >> 3] = HOST_R13, |
|
[R14 >> 3] = HOST_R14, |
|
[R15 >> 3] = HOST_R15, |
|
[RIP >> 3] = HOST_IP, |
|
[RSP >> 3] = HOST_SP, |
|
[RAX >> 3] = HOST_AX, |
|
[RBX >> 3] = HOST_BX, |
|
[RCX >> 3] = HOST_CX, |
|
[RDX >> 3] = HOST_DX, |
|
[RSI >> 3] = HOST_SI, |
|
[RDI >> 3] = HOST_DI, |
|
[RBP >> 3] = HOST_BP, |
|
[CS >> 3] = HOST_CS, |
|
[SS >> 3] = HOST_SS, |
|
[FS_BASE >> 3] = HOST_FS_BASE, |
|
[GS_BASE >> 3] = HOST_GS_BASE, |
|
[DS >> 3] = HOST_DS, |
|
[ES >> 3] = HOST_ES, |
|
[FS >> 3] = HOST_FS, |
|
[GS >> 3] = HOST_GS, |
|
[EFLAGS >> 3] = HOST_EFLAGS, |
|
[ORIG_RAX >> 3] = HOST_ORIG_AX, |
|
}; |
|
|
|
int putreg(struct task_struct *child, int regno, unsigned long value) |
|
{ |
|
switch (regno) { |
|
case R8: |
|
case R9: |
|
case R10: |
|
case R11: |
|
case R12: |
|
case R13: |
|
case R14: |
|
case R15: |
|
case RIP: |
|
case RSP: |
|
case RAX: |
|
case RBX: |
|
case RCX: |
|
case RDX: |
|
case RSI: |
|
case RDI: |
|
case RBP: |
|
break; |
|
|
|
case ORIG_RAX: |
|
/* Update the syscall number. */ |
|
UPT_SYSCALL_NR(&child->thread.regs.regs) = value; |
|
break; |
|
|
|
case FS: |
|
case GS: |
|
case DS: |
|
case ES: |
|
case SS: |
|
case CS: |
|
if (value && (value & 3) != 3) |
|
return -EIO; |
|
value &= 0xffff; |
|
break; |
|
|
|
case FS_BASE: |
|
case GS_BASE: |
|
if (!((value >> 48) == 0 || (value >> 48) == 0xffff)) |
|
return -EIO; |
|
break; |
|
|
|
case EFLAGS: |
|
value &= FLAG_MASK; |
|
child->thread.regs.regs.gp[HOST_EFLAGS] |= value; |
|
return 0; |
|
|
|
default: |
|
panic("Bad register in putreg(): %d\n", regno); |
|
} |
|
|
|
child->thread.regs.regs.gp[reg_offsets[regno >> 3]] = value; |
|
return 0; |
|
} |
|
|
|
int poke_user(struct task_struct *child, long addr, long data) |
|
{ |
|
if ((addr & 3) || addr < 0) |
|
return -EIO; |
|
|
|
if (addr < MAX_REG_OFFSET) |
|
return putreg(child, addr, data); |
|
else if ((addr >= offsetof(struct user, u_debugreg[0])) && |
|
(addr <= offsetof(struct user, u_debugreg[7]))) { |
|
addr -= offsetof(struct user, u_debugreg[0]); |
|
addr = addr >> 3; |
|
if ((addr == 4) || (addr == 5)) |
|
return -EIO; |
|
child->thread.arch.debugregs[addr] = data; |
|
return 0; |
|
} |
|
return -EIO; |
|
} |
|
|
|
unsigned long getreg(struct task_struct *child, int regno) |
|
{ |
|
unsigned long mask = ~0UL; |
|
|
|
switch (regno) { |
|
case R8: |
|
case R9: |
|
case R10: |
|
case R11: |
|
case R12: |
|
case R13: |
|
case R14: |
|
case R15: |
|
case RIP: |
|
case RSP: |
|
case RAX: |
|
case RBX: |
|
case RCX: |
|
case RDX: |
|
case RSI: |
|
case RDI: |
|
case RBP: |
|
case ORIG_RAX: |
|
case EFLAGS: |
|
case FS_BASE: |
|
case GS_BASE: |
|
break; |
|
case FS: |
|
case GS: |
|
case DS: |
|
case ES: |
|
case SS: |
|
case CS: |
|
mask = 0xffff; |
|
break; |
|
default: |
|
panic("Bad register in getreg: %d\n", regno); |
|
} |
|
return mask & child->thread.regs.regs.gp[reg_offsets[regno >> 3]]; |
|
} |
|
|
|
int peek_user(struct task_struct *child, long addr, long data) |
|
{ |
|
/* read the word at location addr in the USER area. */ |
|
unsigned long tmp; |
|
|
|
if ((addr & 3) || addr < 0) |
|
return -EIO; |
|
|
|
tmp = 0; /* Default return condition */ |
|
if (addr < MAX_REG_OFFSET) |
|
tmp = getreg(child, addr); |
|
else if ((addr >= offsetof(struct user, u_debugreg[0])) && |
|
(addr <= offsetof(struct user, u_debugreg[7]))) { |
|
addr -= offsetof(struct user, u_debugreg[0]); |
|
addr = addr >> 2; |
|
tmp = child->thread.arch.debugregs[addr]; |
|
} |
|
return put_user(tmp, (unsigned long *) data); |
|
} |
|
|
|
/* XXX Mostly copied from sys-i386 */ |
|
int is_syscall(unsigned long addr) |
|
{ |
|
unsigned short instr; |
|
int n; |
|
|
|
n = copy_from_user(&instr, (void __user *) addr, sizeof(instr)); |
|
if (n) { |
|
/* |
|
* access_process_vm() grants access to vsyscall and stub, |
|
* while copy_from_user doesn't. Maybe access_process_vm is |
|
* slow, but that doesn't matter, since it will be called only |
|
* in case of singlestepping, if copy_from_user failed. |
|
*/ |
|
n = access_process_vm(current, addr, &instr, sizeof(instr), |
|
FOLL_FORCE); |
|
if (n != sizeof(instr)) { |
|
printk("is_syscall : failed to read instruction from " |
|
"0x%lx\n", addr); |
|
return 1; |
|
} |
|
} |
|
/* sysenter */ |
|
return instr == 0x050f; |
|
} |
|
|
|
static int get_fpregs(struct user_i387_struct __user *buf, struct task_struct *child) |
|
{ |
|
int err, n, cpu = ((struct thread_info *) child->stack)->cpu; |
|
struct user_i387_struct fpregs; |
|
|
|
err = save_i387_registers(userspace_pid[cpu], |
|
(unsigned long *) &fpregs); |
|
if (err) |
|
return err; |
|
|
|
n = copy_to_user(buf, &fpregs, sizeof(fpregs)); |
|
if (n > 0) |
|
return -EFAULT; |
|
|
|
return n; |
|
} |
|
|
|
static int set_fpregs(struct user_i387_struct __user *buf, struct task_struct *child) |
|
{ |
|
int n, cpu = ((struct thread_info *) child->stack)->cpu; |
|
struct user_i387_struct fpregs; |
|
|
|
n = copy_from_user(&fpregs, buf, sizeof(fpregs)); |
|
if (n > 0) |
|
return -EFAULT; |
|
|
|
return restore_i387_registers(userspace_pid[cpu], |
|
(unsigned long *) &fpregs); |
|
} |
|
|
|
long subarch_ptrace(struct task_struct *child, long request, |
|
unsigned long addr, unsigned long data) |
|
{ |
|
int ret = -EIO; |
|
void __user *datap = (void __user *) data; |
|
|
|
switch (request) { |
|
case PTRACE_GETFPREGS: /* Get the child FPU state. */ |
|
ret = get_fpregs(datap, child); |
|
break; |
|
case PTRACE_SETFPREGS: /* Set the child FPU state. */ |
|
ret = set_fpregs(datap, child); |
|
break; |
|
case PTRACE_ARCH_PRCTL: |
|
/* XXX Calls ptrace on the host - needs some SMP thinking */ |
|
ret = arch_prctl(child, data, (void __user *) addr); |
|
break; |
|
} |
|
|
|
return ret; |
|
}
|
|
|