ptrace.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:7k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

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