ptrace.c
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:7k
源码类别:

Linux/Unix编程

开发平台:

Unix_Linux

  1. /*
  2.  *  linux/arch/ppc64/kernel/ptrace.c
  3.  *
  4.  *  PowerPC version
  5.  *    Copyright (C) 1995-1996 Gary Thomas (gdt@linuxppc.org)
  6.  *
  7.  *  Derived from "arch/m68k/kernel/ptrace.c"
  8.  *  Copyright (C) 1994 by Hamish Macdonald
  9.  *  Taken from linux/kernel/ptrace.c and modified for M680x0.
  10.  *  linux/kernel/ptrace.c is by Ross Biro 1/23/92, edited by Linus Torvalds
  11.  *
  12.  * Modified by Cort Dougan (cort@hq.fsmlabs.com)
  13.  * and Paul Mackerras (paulus@linuxcare.com.au).
  14.  *
  15.  * This file is subject to the terms and conditions of the GNU General
  16.  * Public License.  See the file README.legal in the main directory of
  17.  * this archive for more details.
  18.  */
  19. #include <linux/kernel.h>
  20. #include <linux/sched.h>
  21. #include <linux/mm.h>
  22. #include <linux/smp.h>
  23. #include <linux/smp_lock.h>
  24. #include <linux/errno.h>
  25. #include <linux/ptrace.h>
  26. #include <linux/user.h>
  27. #include <asm/uaccess.h>
  28. #include <asm/page.h>
  29. #include <asm/pgtable.h>
  30. #include <asm/system.h>
  31. /*
  32.  * Set of msr bits that gdb can change on behalf of a process.
  33.  */
  34. #define MSR_DEBUGCHANGE (MSR_FE0 | MSR_SE | MSR_BE | MSR_FE1)
  35. /*
  36.  * does not yet catch signals sent when the child dies.
  37.  * in exit.c or in signal.c.
  38.  */
  39. /*
  40.  * Get contents of register REGNO in task TASK.
  41.  */
  42. static inline unsigned long get_reg(struct task_struct *task, int regno)
  43. {
  44. if (regno < sizeof(struct pt_regs) / sizeof(unsigned long))
  45. return ((unsigned long *)task->thread.regs)[regno];
  46. return (0);
  47. }
  48. /*
  49.  * Write contents of register REGNO in task TASK.
  50.  */
  51. static inline int put_reg(struct task_struct *task, int regno,
  52.   unsigned long data)
  53. {
  54. if (regno < PT_SOFTE) {
  55. if (regno == PT_MSR)
  56. data = (data & MSR_DEBUGCHANGE)
  57. | (task->thread.regs->msr & ~MSR_DEBUGCHANGE);
  58. ((unsigned long *)task->thread.regs)[regno] = data;
  59. return 0;
  60. }
  61. return -EIO;
  62. }
  63. static inline void
  64. set_single_step(struct task_struct *task)
  65. {
  66. struct pt_regs *regs = task->thread.regs;
  67. if (regs != NULL)
  68. regs->msr |= MSR_SE;
  69. }
  70. static inline void
  71. clear_single_step(struct task_struct *task)
  72. {
  73. struct pt_regs *regs = task->thread.regs;
  74. if (regs != NULL)
  75. regs->msr &= ~MSR_SE;
  76. }
  77. /*
  78.  * Called by kernel/ptrace.c when detaching..
  79.  *
  80.  * Make sure single step bits etc are not set.
  81.  */
  82. void ptrace_disable(struct task_struct *child)
  83. {
  84. /* make sure the single step bit is not set. */
  85. clear_single_step(child);
  86. }
  87. int sys_ptrace(long request, long pid, long addr, long data)
  88. {
  89. struct task_struct *child;
  90. int ret = -EPERM;
  91. lock_kernel();
  92. if (request == PTRACE_TRACEME) {
  93. /* are we already being traced? */
  94. if (current->ptrace & PT_PTRACED)
  95. goto out;
  96. /* set the ptrace bit in the process flags. */
  97. current->ptrace |= PT_PTRACED;
  98. ret = 0;
  99. goto out;
  100. }
  101. ret = -ESRCH;
  102. read_lock(&tasklist_lock);
  103. child = find_task_by_pid(pid);
  104. if (child)
  105. get_task_struct(child);
  106. read_unlock(&tasklist_lock);
  107. if (!child)
  108. goto out;
  109. ret = -EPERM;
  110. if (pid == 1) /* you may not mess with init */
  111. goto out_tsk;
  112. if (request == PTRACE_ATTACH) {
  113. ret = ptrace_attach(child);
  114. goto out_tsk;
  115. }
  116. ret = ptrace_check_attach(child, request == PTRACE_KILL);
  117. if (ret < 0)
  118. goto out_tsk;
  119. switch (request) {
  120. /* when I and D space are separate, these will need to be fixed. */
  121. case PTRACE_PEEKTEXT: /* read word at location addr. */ 
  122. case PTRACE_PEEKDATA: {
  123. unsigned long tmp;
  124. int copied;
  125. copied = access_process_vm(child, addr, &tmp, sizeof(tmp), 0);
  126. ret = -EIO;
  127. if (copied != sizeof(tmp))
  128. break;
  129. ret = put_user(tmp,(unsigned long *) data);
  130. break;
  131. }
  132. /* read the word at location addr in the USER area. */
  133. case PTRACE_PEEKUSR: {
  134. unsigned long index;
  135. unsigned long tmp;
  136. ret = -EIO;
  137. /* convert to index and check */
  138. index = (unsigned long) addr >> 3;
  139. if ((addr & 7) || (index > PT_FPSCR))
  140. break;
  141. if (index < PT_FPR0) {
  142. tmp = get_reg(child, (int)index);
  143. } else {
  144. if (child->thread.regs->msr & MSR_FP)
  145. giveup_fpu(child);
  146. tmp = ((unsigned long *)child->thread.fpr)[index - PT_FPR0];
  147. }
  148. ret = put_user(tmp,(unsigned long *) data);
  149. break;
  150. }
  151. /* If I and D space are separate, this will have to be fixed. */
  152. case PTRACE_POKETEXT: /* write the word at location addr. */
  153. case PTRACE_POKEDATA:
  154. ret = 0;
  155. if (access_process_vm(child, addr, &data, sizeof(data), 1)
  156. == sizeof(data))
  157. break;
  158. ret = -EIO;
  159. break;
  160. /* write the word at location addr in the USER area */
  161. case PTRACE_POKEUSR: {
  162. unsigned long index;
  163. ret = -EIO;
  164. /* convert to index and check */
  165. index = (unsigned long) addr >> 3;
  166. if ((addr & 7) || (index > PT_FPSCR))
  167. break;
  168. if (index == PT_ORIG_R3)
  169. break;
  170. if (index < PT_FPR0) {
  171. ret = put_reg(child, index, data);
  172. } else {
  173. if (child->thread.regs->msr & MSR_FP)
  174. giveup_fpu(child);
  175. ((unsigned long *)child->thread.fpr)[index - PT_FPR0] = data;
  176. ret = 0;
  177. }
  178. break;
  179. }
  180. case PTRACE_SYSCALL: /* continue and stop at next (return from) syscall */
  181. case PTRACE_CONT: { /* restart after signal. */
  182. ret = -EIO;
  183. if ((unsigned long) data > _NSIG)
  184. break;
  185. if (request == PTRACE_SYSCALL)
  186. child->ptrace |= PT_TRACESYS;
  187. else
  188. child->ptrace &= ~PT_TRACESYS;
  189. child->exit_code = data;
  190. /* make sure the single step bit is not set. */
  191. clear_single_step(child);
  192. wake_up_process(child);
  193. ret = 0;
  194. break;
  195. }
  196. /*
  197.  * make the child exit.  Best I can do is send it a sigkill.
  198.  * perhaps it should be put in the status that it wants to
  199.  * exit.
  200.  */
  201. case PTRACE_KILL: {
  202. ret = 0;
  203. if (child->state == TASK_ZOMBIE) /* already dead */
  204. break;
  205. child->exit_code = SIGKILL;
  206. /* make sure the single step bit is not set. */
  207. clear_single_step(child);
  208. wake_up_process(child);
  209. break;
  210. }
  211. case PTRACE_SINGLESTEP: {  /* set the trap flag. */
  212. ret = -EIO;
  213. if ((unsigned long) data > _NSIG)
  214. break;
  215. child->ptrace &= ~PT_TRACESYS;
  216. set_single_step(child);
  217. child->exit_code = data;
  218. /* give it a chance to run. */
  219. wake_up_process(child);
  220. ret = 0;
  221. break;
  222. }
  223. case PTRACE_DETACH:
  224. ret = ptrace_detach(child, data);
  225. break;
  226. case PPC_PTRACE_GETREGS: { /* Get GPRs 0 - 31. */
  227. u64 tmp;
  228. u64 cntr;
  229. ret = 0; 
  230. for (cntr=0; cntr<32 && ret==0; ++cntr) {
  231. tmp = ((u64*)child->thread.regs)[cntr];
  232. ret = put_user(tmp, (u64*)(data+cntr));
  233. }
  234. break;
  235. }
  236. case PPC_PTRACE_SETREGS: { /* Set GPRs 0 - 31. */
  237. u64 cntr;
  238. ret = 0; 
  239. for (cntr=0; cntr<32 && ret==0; ++cntr)
  240. ret = put_reg(child, cntr, *(u64*)(data+cntr));
  241. break;
  242. }
  243. case PPC_PTRACE_GETFPREGS: { /* Get FPRs 0 - 31. */
  244. u64 tmp;
  245. u64 cntr;
  246. ret = -EIO;
  247. if (child->thread.regs->msr & MSR_FP)
  248. giveup_fpu(child);
  249. ret = 0; 
  250. for (cntr=0; cntr<32 && ret==0; ++cntr) {
  251. tmp = ((u64*)child->thread.fpr)[cntr];
  252. ret = put_user(tmp, (u64*)(data+cntr));
  253. }
  254. break;
  255. }
  256. case PPC_PTRACE_SETFPREGS: { /* Get FPRs 0 - 31. */
  257. u64 cntr;
  258. ret = -EIO;
  259. if (child->thread.regs->msr & MSR_FP)
  260. giveup_fpu(child);
  261. for (cntr=0; cntr<32; ++cntr)
  262. ((u64*)child->thread.fpr)[cntr] = *(u64*)(data+cntr);
  263. ret = 0; 
  264. break;
  265. }
  266. default:
  267. ret = -EIO;
  268. break;
  269. }
  270. out_tsk:
  271. free_task_struct(child);
  272. out:
  273. unlock_kernel();
  274. return ret;
  275. }
  276. void syscall_trace(void)
  277. {
  278.   if ((current->ptrace & (PT_PTRACED|PT_TRACESYS))
  279. != (PT_PTRACED|PT_TRACESYS))
  280. return;
  281. current->exit_code = SIGTRAP;
  282. current->state = TASK_STOPPED;
  283. notify_parent(current, SIGCHLD);
  284. schedule();
  285. /*
  286.  * this isn't the same as continuing with a signal, but it will do
  287.  * for normal use.  strace only continues with a signal if the
  288.  * stopping signal is not SIGTRAP.  -brl
  289.  */
  290. if (current->exit_code) {
  291. send_sig(current->exit_code, current, 1);
  292. current->exit_code = 0;
  293. }
  294. }