| Jeff Dike | ba180fd | 2007-10-16 01:27:00 -0700 | [diff] [blame] | 1 | /* | 
 | 2 |  * Copyright (C) 2000 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3 |  * Licensed under the GPL | 
 | 4 |  */ | 
 | 5 |  | 
| Bodo Stroesser | 81efcd3 | 2006-03-27 01:14:34 -0800 | [diff] [blame] | 6 | #include "linux/mm.h" | 
| Jeff Dike | ba180fd | 2007-10-16 01:27:00 -0700 | [diff] [blame] | 7 | #include "linux/sched.h" | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 8 | #include "asm/uaccess.h" | 
| Jeff Dike | e8012b5 | 2007-10-16 01:27:16 -0700 | [diff] [blame] | 9 | #include "skas.h" | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 10 |  | 
| Karol Swietlicki | 291248f | 2008-02-04 22:30:49 -0800 | [diff] [blame] | 11 | extern int arch_switch_tls(struct task_struct *to); | 
| Jeff Dike | 77bf440 | 2007-10-16 01:26:58 -0700 | [diff] [blame] | 12 |  | 
| Karol Swietlicki | 291248f | 2008-02-04 22:30:49 -0800 | [diff] [blame] | 13 | void arch_switch_to(struct task_struct *to) | 
| Paolo 'Blaisorblade' Giarrusso | 972410b | 2006-03-31 02:30:21 -0800 | [diff] [blame] | 14 | { | 
| Karol Swietlicki | 291248f | 2008-02-04 22:30:49 -0800 | [diff] [blame] | 15 | 	int err = arch_switch_tls(to); | 
| Paolo 'Blaisorblade' Giarrusso | 54d8d3b | 2006-03-31 02:30:24 -0800 | [diff] [blame] | 16 | 	if (!err) | 
 | 17 | 		return; | 
 | 18 |  | 
 | 19 | 	if (err != -EINVAL) | 
| Jeff Dike | ba180fd | 2007-10-16 01:27:00 -0700 | [diff] [blame] | 20 | 		printk(KERN_WARNING "arch_switch_tls failed, errno %d, " | 
 | 21 | 		       "not EINVAL\n", -err); | 
| Paolo 'Blaisorblade' Giarrusso | 54d8d3b | 2006-03-31 02:30:24 -0800 | [diff] [blame] | 22 | 	else | 
| Jeff Dike | 77bf440 | 2007-10-16 01:26:58 -0700 | [diff] [blame] | 23 | 		printk(KERN_WARNING "arch_switch_tls failed, errno = EINVAL\n"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 24 | } | 
 | 25 |  | 
 | 26 | int is_syscall(unsigned long addr) | 
 | 27 | { | 
 | 28 | 	unsigned short instr; | 
 | 29 | 	int n; | 
 | 30 |  | 
 | 31 | 	n = copy_from_user(&instr, (void __user *) addr, sizeof(instr)); | 
| Jeff Dike | ba180fd | 2007-10-16 01:27:00 -0700 | [diff] [blame] | 32 | 	if (n) { | 
| Bodo Stroesser | 81efcd3 | 2006-03-27 01:14:34 -0800 | [diff] [blame] | 33 | 		/* access_process_vm() grants access to vsyscall and stub, | 
 | 34 | 		 * while copy_from_user doesn't. Maybe access_process_vm is | 
 | 35 | 		 * slow, but that doesn't matter, since it will be called only | 
 | 36 | 		 * in case of singlestepping, if copy_from_user failed. | 
 | 37 | 		 */ | 
 | 38 | 		n = access_process_vm(current, addr, &instr, sizeof(instr), 0); | 
| Jeff Dike | ba180fd | 2007-10-16 01:27:00 -0700 | [diff] [blame] | 39 | 		if (n != sizeof(instr)) { | 
 | 40 | 			printk(KERN_ERR "is_syscall : failed to read " | 
 | 41 | 			       "instruction from 0x%lx\n", addr); | 
 | 42 | 			return 1; | 
| Bodo Stroesser | 81efcd3 | 2006-03-27 01:14:34 -0800 | [diff] [blame] | 43 | 		} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 44 | 	} | 
 | 45 | 	/* int 0x80 or sysenter */ | 
| Jeff Dike | ba180fd | 2007-10-16 01:27:00 -0700 | [diff] [blame] | 46 | 	return (instr == 0x80cd) || (instr == 0x340f); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 47 | } | 
 | 48 |  | 
 | 49 | /* determines which flags the user has access to. */ | 
 | 50 | /* 1 = access 0 = no access */ | 
 | 51 | #define FLAG_MASK 0x00044dd5 | 
 | 52 |  | 
 | 53 | int putreg(struct task_struct *child, int regno, unsigned long value) | 
 | 54 | { | 
 | 55 | 	regno >>= 2; | 
 | 56 | 	switch (regno) { | 
 | 57 | 	case FS: | 
 | 58 | 		if (value && (value & 3) != 3) | 
 | 59 | 			return -EIO; | 
 | 60 | 		PT_REGS_FS(&child->thread.regs) = value; | 
 | 61 | 		return 0; | 
 | 62 | 	case GS: | 
 | 63 | 		if (value && (value & 3) != 3) | 
 | 64 | 			return -EIO; | 
 | 65 | 		PT_REGS_GS(&child->thread.regs) = value; | 
 | 66 | 		return 0; | 
 | 67 | 	case DS: | 
 | 68 | 	case ES: | 
 | 69 | 		if (value && (value & 3) != 3) | 
 | 70 | 			return -EIO; | 
 | 71 | 		value &= 0xffff; | 
 | 72 | 		break; | 
 | 73 | 	case SS: | 
 | 74 | 	case CS: | 
 | 75 | 		if ((value & 3) != 3) | 
 | 76 | 			return -EIO; | 
 | 77 | 		value &= 0xffff; | 
 | 78 | 		break; | 
 | 79 | 	case EFL: | 
 | 80 | 		value &= FLAG_MASK; | 
 | 81 | 		value |= PT_REGS_EFLAGS(&child->thread.regs); | 
 | 82 | 		break; | 
 | 83 | 	} | 
 | 84 | 	PT_REGS_SET(&child->thread.regs, regno, value); | 
 | 85 | 	return 0; | 
 | 86 | } | 
 | 87 |  | 
| Bodo Stroesser | 82c1c11 | 2005-05-06 21:30:46 -0700 | [diff] [blame] | 88 | int poke_user(struct task_struct *child, long addr, long data) | 
 | 89 | { | 
| Jeff Dike | ba180fd | 2007-10-16 01:27:00 -0700 | [diff] [blame] | 90 | 	if ((addr & 3) || addr < 0) | 
 | 91 | 		return -EIO; | 
| Bodo Stroesser | 82c1c11 | 2005-05-06 21:30:46 -0700 | [diff] [blame] | 92 |  | 
| Jeff Dike | ba180fd | 2007-10-16 01:27:00 -0700 | [diff] [blame] | 93 | 	if (addr < MAX_REG_OFFSET) | 
 | 94 | 		return putreg(child, addr, data); | 
 | 95 | 	else if ((addr >= offsetof(struct user, u_debugreg[0])) && | 
 | 96 | 		 (addr <= offsetof(struct user, u_debugreg[7]))) { | 
 | 97 | 		addr -= offsetof(struct user, u_debugreg[0]); | 
 | 98 | 		addr = addr >> 2; | 
 | 99 | 		if ((addr == 4) || (addr == 5)) | 
 | 100 | 			return -EIO; | 
 | 101 | 		child->thread.arch.debugregs[addr] = data; | 
 | 102 | 		return 0; | 
 | 103 | 	} | 
 | 104 | 	return -EIO; | 
| Bodo Stroesser | 82c1c11 | 2005-05-06 21:30:46 -0700 | [diff] [blame] | 105 | } | 
 | 106 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 107 | unsigned long getreg(struct task_struct *child, int regno) | 
 | 108 | { | 
 | 109 | 	unsigned long retval = ~0UL; | 
 | 110 |  | 
 | 111 | 	regno >>= 2; | 
 | 112 | 	switch (regno) { | 
 | 113 | 	case FS: | 
 | 114 | 	case GS: | 
 | 115 | 	case DS: | 
 | 116 | 	case ES: | 
 | 117 | 	case SS: | 
 | 118 | 	case CS: | 
 | 119 | 		retval = 0xffff; | 
 | 120 | 		/* fall through */ | 
 | 121 | 	default: | 
 | 122 | 		retval &= PT_REG(&child->thread.regs, regno); | 
 | 123 | 	} | 
 | 124 | 	return retval; | 
 | 125 | } | 
 | 126 |  | 
| Jeff Dike | ba180fd | 2007-10-16 01:27:00 -0700 | [diff] [blame] | 127 | /* read the word at location addr in the USER area. */ | 
| Bodo Stroesser | 82c1c11 | 2005-05-06 21:30:46 -0700 | [diff] [blame] | 128 | int peek_user(struct task_struct *child, long addr, long data) | 
 | 129 | { | 
| Al Viro | 4d338e1 | 2006-03-31 02:30:15 -0800 | [diff] [blame] | 130 | 	unsigned long tmp; | 
| Bodo Stroesser | 82c1c11 | 2005-05-06 21:30:46 -0700 | [diff] [blame] | 131 |  | 
| Al Viro | 4d338e1 | 2006-03-31 02:30:15 -0800 | [diff] [blame] | 132 | 	if ((addr & 3) || addr < 0) | 
 | 133 | 		return -EIO; | 
| Bodo Stroesser | 82c1c11 | 2005-05-06 21:30:46 -0700 | [diff] [blame] | 134 |  | 
| Al Viro | 4d338e1 | 2006-03-31 02:30:15 -0800 | [diff] [blame] | 135 | 	tmp = 0;  /* Default return condition */ | 
| Jeff Dike | ba180fd | 2007-10-16 01:27:00 -0700 | [diff] [blame] | 136 | 	if (addr < MAX_REG_OFFSET) { | 
| Al Viro | 4d338e1 | 2006-03-31 02:30:15 -0800 | [diff] [blame] | 137 | 		tmp = getreg(child, addr); | 
 | 138 | 	} | 
| Jeff Dike | ba180fd | 2007-10-16 01:27:00 -0700 | [diff] [blame] | 139 | 	else if ((addr >= offsetof(struct user, u_debugreg[0])) && | 
 | 140 | 		 (addr <= offsetof(struct user, u_debugreg[7]))) { | 
| Al Viro | 4d338e1 | 2006-03-31 02:30:15 -0800 | [diff] [blame] | 141 | 		addr -= offsetof(struct user, u_debugreg[0]); | 
 | 142 | 		addr = addr >> 2; | 
 | 143 | 		tmp = child->thread.arch.debugregs[addr]; | 
 | 144 | 	} | 
 | 145 | 	return put_user(tmp, (unsigned long __user *) data); | 
| Bodo Stroesser | 82c1c11 | 2005-05-06 21:30:46 -0700 | [diff] [blame] | 146 | } | 
 | 147 |  | 
| Jeff Dike | e8012b5 | 2007-10-16 01:27:16 -0700 | [diff] [blame] | 148 | int get_fpregs(struct user_i387_struct __user *buf, struct task_struct *child) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 149 | { | 
| Jeff Dike | e8012b5 | 2007-10-16 01:27:16 -0700 | [diff] [blame] | 150 | 	int err, n, cpu = ((struct thread_info *) child->stack)->cpu; | 
| Jeff Dike | 47906dd | 2008-05-12 14:01:50 -0700 | [diff] [blame] | 151 | 	struct user_i387_struct fpregs; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 152 |  | 
| Jeff Dike | 47906dd | 2008-05-12 14:01:50 -0700 | [diff] [blame] | 153 | 	err = save_fp_registers(userspace_pid[cpu], (unsigned long *) &fpregs); | 
| Jeff Dike | ba180fd | 2007-10-16 01:27:00 -0700 | [diff] [blame] | 154 | 	if (err) | 
| Jeff Dike | e8012b5 | 2007-10-16 01:27:16 -0700 | [diff] [blame] | 155 | 		return err; | 
 | 156 |  | 
| Jeff Dike | 47906dd | 2008-05-12 14:01:50 -0700 | [diff] [blame] | 157 | 	n = copy_to_user(buf, &fpregs, sizeof(fpregs)); | 
| Jeff Dike | e8012b5 | 2007-10-16 01:27:16 -0700 | [diff] [blame] | 158 | 	if(n > 0) | 
| Jeff Dike | ba180fd | 2007-10-16 01:27:00 -0700 | [diff] [blame] | 159 | 		return -EFAULT; | 
| Jeff Dike | e8012b5 | 2007-10-16 01:27:16 -0700 | [diff] [blame] | 160 |  | 
 | 161 | 	return n; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 162 | } | 
 | 163 |  | 
| Jeff Dike | e8012b5 | 2007-10-16 01:27:16 -0700 | [diff] [blame] | 164 | int set_fpregs(struct user_i387_struct __user *buf, struct task_struct *child) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 165 | { | 
| Jeff Dike | e8012b5 | 2007-10-16 01:27:16 -0700 | [diff] [blame] | 166 | 	int n, cpu = ((struct thread_info *) child->stack)->cpu; | 
| Jeff Dike | 47906dd | 2008-05-12 14:01:50 -0700 | [diff] [blame] | 167 | 	struct user_i387_struct fpregs; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 168 |  | 
| Jeff Dike | 47906dd | 2008-05-12 14:01:50 -0700 | [diff] [blame] | 169 | 	n = copy_from_user(&fpregs, buf, sizeof(fpregs)); | 
| Jeff Dike | e8012b5 | 2007-10-16 01:27:16 -0700 | [diff] [blame] | 170 | 	if (n > 0) | 
 | 171 | 		return -EFAULT; | 
 | 172 |  | 
| Jeff Dike | 47906dd | 2008-05-12 14:01:50 -0700 | [diff] [blame] | 173 | 	return restore_fp_registers(userspace_pid[cpu], | 
 | 174 | 				    (unsigned long *) &fpregs); | 
| Jeff Dike | e8012b5 | 2007-10-16 01:27:16 -0700 | [diff] [blame] | 175 | } | 
 | 176 |  | 
 | 177 | int get_fpxregs(struct user_fxsr_struct __user *buf, struct task_struct *child) | 
 | 178 | { | 
 | 179 | 	int err, n, cpu = ((struct thread_info *) child->stack)->cpu; | 
| Jeff Dike | 47906dd | 2008-05-12 14:01:50 -0700 | [diff] [blame] | 180 | 	struct user_fxsr_struct fpregs; | 
| Jeff Dike | e8012b5 | 2007-10-16 01:27:16 -0700 | [diff] [blame] | 181 |  | 
| Jeff Dike | 47906dd | 2008-05-12 14:01:50 -0700 | [diff] [blame] | 182 | 	err = save_fpx_registers(userspace_pid[cpu], (unsigned long *) &fpregs); | 
| Jeff Dike | ba180fd | 2007-10-16 01:27:00 -0700 | [diff] [blame] | 183 | 	if (err) | 
| Jeff Dike | e8012b5 | 2007-10-16 01:27:16 -0700 | [diff] [blame] | 184 | 		return err; | 
 | 185 |  | 
| Jeff Dike | 47906dd | 2008-05-12 14:01:50 -0700 | [diff] [blame] | 186 | 	n = copy_to_user(buf, &fpregs, sizeof(fpregs)); | 
| Jeff Dike | e8012b5 | 2007-10-16 01:27:16 -0700 | [diff] [blame] | 187 | 	if(n > 0) | 
| Jeff Dike | ba180fd | 2007-10-16 01:27:00 -0700 | [diff] [blame] | 188 | 		return -EFAULT; | 
| Jeff Dike | e8012b5 | 2007-10-16 01:27:16 -0700 | [diff] [blame] | 189 |  | 
 | 190 | 	return n; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 191 | } | 
 | 192 |  | 
| Jeff Dike | e8012b5 | 2007-10-16 01:27:16 -0700 | [diff] [blame] | 193 | int set_fpxregs(struct user_fxsr_struct __user *buf, struct task_struct *child) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 194 | { | 
| Jeff Dike | e8012b5 | 2007-10-16 01:27:16 -0700 | [diff] [blame] | 195 | 	int n, cpu = ((struct thread_info *) child->stack)->cpu; | 
| Jeff Dike | 47906dd | 2008-05-12 14:01:50 -0700 | [diff] [blame] | 196 | 	struct user_fxsr_struct fpregs; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 197 |  | 
| Jeff Dike | 47906dd | 2008-05-12 14:01:50 -0700 | [diff] [blame] | 198 | 	n = copy_from_user(&fpregs, buf, sizeof(fpregs)); | 
| Jeff Dike | e8012b5 | 2007-10-16 01:27:16 -0700 | [diff] [blame] | 199 | 	if (n > 0) | 
 | 200 | 		return -EFAULT; | 
 | 201 |  | 
| Jeff Dike | 47906dd | 2008-05-12 14:01:50 -0700 | [diff] [blame] | 202 | 	return restore_fpx_registers(userspace_pid[cpu], | 
 | 203 | 				     (unsigned long *) &fpregs); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 204 | } | 
 | 205 |  | 
| Jeff Dike | e8012b5 | 2007-10-16 01:27:16 -0700 | [diff] [blame] | 206 | long subarch_ptrace(struct task_struct *child, long request, long addr, | 
 | 207 | 		    long data) | 
 | 208 | { | 
 | 209 | 	return -EIO; | 
 | 210 | } |