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

Linux/Unix编程

开发平台:

Unix_Linux

  1. /*
  2.  * IA32 helper functions
  3.  *
  4.  * Copyright (C) 1999 Arun Sharma <arun.sharma@intel.com>
  5.  * Copyright (C) 2000 Asit K. Mallick <asit.k.mallick@intel.com>
  6.  * Copyright (C) 2001-2002 Hewlett-Packard Co
  7.  * David Mosberger-Tang <davidm@hpl.hp.com>
  8.  *
  9.  * 06/16/00 A. Mallick added csd/ssd/tssd for ia32 thread context
  10.  * 02/19/01 D. Mosberger dropped tssd; it's not needed
  11.  * 09/14/01 D. Mosberger fixed memory management for gdt/tss page
  12.  * 09/29/01 D. Mosberger added ia32_load_segment_descriptors()
  13.  */
  14. #include <linux/kernel.h>
  15. #include <linux/init.h>
  16. #include <linux/mm.h>
  17. #include <linux/personality.h>
  18. #include <linux/sched.h>
  19. #include <asm/page.h>
  20. #include <asm/pgtable.h>
  21. #include <asm/system.h>
  22. #include <asm/processor.h>
  23. #include <asm/ia32.h>
  24. extern void die_if_kernel (char *str, struct pt_regs *regs, long err);
  25. struct exec_domain ia32_exec_domain;
  26. struct page *ia32_shared_page[(2*IA32_PAGE_SIZE + PAGE_SIZE - 1)/PAGE_SIZE];
  27. unsigned long *ia32_gdt;
  28. static unsigned long
  29. load_desc (u16 selector)
  30. {
  31. unsigned long *table, limit, index;
  32. if (!selector)
  33. return 0;
  34. if (selector & IA32_SEGSEL_TI) {
  35. table = (unsigned long *) IA32_LDT_OFFSET;
  36. limit = IA32_LDT_ENTRIES;
  37. } else {
  38. table = ia32_gdt;
  39. limit = IA32_PAGE_SIZE / sizeof(ia32_gdt[0]);
  40. }
  41. index = selector >> IA32_SEGSEL_INDEX_SHIFT;
  42. if (index >= limit)
  43. return 0;
  44. return IA32_SEG_UNSCRAMBLE(table[index]);
  45. }
  46. void
  47. ia32_load_segment_descriptors (struct task_struct *task)
  48. {
  49. struct pt_regs *regs = ia64_task_regs(task);
  50. /* Setup the segment descriptors */
  51. regs->r24 = load_desc(regs->r16 >> 16); /* ESD */
  52. regs->r27 = load_desc(regs->r16 >>  0); /* DSD */
  53. regs->r28 = load_desc(regs->r16 >> 32); /* FSD */
  54. regs->r29 = load_desc(regs->r16 >> 48); /* GSD */
  55. task->thread.csd = load_desc(regs->r17 >>  0); /* CSD */
  56. task->thread.ssd = load_desc(regs->r17 >> 16); /* SSD */
  57. }
  58. void
  59. ia32_save_state (struct task_struct *t)
  60. {
  61. unsigned long eflag, fsr, fcr, fir, fdr, csd, ssd;
  62. asm ("mov %0=ar.eflag;"
  63.      "mov %1=ar.fsr;"
  64.      "mov %2=ar.fcr;"
  65.      "mov %3=ar.fir;"
  66.      "mov %4=ar.fdr;"
  67.      "mov %5=ar.csd;"
  68.      "mov %6=ar.ssd;"
  69.      : "=r"(eflag), "=r"(fsr), "=r"(fcr), "=r"(fir), "=r"(fdr), "=r"(csd), "=r"(ssd));
  70. t->thread.eflag = eflag;
  71. t->thread.fsr = fsr;
  72. t->thread.fcr = fcr;
  73. t->thread.fir = fir;
  74. t->thread.fdr = fdr;
  75. t->thread.csd = csd;
  76. t->thread.ssd = ssd;
  77. ia64_set_kr(IA64_KR_IO_BASE, t->thread.old_iob);
  78. ia64_set_kr(IA64_KR_TSSD, t->thread.old_k1);
  79. }
  80. void
  81. ia32_load_state (struct task_struct *t)
  82. {
  83. unsigned long eflag, fsr, fcr, fir, fdr, csd, ssd, tssd;
  84. struct pt_regs *regs = ia64_task_regs(t);
  85. int nr = smp_processor_id(); /* LDT and TSS depend on CPU number: */
  86. nr = smp_processor_id();
  87. eflag = t->thread.eflag;
  88. fsr = t->thread.fsr;
  89. fcr = t->thread.fcr;
  90. fir = t->thread.fir;
  91. fdr = t->thread.fdr;
  92. csd = t->thread.csd;
  93. ssd = t->thread.ssd;
  94. tssd = load_desc(_TSS(nr)); /* TSSD */
  95. asm volatile ("mov ar.eflag=%0;"
  96.       "mov ar.fsr=%1;"
  97.       "mov ar.fcr=%2;"
  98.       "mov ar.fir=%3;"
  99.       "mov ar.fdr=%4;"
  100.       "mov ar.csd=%5;"
  101.       "mov ar.ssd=%6;"
  102.       :: "r"(eflag), "r"(fsr), "r"(fcr), "r"(fir), "r"(fdr), "r"(csd), "r"(ssd));
  103. current->thread.old_iob = ia64_get_kr(IA64_KR_IO_BASE);
  104. current->thread.old_k1 = ia64_get_kr(IA64_KR_TSSD);
  105. ia64_set_kr(IA64_KR_IO_BASE, IA32_IOBASE);
  106. ia64_set_kr(IA64_KR_TSSD, tssd);
  107. regs->r17 = (_TSS(nr) << 48) | (_LDT(nr) << 32) | (__u32) regs->r17;
  108. regs->r30 = load_desc(_LDT(nr)); /* LDTD */
  109. }
  110. /*
  111.  * Setup IA32 GDT and TSS
  112.  */
  113. void
  114. ia32_gdt_init (void)
  115. {
  116. unsigned long *tss;
  117. unsigned long ldt_size;
  118. int nr;
  119. ia32_shared_page[0] = alloc_page(GFP_KERNEL);
  120. ia32_gdt = page_address(ia32_shared_page[0]);
  121. tss = ia32_gdt + IA32_PAGE_SIZE/sizeof(ia32_gdt[0]);
  122. if (IA32_PAGE_SIZE == PAGE_SIZE) {
  123. ia32_shared_page[1] = alloc_page(GFP_KERNEL);
  124. tss = page_address(ia32_shared_page[1]);
  125. }
  126. /* CS descriptor in IA-32 (scrambled) format */
  127. ia32_gdt[__USER_CS >> 3] = IA32_SEG_DESCRIPTOR(0, (IA32_PAGE_OFFSET-1) >> IA32_PAGE_SHIFT,
  128.        0xb, 1, 3, 1, 1, 1, 1);
  129. /* DS descriptor in IA-32 (scrambled) format */
  130. ia32_gdt[__USER_DS >> 3] = IA32_SEG_DESCRIPTOR(0, (IA32_PAGE_OFFSET-1) >> IA32_PAGE_SHIFT,
  131.        0x3, 1, 3, 1, 1, 1, 1);
  132. /* We never change the TSS and LDT descriptors, so we can share them across all CPUs.  */
  133. ldt_size = PAGE_ALIGN(IA32_LDT_ENTRIES*IA32_LDT_ENTRY_SIZE);
  134. for (nr = 0; nr < NR_CPUS; ++nr) {
  135. ia32_gdt[_TSS(nr) >> IA32_SEGSEL_INDEX_SHIFT]
  136. = IA32_SEG_DESCRIPTOR(IA32_TSS_OFFSET, 235,
  137.       0xb, 0, 3, 1, 1, 1, 0);
  138. ia32_gdt[_LDT(nr) >> IA32_SEGSEL_INDEX_SHIFT]
  139. = IA32_SEG_DESCRIPTOR(IA32_LDT_OFFSET, ldt_size - 1,
  140.       0x2, 0, 3, 1, 1, 1, 0);
  141. }
  142. }
  143. /*
  144.  * Handle bad IA32 interrupt via syscall
  145.  */
  146. void
  147. ia32_bad_interrupt (unsigned long int_num, struct pt_regs *regs)
  148. {
  149. siginfo_t siginfo;
  150. die_if_kernel("Bad IA-32 interrupt", regs, int_num);
  151. siginfo.si_signo = SIGTRAP;
  152. siginfo.si_errno = int_num; /* XXX is it OK to abuse si_errno like this? */
  153. siginfo.si_flags = 0;
  154. siginfo.si_isr = 0;
  155. siginfo.si_addr = 0;
  156. siginfo.si_imm = 0;
  157. siginfo.si_code = TRAP_BRKPT;
  158. force_sig_info(SIGTRAP, &siginfo, current);
  159. }
  160. static int __init
  161. ia32_init (void)
  162. {
  163. ia32_exec_domain.name = "Linux/x86";
  164. ia32_exec_domain.handler = NULL;
  165. ia32_exec_domain.pers_low = PER_LINUX32;
  166. ia32_exec_domain.pers_high = PER_LINUX32;
  167. ia32_exec_domain.signal_map = default_exec_domain.signal_map;
  168. ia32_exec_domain.signal_invmap = default_exec_domain.signal_invmap;
  169. register_exec_domain(&ia32_exec_domain);
  170. return 0;
  171. }
  172. __initcall(ia32_init);