Ingo Molnar | 77ad386 | 2008-03-21 15:23:19 +0100 | [diff] [blame] | 1 | #include <linux/io.h> |
| 2 | |
| 3 | #include <asm/trampoline.h> |
Joerg Roedel | fd89a13 | 2010-08-16 14:38:33 +0200 | [diff] [blame] | 4 | #include <asm/pgtable.h> |
Rafael J. Wysocki | 3e1e900 | 2008-12-08 00:50:22 +0100 | [diff] [blame] | 5 | #include <asm/e820.h> |
Ingo Molnar | 77ad386 | 2008-03-21 15:23:19 +0100 | [diff] [blame] | 6 | |
Jan Beulich | 7a4b7e5 | 2009-10-06 16:32:43 +0100 | [diff] [blame] | 7 | #if defined(CONFIG_X86_64) && defined(CONFIG_ACPI_SLEEP) |
| 8 | #define __trampinit |
| 9 | #define __trampinitdata |
| 10 | #else |
| 11 | #define __trampinit __cpuinit |
| 12 | #define __trampinitdata __cpuinitdata |
| 13 | #endif |
| 14 | |
Yinghai Lu | a4c81cf | 2008-05-18 01:18:57 -0700 | [diff] [blame] | 15 | /* ready for x86_64 and x86 */ |
Yinghai Lu | 893f38d | 2009-12-10 13:07:22 -0800 | [diff] [blame] | 16 | unsigned char *__trampinitdata trampoline_base; |
Ingo Molnar | 77ad386 | 2008-03-21 15:23:19 +0100 | [diff] [blame] | 17 | |
Rafael J. Wysocki | 3e1e900 | 2008-12-08 00:50:22 +0100 | [diff] [blame] | 18 | void __init reserve_trampoline_memory(void) |
| 19 | { |
Yinghai Lu | 893f38d | 2009-12-10 13:07:22 -0800 | [diff] [blame] | 20 | unsigned long mem; |
| 21 | |
Rafael J. Wysocki | 3e1e900 | 2008-12-08 00:50:22 +0100 | [diff] [blame] | 22 | /* Has to be in very low memory so we can execute real-mode AP code. */ |
Yinghai Lu | 893f38d | 2009-12-10 13:07:22 -0800 | [diff] [blame] | 23 | mem = find_e820_area(0, 1<<20, TRAMPOLINE_SIZE, PAGE_SIZE); |
| 24 | if (mem == -1L) |
| 25 | panic("Cannot allocate trampoline\n"); |
| 26 | |
| 27 | trampoline_base = __va(mem); |
| 28 | reserve_early(mem, mem + TRAMPOLINE_SIZE, "TRAMPOLINE"); |
Rafael J. Wysocki | 3e1e900 | 2008-12-08 00:50:22 +0100 | [diff] [blame] | 29 | } |
| 30 | |
Ingo Molnar | 77ad386 | 2008-03-21 15:23:19 +0100 | [diff] [blame] | 31 | /* |
| 32 | * Currently trivial. Write the real->protected mode |
| 33 | * bootstrap into the page concerned. The caller |
| 34 | * has made sure it's suitably aligned. |
| 35 | */ |
Jan Beulich | 7a4b7e5 | 2009-10-06 16:32:43 +0100 | [diff] [blame] | 36 | unsigned long __trampinit setup_trampoline(void) |
Ingo Molnar | 77ad386 | 2008-03-21 15:23:19 +0100 | [diff] [blame] | 37 | { |
Rafael J. Wysocki | 3e1e900 | 2008-12-08 00:50:22 +0100 | [diff] [blame] | 38 | memcpy(trampoline_base, trampoline_data, TRAMPOLINE_SIZE); |
Ingo Molnar | 77ad386 | 2008-03-21 15:23:19 +0100 | [diff] [blame] | 39 | return virt_to_phys(trampoline_base); |
| 40 | } |
Joerg Roedel | fd89a13 | 2010-08-16 14:38:33 +0200 | [diff] [blame] | 41 | |
| 42 | void __init setup_trampoline_page_table(void) |
| 43 | { |
| 44 | #ifdef CONFIG_X86_32 |
| 45 | /* Copy kernel address range */ |
| 46 | clone_pgd_range(trampoline_pg_dir + KERNEL_PGD_BOUNDARY, |
| 47 | swapper_pg_dir + KERNEL_PGD_BOUNDARY, |
Hugh Dickins | b7d4608 | 2010-08-24 22:44:12 -0700 | [diff] [blame] | 48 | KERNEL_PGD_PTRS); |
Joerg Roedel | fd89a13 | 2010-08-16 14:38:33 +0200 | [diff] [blame] | 49 | |
| 50 | /* Initialize low mappings */ |
| 51 | clone_pgd_range(trampoline_pg_dir, |
| 52 | swapper_pg_dir + KERNEL_PGD_BOUNDARY, |
| 53 | min_t(unsigned long, KERNEL_PGD_PTRS, |
| 54 | KERNEL_PGD_BOUNDARY)); |
| 55 | #endif |
| 56 | } |