Commit | Line | Data |
---|---|---|
5234f5eb | 1 | /* |
835c34a1 | 2 | * handle transition of Linux booting another kernel |
5234f5eb EB |
3 | * Copyright (C) 2002-2005 Eric Biederman <ebiederm@xmission.com> |
4 | * | |
5 | * This source code is licensed under the GNU General Public License, | |
6 | * Version 2. See the file COPYING for more details. | |
7 | */ | |
8 | ||
9 | #include <linux/mm.h> | |
10 | #include <linux/kexec.h> | |
5234f5eb | 11 | #include <linux/string.h> |
5a0e3ad6 | 12 | #include <linux/gfp.h> |
5234f5eb | 13 | #include <linux/reboot.h> |
fd59d231 | 14 | #include <linux/numa.h> |
f43fdad8 | 15 | #include <linux/ftrace.h> |
fef3a7a1 | 16 | #include <linux/io.h> |
fee7b0d8 | 17 | #include <linux/suspend.h> |
f43fdad8 | 18 | |
9ebdc79f | 19 | #include <asm/init.h> |
5234f5eb | 20 | #include <asm/pgtable.h> |
5234f5eb EB |
21 | #include <asm/tlbflush.h> |
22 | #include <asm/mmu_context.h> | |
17f557e5 | 23 | #include <asm/debugreg.h> |
8bf27556 | 24 | |
f5deb796 HY |
25 | static void free_transition_pgtable(struct kimage *image) |
26 | { | |
27 | free_page((unsigned long)image->arch.pud); | |
28 | free_page((unsigned long)image->arch.pmd); | |
29 | free_page((unsigned long)image->arch.pte); | |
30 | } | |
31 | ||
32 | static int init_transition_pgtable(struct kimage *image, pgd_t *pgd) | |
33 | { | |
34 | pud_t *pud; | |
35 | pmd_t *pmd; | |
36 | pte_t *pte; | |
37 | unsigned long vaddr, paddr; | |
38 | int result = -ENOMEM; | |
39 | ||
40 | vaddr = (unsigned long)relocate_kernel; | |
41 | paddr = __pa(page_address(image->control_code_page)+PAGE_SIZE); | |
42 | pgd += pgd_index(vaddr); | |
43 | if (!pgd_present(*pgd)) { | |
44 | pud = (pud_t *)get_zeroed_page(GFP_KERNEL); | |
45 | if (!pud) | |
46 | goto err; | |
47 | image->arch.pud = pud; | |
48 | set_pgd(pgd, __pgd(__pa(pud) | _KERNPG_TABLE)); | |
49 | } | |
50 | pud = pud_offset(pgd, vaddr); | |
51 | if (!pud_present(*pud)) { | |
52 | pmd = (pmd_t *)get_zeroed_page(GFP_KERNEL); | |
53 | if (!pmd) | |
54 | goto err; | |
55 | image->arch.pmd = pmd; | |
56 | set_pud(pud, __pud(__pa(pmd) | _KERNPG_TABLE)); | |
57 | } | |
58 | pmd = pmd_offset(pud, vaddr); | |
59 | if (!pmd_present(*pmd)) { | |
60 | pte = (pte_t *)get_zeroed_page(GFP_KERNEL); | |
61 | if (!pte) | |
62 | goto err; | |
63 | image->arch.pte = pte; | |
64 | set_pmd(pmd, __pmd(__pa(pte) | _KERNPG_TABLE)); | |
65 | } | |
66 | pte = pte_offset_kernel(pmd, vaddr); | |
67 | set_pte(pte, pfn_pte(paddr >> PAGE_SHIFT, PAGE_KERNEL_EXEC)); | |
68 | return 0; | |
69 | err: | |
70 | free_transition_pgtable(image); | |
71 | return result; | |
72 | } | |
73 | ||
9ebdc79f YL |
74 | static void *alloc_pgt_page(void *data) |
75 | { | |
76 | struct kimage *image = (struct kimage *)data; | |
77 | struct page *page; | |
78 | void *p = NULL; | |
79 | ||
80 | page = kimage_alloc_control_pages(image, 0); | |
81 | if (page) { | |
82 | p = page_address(page); | |
83 | clear_page(p); | |
84 | } | |
85 | ||
86 | return p; | |
87 | } | |
88 | ||
5234f5eb EB |
89 | static int init_pgtable(struct kimage *image, unsigned long start_pgtable) |
90 | { | |
9ebdc79f YL |
91 | struct x86_mapping_info info = { |
92 | .alloc_pgt_page = alloc_pgt_page, | |
93 | .context = image, | |
94 | .pmd_flag = __PAGE_KERNEL_LARGE_EXEC, | |
95 | }; | |
084d1283 | 96 | unsigned long mstart, mend; |
8bf27556 | 97 | pgd_t *level4p; |
f5deb796 | 98 | int result; |
084d1283 YL |
99 | int i; |
100 | ||
8bf27556 | 101 | level4p = (pgd_t *)__va(start_pgtable); |
9ebdc79f YL |
102 | clear_page(level4p); |
103 | result = kernel_ident_mapping_init(&info, level4p, | |
104 | 0, max_pfn << PAGE_SHIFT); | |
53594547 HY |
105 | if (result) |
106 | return result; | |
084d1283 | 107 | |
53594547 | 108 | /* |
084d1283 YL |
109 | * segments's mem ranges could be outside 0 ~ max_pfn, |
110 | * for example when jump back to original kernel from kexeced kernel. | |
111 | * or first kernel is booted with user mem map, and second kernel | |
112 | * could be loaded out of that range. | |
53594547 | 113 | */ |
084d1283 YL |
114 | for (i = 0; i < image->nr_segments; i++) { |
115 | mstart = image->segment[i].mem; | |
116 | mend = mstart + image->segment[i].memsz; | |
117 | ||
9ebdc79f YL |
118 | result = kernel_ident_mapping_init(&info, |
119 | level4p, mstart, mend); | |
084d1283 YL |
120 | |
121 | if (result) | |
122 | return result; | |
123 | } | |
124 | ||
f5deb796 | 125 | return init_transition_pgtable(image, level4p); |
5234f5eb EB |
126 | } |
127 | ||
128 | static void set_idt(void *newidt, u16 limit) | |
129 | { | |
36c4fd23 | 130 | struct desc_ptr curidt; |
5234f5eb EB |
131 | |
132 | /* x86-64 supports unaliged loads & stores */ | |
36c4fd23 EB |
133 | curidt.size = limit; |
134 | curidt.address = (unsigned long)newidt; | |
5234f5eb EB |
135 | |
136 | __asm__ __volatile__ ( | |
36c4fd23 EB |
137 | "lidtq %0\n" |
138 | : : "m" (curidt) | |
5234f5eb EB |
139 | ); |
140 | }; | |
141 | ||
142 | ||
143 | static void set_gdt(void *newgdt, u16 limit) | |
144 | { | |
36c4fd23 | 145 | struct desc_ptr curgdt; |
5234f5eb EB |
146 | |
147 | /* x86-64 supports unaligned loads & stores */ | |
36c4fd23 EB |
148 | curgdt.size = limit; |
149 | curgdt.address = (unsigned long)newgdt; | |
5234f5eb EB |
150 | |
151 | __asm__ __volatile__ ( | |
36c4fd23 EB |
152 | "lgdtq %0\n" |
153 | : : "m" (curgdt) | |
5234f5eb EB |
154 | ); |
155 | }; | |
156 | ||
157 | static void load_segments(void) | |
158 | { | |
159 | __asm__ __volatile__ ( | |
36c4fd23 EB |
160 | "\tmovl %0,%%ds\n" |
161 | "\tmovl %0,%%es\n" | |
162 | "\tmovl %0,%%ss\n" | |
163 | "\tmovl %0,%%fs\n" | |
164 | "\tmovl %0,%%gs\n" | |
2ec5e3a8 | 165 | : : "a" (__KERNEL_DS) : "memory" |
5234f5eb | 166 | ); |
5234f5eb EB |
167 | } |
168 | ||
5234f5eb EB |
169 | int machine_kexec_prepare(struct kimage *image) |
170 | { | |
4bfaaef0 | 171 | unsigned long start_pgtable; |
5234f5eb EB |
172 | int result; |
173 | ||
174 | /* Calculate the offsets */ | |
72414d3f | 175 | start_pgtable = page_to_pfn(image->control_code_page) << PAGE_SHIFT; |
5234f5eb EB |
176 | |
177 | /* Setup the identity mapped 64bit page table */ | |
178 | result = init_pgtable(image, start_pgtable); | |
72414d3f | 179 | if (result) |
5234f5eb | 180 | return result; |
5234f5eb | 181 | |
5234f5eb EB |
182 | return 0; |
183 | } | |
184 | ||
185 | void machine_kexec_cleanup(struct kimage *image) | |
186 | { | |
f5deb796 | 187 | free_transition_pgtable(image); |
5234f5eb EB |
188 | } |
189 | ||
190 | /* | |
191 | * Do not allocate memory (or fail in any way) in machine_kexec(). | |
192 | * We are past the point of no return, committed to rebooting now. | |
193 | */ | |
3ab83521 | 194 | void machine_kexec(struct kimage *image) |
5234f5eb | 195 | { |
4bfaaef0 MD |
196 | unsigned long page_list[PAGES_NR]; |
197 | void *control_page; | |
fee7b0d8 | 198 | int save_ftrace_enabled; |
5234f5eb | 199 | |
fee7b0d8 | 200 | #ifdef CONFIG_KEXEC_JUMP |
6407df5c | 201 | if (image->preserve_context) |
fee7b0d8 HY |
202 | save_processor_state(); |
203 | #endif | |
204 | ||
205 | save_ftrace_enabled = __ftrace_enabled_save(); | |
f43fdad8 | 206 | |
5234f5eb EB |
207 | /* Interrupts aren't acceptable while we reboot */ |
208 | local_irq_disable(); | |
17f557e5 | 209 | hw_breakpoint_disable(); |
5234f5eb | 210 | |
fee7b0d8 HY |
211 | if (image->preserve_context) { |
212 | #ifdef CONFIG_X86_IO_APIC | |
213 | /* | |
214 | * We need to put APICs in legacy mode so that we can | |
215 | * get timer interrupts in second kernel. kexec/kdump | |
216 | * paths already have calls to disable_IO_APIC() in | |
217 | * one form or other. kexec jump path also need | |
218 | * one. | |
219 | */ | |
220 | disable_IO_APIC(); | |
221 | #endif | |
222 | } | |
223 | ||
4bfaaef0 | 224 | control_page = page_address(image->control_code_page) + PAGE_SIZE; |
fee7b0d8 | 225 | memcpy(control_page, relocate_kernel, KEXEC_CONTROL_CODE_MAX_SIZE); |
4bfaaef0 | 226 | |
e3ebadd9 | 227 | page_list[PA_CONTROL_PAGE] = virt_to_phys(control_page); |
fee7b0d8 | 228 | page_list[VA_CONTROL_PAGE] = (unsigned long)control_page; |
4bfaaef0 MD |
229 | page_list[PA_TABLE_PAGE] = |
230 | (unsigned long)__pa(page_address(image->control_code_page)); | |
5234f5eb | 231 | |
fee7b0d8 HY |
232 | if (image->type == KEXEC_TYPE_DEFAULT) |
233 | page_list[PA_SWAP_PAGE] = (page_to_pfn(image->swap_page) | |
234 | << PAGE_SHIFT); | |
235 | ||
fef3a7a1 HY |
236 | /* |
237 | * The segment registers are funny things, they have both a | |
2a8a3d5b EB |
238 | * visible and an invisible part. Whenever the visible part is |
239 | * set to a specific selector, the invisible part is loaded | |
240 | * with from a table in memory. At no other time is the | |
241 | * descriptor table in memory accessed. | |
5234f5eb EB |
242 | * |
243 | * I take advantage of this here by force loading the | |
244 | * segments, before I zap the gdt with an invalid value. | |
245 | */ | |
246 | load_segments(); | |
fef3a7a1 HY |
247 | /* |
248 | * The gdt & idt are now invalid. | |
5234f5eb EB |
249 | * If you want to load them you must set up your own idt & gdt. |
250 | */ | |
fef3a7a1 HY |
251 | set_gdt(phys_to_virt(0), 0); |
252 | set_idt(phys_to_virt(0), 0); | |
4bfaaef0 | 253 | |
5234f5eb | 254 | /* now call it */ |
fee7b0d8 HY |
255 | image->start = relocate_kernel((unsigned long)image->head, |
256 | (unsigned long)page_list, | |
257 | image->start, | |
258 | image->preserve_context); | |
259 | ||
260 | #ifdef CONFIG_KEXEC_JUMP | |
6407df5c | 261 | if (image->preserve_context) |
fee7b0d8 HY |
262 | restore_processor_state(); |
263 | #endif | |
264 | ||
265 | __ftrace_enabled_restore(save_ftrace_enabled); | |
5234f5eb | 266 | } |
2c8c0e6b | 267 | |
fd59d231 KO |
268 | void arch_crash_save_vmcoreinfo(void) |
269 | { | |
629c8b4c | 270 | VMCOREINFO_SYMBOL(phys_base); |
69243f91 | 271 | VMCOREINFO_SYMBOL(init_level4_pgt); |
92df5c3e KO |
272 | |
273 | #ifdef CONFIG_NUMA | |
274 | VMCOREINFO_SYMBOL(node_data); | |
275 | VMCOREINFO_LENGTH(node_data, MAX_NUMNODES); | |
276 | #endif | |
fd59d231 KO |
277 | } |
278 |