diff options
-rw-r--r-- | arch/x86/kernel/tboot.c | 78 |
1 files changed, 5 insertions, 73 deletions
diff --git a/arch/x86/kernel/tboot.c b/arch/x86/kernel/tboot.c index f84fe00fad48..d4f460f962ee 100644 --- a/arch/x86/kernel/tboot.c +++ b/arch/x86/kernel/tboot.c | |||
@@ -103,71 +103,13 @@ void __init tboot_probe(void) | |||
103 | pr_debug("tboot_size: 0x%x\n", tboot->tboot_size); | 103 | pr_debug("tboot_size: 0x%x\n", tboot->tboot_size); |
104 | } | 104 | } |
105 | 105 | ||
106 | static pgd_t *tboot_pg_dir; | ||
107 | static struct mm_struct tboot_mm = { | ||
108 | .mm_rb = RB_ROOT, | ||
109 | .pgd = swapper_pg_dir, | ||
110 | .mm_users = ATOMIC_INIT(2), | ||
111 | .mm_count = ATOMIC_INIT(1), | ||
112 | .mmap_sem = __RWSEM_INITIALIZER(init_mm.mmap_sem), | ||
113 | .page_table_lock = __SPIN_LOCK_UNLOCKED(init_mm.page_table_lock), | ||
114 | .mmlist = LIST_HEAD_INIT(init_mm.mmlist), | ||
115 | }; | ||
116 | |||
117 | static inline void switch_to_tboot_pt(void) | 106 | static inline void switch_to_tboot_pt(void) |
118 | { | 107 | { |
119 | write_cr3(virt_to_phys(tboot_pg_dir)); | 108 | #ifdef CONFIG_X86_32 |
120 | } | 109 | load_cr3(initial_page_table); |
121 | 110 | #else | |
122 | static int map_tboot_page(unsigned long vaddr, unsigned long pfn, | 111 | write_cr3(real_mode_header->trampoline_pgd); |
123 | pgprot_t prot) | 112 | #endif |
124 | { | ||
125 | pgd_t *pgd; | ||
126 | pud_t *pud; | ||
127 | pmd_t *pmd; | ||
128 | pte_t *pte; | ||
129 | |||
130 | pgd = pgd_offset(&tboot_mm, vaddr); | ||
131 | pud = pud_alloc(&tboot_mm, pgd, vaddr); | ||
132 | if (!pud) | ||
133 | return -1; | ||
134 | pmd = pmd_alloc(&tboot_mm, pud, vaddr); | ||
135 | if (!pmd) | ||
136 | return -1; | ||
137 | pte = pte_alloc_map(&tboot_mm, NULL, pmd, vaddr); | ||
138 | if (!pte) | ||
139 | return -1; | ||
140 | set_pte_at(&tboot_mm, vaddr, pte, pfn_pte(pfn, prot)); | ||
141 | pte_unmap(pte); | ||
142 | return 0; | ||
143 | } | ||
144 | |||
145 | static int map_tboot_pages(unsigned long vaddr, unsigned long start_pfn, | ||
146 | unsigned long nr) | ||
147 | { | ||
148 | /* Reuse the original kernel mapping */ | ||
149 | tboot_pg_dir = pgd_alloc(&tboot_mm); | ||
150 | if (!tboot_pg_dir) | ||
151 | return -1; | ||
152 | |||
153 | for (; nr > 0; nr--, vaddr += PAGE_SIZE, start_pfn++) { | ||
154 | if (map_tboot_page(vaddr, start_pfn, PAGE_KERNEL_EXEC)) | ||
155 | return -1; | ||
156 | } | ||
157 | |||
158 | return 0; | ||
159 | } | ||
160 | |||
161 | static void tboot_create_trampoline(void) | ||
162 | { | ||
163 | u32 map_base, map_size; | ||
164 | |||
165 | /* Create identity map for tboot shutdown code. */ | ||
166 | map_base = PFN_DOWN(tboot->tboot_base); | ||
167 | map_size = PFN_UP(tboot->tboot_size); | ||
168 | if (map_tboot_pages(map_base << PAGE_SHIFT, map_base, map_size)) | ||
169 | panic("tboot: Error mapping tboot pages (mfns) @ 0x%x, 0x%x\n", | ||
170 | map_base, map_size); | ||
171 | } | 113 | } |
172 | 114 | ||
173 | #ifdef CONFIG_ACPI_SLEEP | 115 | #ifdef CONFIG_ACPI_SLEEP |
@@ -225,14 +167,6 @@ void tboot_shutdown(u32 shutdown_type) | |||
225 | if (!tboot_enabled()) | 167 | if (!tboot_enabled()) |
226 | return; | 168 | return; |
227 | 169 | ||
228 | /* | ||
229 | * if we're being called before the 1:1 mapping is set up then just | ||
230 | * return and let the normal shutdown happen; this should only be | ||
231 | * due to very early panic() | ||
232 | */ | ||
233 | if (!tboot_pg_dir) | ||
234 | return; | ||
235 | |||
236 | /* if this is S3 then set regions to MAC */ | 170 | /* if this is S3 then set regions to MAC */ |
237 | if (shutdown_type == TB_SHUTDOWN_S3) | 171 | if (shutdown_type == TB_SHUTDOWN_S3) |
238 | if (tboot_setup_sleep()) | 172 | if (tboot_setup_sleep()) |
@@ -343,8 +277,6 @@ static __init int tboot_late_init(void) | |||
343 | if (!tboot_enabled()) | 277 | if (!tboot_enabled()) |
344 | return 0; | 278 | return 0; |
345 | 279 | ||
346 | tboot_create_trampoline(); | ||
347 | |||
348 | atomic_set(&ap_wfs_count, 0); | 280 | atomic_set(&ap_wfs_count, 0); |
349 | register_hotcpu_notifier(&tboot_cpu_notifier); | 281 | register_hotcpu_notifier(&tboot_cpu_notifier); |
350 | 282 | ||