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

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.  *  linux/arch/arm/kernel/process.c
  3.  *
  4.  *  Copyright (C) 1996-2000 Russell King - Converted to ARM.
  5.  *  Origional Copyright (C) 1995  Linus Torvalds
  6.  *
  7.  * This program is free software; you can redistribute it and/or modify
  8.  * it under the terms of the GNU General Public License version 2 as
  9.  * published by the Free Software Foundation.
  10.  */
  11. #include <stdarg.h>
  12. #include <linux/config.h>
  13. #include <linux/sched.h>
  14. #include <linux/kernel.h>
  15. #include <linux/mm.h>
  16. #include <linux/stddef.h>
  17. #include <linux/unistd.h>
  18. #include <linux/ptrace.h>
  19. #include <linux/slab.h>
  20. #include <linux/user.h>
  21. #include <linux/delay.h>
  22. #include <linux/reboot.h>
  23. #include <linux/interrupt.h>
  24. #include <linux/init.h>
  25. #include <asm/leds.h>
  26. #include <asm/system.h>
  27. #include <asm/uaccess.h>
  28. /*
  29.  * Values for cpu_do_idle()
  30.  */
  31. #define IDLE_WAIT_SLOW 0
  32. #define IDLE_WAIT_FAST 1
  33. #define IDLE_CLOCK_SLOW 2
  34. #define IDLE_CLOCK_FAST 3
  35. extern const char *processor_modes[];
  36. extern void setup_mm_for_reboot(char mode);
  37. static volatile int hlt_counter;
  38. #include <asm/arch/system.h>
  39. void disable_hlt(void)
  40. {
  41. hlt_counter++;
  42. }
  43. void enable_hlt(void)
  44. {
  45. hlt_counter--;
  46. }
  47. static int __init nohlt_setup(char *__unused)
  48. {
  49. hlt_counter = 1;
  50. return 1;
  51. }
  52. static int __init hlt_setup(char *__unused)
  53. {
  54. hlt_counter = 0;
  55. return 1;
  56. }
  57. __setup("nohlt", nohlt_setup);
  58. __setup("hlt", hlt_setup);
  59. /*
  60.  * The following aren't currently used.
  61.  */
  62. void (*pm_idle)(void);
  63. void (*pm_power_off)(void);
  64. /*
  65.  * The idle thread.  We try to conserve power, while trying to keep
  66.  * overall latency low.  The architecture specific idle is passed
  67.  * a value to indicate the level of "idleness" of the system.
  68.  */
  69. void cpu_idle(void)
  70. {
  71. /* endless idle loop with no priority at all */
  72. init_idle();
  73. current->nice = 20;
  74. current->counter = -100;
  75. while (1) {
  76. void (*idle)(void) = pm_idle;
  77. if (!idle)
  78. idle = arch_idle;
  79. leds_event(led_idle_start);
  80. while (!current->need_resched)
  81. idle();
  82. leds_event(led_idle_end);
  83. schedule();
  84. #ifndef CONFIG_NO_PGT_CACHE
  85. check_pgt_cache();
  86. #endif
  87. }
  88. }
  89. static char reboot_mode = 'h';
  90. int __init reboot_setup(char *str)
  91. {
  92. reboot_mode = str[0];
  93. return 1;
  94. }
  95. __setup("reboot=", reboot_setup);
  96. void machine_halt(void)
  97. {
  98. leds_event(led_halted);
  99. }
  100. void machine_power_off(void)
  101. {
  102. leds_event(led_halted);
  103. if (pm_power_off)
  104. pm_power_off();
  105. }
  106. void machine_restart(char * __unused)
  107. {
  108. /*
  109.  * Clean and disable cache, and turn off interrupts
  110.  */
  111. cpu_proc_fin();
  112. /*
  113.  * Tell the mm system that we are going to reboot -
  114.  * we may need it to insert some 1:1 mappings so that
  115.  * soft boot works.
  116.  */
  117. setup_mm_for_reboot(reboot_mode);
  118. /*
  119.  * Now call the architecture specific reboot code.
  120.  */
  121. arch_reset(reboot_mode);
  122. /*
  123.  * Whoops - the architecture was unable to reboot.
  124.  * Tell the user!
  125.  */
  126. mdelay(1000);
  127. printk("Reboot failed -- System haltedn");
  128. while (1);
  129. }
  130. void show_regs(struct pt_regs * regs)
  131. {
  132. unsigned long flags;
  133. flags = condition_codes(regs);
  134. printk("pc : [<%08lx>]    lr : [<%08lx>]    %sn"
  135.        "sp : %08lx  ip : %08lx  fp : %08lxn",
  136. instruction_pointer(regs),
  137. regs->ARM_lr, print_tainted(), regs->ARM_sp,
  138. regs->ARM_ip, regs->ARM_fp);
  139. printk("r10: %08lx  r9 : %08lx  r8 : %08lxn",
  140. regs->ARM_r10, regs->ARM_r9,
  141. regs->ARM_r8);
  142. printk("r7 : %08lx  r6 : %08lx  r5 : %08lx  r4 : %08lxn",
  143. regs->ARM_r7, regs->ARM_r6,
  144. regs->ARM_r5, regs->ARM_r4);
  145. printk("r3 : %08lx  r2 : %08lx  r1 : %08lx  r0 : %08lxn",
  146. regs->ARM_r3, regs->ARM_r2,
  147. regs->ARM_r1, regs->ARM_r0);
  148. printk("Flags: %c%c%c%c",
  149. flags & CC_N_BIT ? 'N' : 'n',
  150. flags & CC_Z_BIT ? 'Z' : 'z',
  151. flags & CC_C_BIT ? 'C' : 'c',
  152. flags & CC_V_BIT ? 'V' : 'v');
  153. printk("  IRQs %s  FIQs %s  Mode %s%s  Segment %sn",
  154. interrupts_enabled(regs) ? "on" : "off",
  155. fast_interrupts_enabled(regs) ? "on" : "off",
  156. processor_modes[processor_mode(regs)],
  157. thumb_mode(regs) ? " (T)" : "",
  158. get_fs() == get_ds() ? "kernel" : "user");
  159. #if defined(CONFIG_CPU_32)
  160. {
  161. int ctrl, transbase, dac;
  162.   __asm__ (
  163. " mrc p15, 0, %0, c1, c0n"
  164. " mrc p15, 0, %1, c2, c0n"
  165. " mrc p15, 0, %2, c3, c0n"
  166. : "=r" (ctrl), "=r" (transbase), "=r" (dac));
  167. printk("Control: %04X  Table: %08X  DAC: %08Xn",
  168.    ctrl, transbase, dac);
  169. }
  170. #endif
  171. }
  172. void show_fpregs(struct user_fp *regs)
  173. {
  174. int i;
  175. for (i = 0; i < 8; i++) {
  176. unsigned long *p;
  177. char type;
  178. p = (unsigned long *)(regs->fpregs + i);
  179. switch (regs->ftype[i]) {
  180. case 1: type = 'f'; break;
  181. case 2: type = 'd'; break;
  182. case 3: type = 'e'; break;
  183. default: type = '?'; break;
  184. }
  185. if (regs->init_flag)
  186. type = '?';
  187. printk("  f%d(%c): %08lx %08lx %08lx%c",
  188. i, type, p[0], p[1], p[2], i & 1 ? 'n' : ' ');
  189. }
  190. printk("FPSR: %08lx FPCR: %08lxn",
  191. (unsigned long)regs->fpsr,
  192. (unsigned long)regs->fpcr);
  193. }
  194. /*
  195.  * Task structure and kernel stack allocation.
  196.  */
  197. static struct task_struct *task_struct_head;
  198. static unsigned int nr_task_struct;
  199. #ifdef CONFIG_CPU_32
  200. #define EXTRA_TASK_STRUCT 4
  201. #else
  202. #define EXTRA_TASK_STRUCT 0
  203. #endif
  204. struct task_struct *alloc_task_struct(void)
  205. {
  206. struct task_struct *tsk;
  207. if (EXTRA_TASK_STRUCT)
  208. tsk = task_struct_head;
  209. else
  210. tsk = NULL;
  211. if (tsk) {
  212. task_struct_head = tsk->next_task;
  213. nr_task_struct -= 1;
  214. } else
  215. tsk = ll_alloc_task_struct();
  216. #ifdef CONFIG_SYSRQ
  217. /*
  218.  * The stack must be cleared if you want SYSRQ-T to
  219.  * give sensible stack usage information
  220.  */
  221. if (tsk) {
  222. char *p = (char *)tsk;
  223. memzero(p+KERNEL_STACK_SIZE, KERNEL_STACK_SIZE);
  224. }
  225. #endif
  226. return tsk;
  227. }
  228. void __free_task_struct(struct task_struct *p)
  229. {
  230. if (EXTRA_TASK_STRUCT && nr_task_struct < EXTRA_TASK_STRUCT) {
  231. p->next_task = task_struct_head;
  232. task_struct_head = p;
  233. nr_task_struct += 1;
  234. } else
  235. ll_free_task_struct(p);
  236. }
  237. /*
  238.  * Free current thread data structures etc..
  239.  */
  240. void exit_thread(void)
  241. {
  242. }
  243. void flush_thread(void)
  244. {
  245. memset(&current->thread.debug, 0, sizeof(struct debug_info));
  246. memset(&current->thread.fpstate, 0, sizeof(union fp_state));
  247. current->used_math = 0;
  248. current->flags &= ~PF_USEDFPU;
  249. }
  250. void release_thread(struct task_struct *dead_task)
  251. {
  252. }
  253. asmlinkage void ret_from_fork(void) __asm__("ret_from_fork");
  254. int copy_thread(int nr, unsigned long clone_flags, unsigned long esp,
  255. unsigned long unused,
  256. struct task_struct * p, struct pt_regs * regs)
  257. {
  258. struct pt_regs * childregs;
  259. struct context_save_struct * save;
  260. atomic_set(&p->thread.refcount, 1);
  261. childregs = ((struct pt_regs *)((unsigned long)p + 8192 - 8)) - 1;
  262. *childregs = *regs;
  263. childregs->ARM_r0 = 0;
  264. childregs->ARM_sp = esp;
  265. save = ((struct context_save_struct *)(childregs)) - 1;
  266. *save = INIT_CSS;
  267. save->pc |= (unsigned long)ret_from_fork;
  268. p->thread.save = save;
  269. return 0;
  270. }
  271. /*
  272.  * fill in the fpe structure for a core dump...
  273.  */
  274. int dump_fpu (struct pt_regs *regs, struct user_fp *fp)
  275. {
  276. if (current->used_math)
  277. memcpy(fp, &current->thread.fpstate.soft, sizeof (*fp));
  278. return current->used_math;
  279. }
  280. /*
  281.  * fill in the user structure for a core dump..
  282.  */
  283. void dump_thread(struct pt_regs * regs, struct user * dump)
  284. {
  285. struct task_struct *tsk = current;
  286. dump->magic = CMAGIC;
  287. dump->start_code = tsk->mm->start_code;
  288. dump->start_stack = regs->ARM_sp & ~(PAGE_SIZE - 1);
  289. dump->u_tsize = (tsk->mm->end_code - tsk->mm->start_code) >> PAGE_SHIFT;
  290. dump->u_dsize = (tsk->mm->brk - tsk->mm->start_data + PAGE_SIZE - 1) >> PAGE_SHIFT;
  291. dump->u_ssize = 0;
  292. dump->u_debugreg[0] = tsk->thread.debug.bp[0].address;
  293. dump->u_debugreg[1] = tsk->thread.debug.bp[1].address;
  294. dump->u_debugreg[2] = tsk->thread.debug.bp[0].insn;
  295. dump->u_debugreg[3] = tsk->thread.debug.bp[1].insn;
  296. dump->u_debugreg[4] = tsk->thread.debug.nsaved;
  297. if (dump->start_stack < 0x04000000)
  298. dump->u_ssize = (0x04000000 - dump->start_stack) >> PAGE_SHIFT;
  299. dump->regs = *regs;
  300. dump->u_fpvalid = dump_fpu (regs, &dump->u_fp);
  301. }
  302. /*
  303.  * This is the mechanism for creating a new kernel thread.
  304.  *
  305.  * NOTE! Only a kernel-only process(ie the swapper or direct descendants
  306.  * who haven't done an "execve()") should use this: it will work within
  307.  * a system call from a "real" process, but the process memory space will
  308.  * not be free'd until both the parent and the child have exited.
  309.  */
  310. pid_t kernel_thread(int (*fn)(void *), void *arg, unsigned long flags)
  311. {
  312. pid_t __ret;
  313. __asm__ __volatile__(
  314. "orr r0, %1, %2 @ kernel_thread sys_clone n
  315. mov r1, #0 n
  316. "__syscall(clone)" n
  317. movs %0, r0 @ if we are the child n
  318. bne 1f n
  319. mov fp, #0 @ ensure that fp is zero n
  320. mov r0, %4 n
  321. mov lr, pc n
  322. mov pc, %3 n
  323. b sys_exit n
  324. 1: "
  325.         : "=&r" (__ret)
  326.         : "Ir" (flags), "I" (CLONE_VM), "r" (fn), "r" (arg)
  327. : "r0", "r1", "lr"); 
  328. return __ret;
  329. }
  330. /*
  331.  * These bracket the sleeping functions..
  332.  */
  333. extern void scheduling_functions_start_here(void);
  334. extern void scheduling_functions_end_here(void);
  335. #define first_sched ((unsigned long) scheduling_functions_start_here)
  336. #define last_sched ((unsigned long) scheduling_functions_end_here)
  337. unsigned long get_wchan(struct task_struct *p)
  338. {
  339. unsigned long fp, lr;
  340. unsigned long stack_page;
  341. int count = 0;
  342. if (!p || p == current || p->state == TASK_RUNNING)
  343. return 0;
  344. stack_page = 4096 + (unsigned long)p;
  345. fp = get_css_fp(&p->thread);
  346. do {
  347. if (fp < stack_page || fp > 4092+stack_page)
  348. return 0;
  349. lr = pc_pointer (((unsigned long *)fp)[-1]);
  350. if (lr < first_sched || lr > last_sched)
  351. return lr;
  352. fp = *(unsigned long *) (fp - 12);
  353. } while (count ++ < 16);
  354. return 0;
  355. }