]>
Commit | Line | Data |
---|---|---|
084ee1c6 JS |
1 | #include <linux/io.h> |
2 | #include <linux/memblock.h> | |
3 | ||
4 | #include <asm/cacheflush.h> | |
5 | #include <asm/pgtable.h> | |
6 | #include <asm/realmode.h> | |
7 | ||
b429dbf6 | 8 | struct real_mode_header *real_mode_header; |
084ee1c6 JS |
9 | |
10 | void __init setup_real_mode(void) | |
11 | { | |
12 | phys_addr_t mem; | |
13 | u16 real_mode_seg; | |
14 | u32 *rel; | |
15 | u32 count; | |
16 | u32 *ptr; | |
17 | u16 *seg; | |
18 | int i; | |
b429dbf6 | 19 | unsigned char *base; |
084ee1c6 | 20 | |
b429dbf6 | 21 | size_t size = PAGE_ALIGN(real_mode_blob_end - real_mode_blob); |
084ee1c6 JS |
22 | |
23 | /* Has to be in very low memory so we can execute real-mode AP code. */ | |
24 | mem = memblock_find_in_range(0, 1<<20, size, PAGE_SIZE); | |
25 | if (!mem) | |
26 | panic("Cannot allocate trampoline\n"); | |
27 | ||
b429dbf6 | 28 | base = __va(mem); |
084ee1c6 | 29 | memblock_reserve(mem, size); |
b429dbf6 | 30 | real_mode_header = (struct real_mode_header *) base; |
084ee1c6 JS |
31 | |
32 | printk(KERN_DEBUG "Base memory trampoline at [%p] %llx size %zu\n", | |
b429dbf6 | 33 | base, (unsigned long long)mem, size); |
084ee1c6 | 34 | |
b429dbf6 | 35 | memcpy(base, real_mode_blob, size); |
084ee1c6 | 36 | |
b429dbf6 | 37 | real_mode_seg = __pa(base) >> 4; |
084ee1c6 JS |
38 | rel = (u32 *) real_mode_relocs; |
39 | ||
40 | /* 16-bit segment relocations. */ | |
41 | count = rel[0]; | |
42 | rel = &rel[1]; | |
43 | for (i = 0; i < count; i++) { | |
b429dbf6 | 44 | seg = (u16 *) (base + rel[i]); |
084ee1c6 JS |
45 | *seg = real_mode_seg; |
46 | } | |
47 | ||
48 | /* 32-bit linear relocations. */ | |
49 | count = rel[i]; | |
50 | rel = &rel[i + 1]; | |
51 | for (i = 0; i < count; i++) { | |
b429dbf6 JS |
52 | ptr = (u32 *) (base + rel[i]); |
53 | *ptr += __pa(base); | |
084ee1c6 JS |
54 | } |
55 | ||
48927bbb | 56 | #ifdef CONFIG_X86_32 |
b429dbf6 JS |
57 | *((u32 *)__va(real_mode_header->startup_32_smp)) = __pa(startup_32_smp); |
58 | *((u32 *)__va(real_mode_header->boot_gdt)) = __pa(boot_gdt); | |
48927bbb | 59 | #else |
b429dbf6 | 60 | *((u64 *) __va(real_mode_header->startup_64_smp)) = |
8e029fcd | 61 | (u64)secondary_startup_64; |
48927bbb | 62 | |
b429dbf6 | 63 | *((u64 *) __va(real_mode_header->level3_ident_pgt)) = |
48927bbb JS |
64 | __pa(level3_ident_pgt) + _KERNPG_TABLE; |
65 | ||
b429dbf6 | 66 | *((u64 *) __va(real_mode_header->level3_kernel_pgt)) = |
48927bbb JS |
67 | __pa(level3_kernel_pgt) + _KERNPG_TABLE; |
68 | #endif | |
084ee1c6 JS |
69 | } |
70 | ||
71 | /* | |
72 | * set_real_mode_permissions() gets called very early, to guarantee the | |
73 | * availability of low memory. This is before the proper kernel page | |
74 | * tables are set up, so we cannot set page permissions in that | |
75 | * function. Thus, we use an arch_initcall instead. | |
76 | */ | |
77 | static int __init set_real_mode_permissions(void) | |
78 | { | |
b429dbf6 JS |
79 | unsigned char *base = (unsigned char *) real_mode_header; |
80 | size_t size = PAGE_ALIGN(real_mode_blob_end - real_mode_blob); | |
084ee1c6 | 81 | |
f156ffc4 | 82 | size_t ro_size = |
b429dbf6 JS |
83 | PAGE_ALIGN(real_mode_header->ro_end) - |
84 | __pa(base); | |
f156ffc4 JS |
85 | |
86 | size_t text_size = | |
b429dbf6 JS |
87 | PAGE_ALIGN(real_mode_header->ro_end) - |
88 | real_mode_header->text_start; | |
f156ffc4 JS |
89 | |
90 | unsigned long text_start = | |
b429dbf6 | 91 | (unsigned long) __va(real_mode_header->text_start); |
f156ffc4 | 92 | |
b429dbf6 JS |
93 | set_memory_nx((unsigned long) base, size >> PAGE_SHIFT); |
94 | set_memory_ro((unsigned long) base, ro_size >> PAGE_SHIFT); | |
f156ffc4 JS |
95 | set_memory_x((unsigned long) text_start, text_size >> PAGE_SHIFT); |
96 | ||
084ee1c6 JS |
97 | return 0; |
98 | } | |
99 | ||
100 | arch_initcall(set_real_mode_permissions); |