|  | /* | 
|  | * Copyright (C) 2000 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com) | 
|  | * Licensed under the GPL | 
|  | */ | 
|  |  | 
|  | #include "linux/mm.h" | 
|  | #include "linux/sched.h" | 
|  | #include "asm/uaccess.h" | 
|  | #include "skas.h" | 
|  |  | 
|  | extern int arch_switch_tls(struct task_struct *to); | 
|  |  | 
|  | void arch_switch_to(struct task_struct *to) | 
|  | { | 
|  | int err = arch_switch_tls(to); | 
|  | if (!err) | 
|  | return; | 
|  |  | 
|  | if (err != -EINVAL) | 
|  | printk(KERN_WARNING "arch_switch_tls failed, errno %d, " | 
|  | "not EINVAL\n", -err); | 
|  | else | 
|  | printk(KERN_WARNING "arch_switch_tls failed, errno = EINVAL\n"); | 
|  | } | 
|  |  | 
|  | 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), 0); | 
|  | if (n != sizeof(instr)) { | 
|  | printk(KERN_ERR "is_syscall : failed to read " | 
|  | "instruction from 0x%lx\n", addr); | 
|  | return 1; | 
|  | } | 
|  | } | 
|  | /* int 0x80 or sysenter */ | 
|  | return (instr == 0x80cd) || (instr == 0x340f); | 
|  | } | 
|  |  | 
|  | /* determines which flags the user has access to. */ | 
|  | /* 1 = access 0 = no access */ | 
|  | #define FLAG_MASK 0x00044dd5 | 
|  |  | 
|  | int putreg(struct task_struct *child, int regno, unsigned long value) | 
|  | { | 
|  | regno >>= 2; | 
|  | switch (regno) { | 
|  | case FS: | 
|  | if (value && (value & 3) != 3) | 
|  | return -EIO; | 
|  | PT_REGS_FS(&child->thread.regs) = value; | 
|  | return 0; | 
|  | case GS: | 
|  | if (value && (value & 3) != 3) | 
|  | return -EIO; | 
|  | PT_REGS_GS(&child->thread.regs) = value; | 
|  | return 0; | 
|  | case DS: | 
|  | case ES: | 
|  | if (value && (value & 3) != 3) | 
|  | return -EIO; | 
|  | value &= 0xffff; | 
|  | break; | 
|  | case SS: | 
|  | case CS: | 
|  | if ((value & 3) != 3) | 
|  | return -EIO; | 
|  | value &= 0xffff; | 
|  | break; | 
|  | case EFL: | 
|  | value &= FLAG_MASK; | 
|  | value |= PT_REGS_EFLAGS(&child->thread.regs); | 
|  | break; | 
|  | } | 
|  | PT_REGS_SET(&child->thread.regs, regno, 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 >> 2; | 
|  | 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 retval = ~0UL; | 
|  |  | 
|  | regno >>= 2; | 
|  | switch (regno) { | 
|  | case FS: | 
|  | case GS: | 
|  | case DS: | 
|  | case ES: | 
|  | case SS: | 
|  | case CS: | 
|  | retval = 0xffff; | 
|  | /* fall through */ | 
|  | default: | 
|  | retval &= PT_REG(&child->thread.regs, regno); | 
|  | } | 
|  | return retval; | 
|  | } | 
|  |  | 
|  | /* read the word at location addr in the USER area. */ | 
|  | int peek_user(struct task_struct *child, long addr, long data) | 
|  | { | 
|  | 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 __user *) data); | 
|  | } | 
|  |  | 
|  | 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_fp_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; | 
|  | } | 
|  |  | 
|  | 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_fp_registers(userspace_pid[cpu], | 
|  | (unsigned long *) &fpregs); | 
|  | } | 
|  |  | 
|  | int get_fpxregs(struct user_fxsr_struct __user *buf, struct task_struct *child) | 
|  | { | 
|  | int err, n, cpu = ((struct thread_info *) child->stack)->cpu; | 
|  | struct user_fxsr_struct fpregs; | 
|  |  | 
|  | err = save_fpx_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; | 
|  | } | 
|  |  | 
|  | int set_fpxregs(struct user_fxsr_struct __user *buf, struct task_struct *child) | 
|  | { | 
|  | int n, cpu = ((struct thread_info *) child->stack)->cpu; | 
|  | struct user_fxsr_struct fpregs; | 
|  |  | 
|  | n = copy_from_user(&fpregs, buf, sizeof(fpregs)); | 
|  | if (n > 0) | 
|  | return -EFAULT; | 
|  |  | 
|  | return restore_fpx_registers(userspace_pid[cpu], | 
|  | (unsigned long *) &fpregs); | 
|  | } | 
|  |  | 
|  | long subarch_ptrace(struct task_struct *child, long request, | 
|  | unsigned long addr, unsigned long data) | 
|  | { | 
|  | return -EIO; | 
|  | } |