Commit | Line | Data |
---|---|---|
4fc2fba8 PM |
1 | /* |
2 | * sleep.c - x86-specific ACPI sleep support. | |
3 | * | |
4 | * Copyright (C) 2001-2003 Patrick Mochel | |
a2531293 | 5 | * Copyright (C) 2001-2003 Pavel Machek <pavel@ucw.cz> |
4fc2fba8 PM |
6 | */ |
7 | ||
8 | #include <linux/acpi.h> | |
9 | #include <linux/bootmem.h> | |
a9ce6bc1 | 10 | #include <linux/memblock.h> |
4fc2fba8 PM |
11 | #include <linux/dmi.h> |
12 | #include <linux/cpumask.h> | |
4fdf08b5 | 13 | #include <asm/segment.h> |
3038edab | 14 | #include <asm/desc.h> |
b40827fa | 15 | #include <asm/pgtable.h> |
d344e38b | 16 | #include <asm/cacheflush.h> |
c9b77ccb | 17 | #include <asm/realmode.h> |
b40827fa | 18 | |
c4845474 | 19 | #include "../../realmode/rm/wakeup.h" |
e44b7b75 | 20 | #include "sleep.h" |
4fc2fba8 | 21 | |
4fc2fba8 | 22 | unsigned long acpi_realmode_flags; |
4fc2fba8 | 23 | |
9744f5a3 | 24 | #if defined(CONFIG_SMP) && defined(CONFIG_64BIT) |
5000cadc | 25 | static char temp_stack[4096]; |
e44b7b75 | 26 | #endif |
4fc2fba8 PM |
27 | |
28 | /** | |
f1a2003e | 29 | * acpi_suspend_lowlevel - save kernel state |
4fc2fba8 PM |
30 | * |
31 | * Create an identity mapped page table and copy the wakeup routine to | |
32 | * low memory. | |
33 | */ | |
f1a2003e | 34 | int acpi_suspend_lowlevel(void) |
4fc2fba8 | 35 | { |
c9b77ccb | 36 | struct wakeup_header *header = |
b429dbf6 | 37 | (struct wakeup_header *) __va(real_mode_header->wakeup_header); |
e44b7b75 | 38 | |
d1ee4335 | 39 | if (header->signature != WAKEUP_HEADER_SIGNATURE) { |
e44b7b75 PM |
40 | printk(KERN_ERR "wakeup header does not match\n"); |
41 | return -EINVAL; | |
42 | } | |
43 | ||
44 | header->video_mode = saved_video_mode; | |
45 | ||
73201dbe PA |
46 | header->pmode_behavior = 0; |
47 | ||
e44b7b75 PM |
48 | #ifndef CONFIG_64BIT |
49 | store_gdt((struct desc_ptr *)&header->pmode_gdt); | |
50 | ||
73201dbe PA |
51 | if (!rdmsr_safe(MSR_EFER, |
52 | &header->pmode_efer_low, | |
53 | &header->pmode_efer_high)) | |
54 | header->pmode_behavior |= (1 << WAKEUP_BEHAVIOR_RESTORE_EFER); | |
e44b7b75 PM |
55 | #endif /* !CONFIG_64BIT */ |
56 | ||
57 | header->pmode_cr0 = read_cr0(); | |
73201dbe PA |
58 | if (__this_cpu_read(cpu_info.cpuid_level) >= 0) { |
59 | header->pmode_cr4 = read_cr4(); | |
60 | header->pmode_behavior |= (1 << WAKEUP_BEHAVIOR_RESTORE_CR4); | |
61 | } | |
7a313666 KC |
62 | if (!rdmsr_safe(MSR_IA32_MISC_ENABLE, |
63 | &header->pmode_misc_en_low, | |
64 | &header->pmode_misc_en_high)) | |
65 | header->pmode_behavior |= | |
66 | (1 << WAKEUP_BEHAVIOR_RESTORE_MISC_ENABLE); | |
e44b7b75 PM |
67 | header->realmode_flags = acpi_realmode_flags; |
68 | header->real_magic = 0x12345678; | |
69 | ||
70 | #ifndef CONFIG_64BIT | |
71 | header->pmode_entry = (u32)&wakeup_pmode_return; | |
b40827fa | 72 | header->pmode_cr3 = (u32)__pa(&initial_page_table); |
e44b7b75 PM |
73 | saved_magic = 0x12345678; |
74 | #else /* CONFIG_64BIT */ | |
1ea598c2 | 75 | #ifdef CONFIG_SMP |
11d4c3f9 | 76 | stack_start = (unsigned long)temp_stack + sizeof(temp_stack); |
3038edab RW |
77 | early_gdt_descr.address = |
78 | (unsigned long)get_cpu_gdt_table(smp_processor_id()); | |
004aa322 | 79 | initial_gs = per_cpu_offset(smp_processor_id()); |
1ea598c2 | 80 | #endif |
e44b7b75 | 81 | initial_code = (unsigned long)wakeup_long64; |
ce4b3c55 | 82 | saved_magic = 0x123456789abcdef0L; |
e44b7b75 | 83 | #endif /* CONFIG_64BIT */ |
4fc2fba8 | 84 | |
f1a2003e | 85 | do_suspend_lowlevel(); |
4fc2fba8 PM |
86 | return 0; |
87 | } | |
88 | ||
4fc2fba8 PM |
89 | static int __init acpi_sleep_setup(char *str) |
90 | { | |
91 | while ((str != NULL) && (*str != '\0')) { | |
92 | if (strncmp(str, "s3_bios", 7) == 0) | |
93 | acpi_realmode_flags |= 1; | |
94 | if (strncmp(str, "s3_mode", 7) == 0) | |
95 | acpi_realmode_flags |= 2; | |
96 | if (strncmp(str, "s3_beep", 7) == 0) | |
97 | acpi_realmode_flags |= 4; | |
bdfe6b7c SL |
98 | #ifdef CONFIG_HIBERNATION |
99 | if (strncmp(str, "s4_nohwsig", 10) == 0) | |
100 | acpi_no_s4_hw_signature(); | |
101 | #endif | |
72ad5d77 RW |
102 | if (strncmp(str, "nonvs", 5) == 0) |
103 | acpi_nvs_nosave(); | |
d8f3de0d RW |
104 | if (strncmp(str, "old_ordering", 12) == 0) |
105 | acpi_old_suspend_ordering(); | |
4fc2fba8 PM |
106 | str = strchr(str, ','); |
107 | if (str != NULL) | |
108 | str += strspn(str, ", \t"); | |
109 | } | |
110 | return 1; | |
111 | } | |
112 | ||
113 | __setup("acpi_sleep=", acpi_sleep_setup); |