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 | /** | |
d6a77ead | 29 | * x86_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 | */ | |
d6a77ead | 34 | int x86_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 | 48 | #ifndef CONFIG_64BIT |
357d1226 | 49 | native_store_gdt((struct desc_ptr *)&header->pmode_gdt); |
e44b7b75 | 50 | |
5ff560fd PA |
51 | /* |
52 | * We have to check that we can write back the value, and not | |
53 | * just read it. At least on 90 nm Pentium M (Family 6, Model | |
54 | * 13), reading an invalid MSR is not guaranteed to trap, see | |
55 | * Erratum X4 in "Intel Pentium M Processor on 90 nm Process | |
56 | * with 2-MB L2 Cache and IntelĀ® Processor A100 and A110 on 90 | |
57 | * nm process with 512-KB L2 Cache Specification Update". | |
58 | */ | |
73201dbe PA |
59 | if (!rdmsr_safe(MSR_EFER, |
60 | &header->pmode_efer_low, | |
5ff560fd PA |
61 | &header->pmode_efer_high) && |
62 | !wrmsr_safe(MSR_EFER, | |
63 | header->pmode_efer_low, | |
64 | header->pmode_efer_high)) | |
73201dbe | 65 | header->pmode_behavior |= (1 << WAKEUP_BEHAVIOR_RESTORE_EFER); |
e44b7b75 PM |
66 | #endif /* !CONFIG_64BIT */ |
67 | ||
68 | header->pmode_cr0 = read_cr0(); | |
73201dbe PA |
69 | if (__this_cpu_read(cpu_info.cpuid_level) >= 0) { |
70 | header->pmode_cr4 = read_cr4(); | |
71 | header->pmode_behavior |= (1 << WAKEUP_BEHAVIOR_RESTORE_CR4); | |
72 | } | |
7a313666 KC |
73 | if (!rdmsr_safe(MSR_IA32_MISC_ENABLE, |
74 | &header->pmode_misc_en_low, | |
5ff560fd PA |
75 | &header->pmode_misc_en_high) && |
76 | !wrmsr_safe(MSR_IA32_MISC_ENABLE, | |
77 | header->pmode_misc_en_low, | |
78 | header->pmode_misc_en_high)) | |
7a313666 KC |
79 | header->pmode_behavior |= |
80 | (1 << WAKEUP_BEHAVIOR_RESTORE_MISC_ENABLE); | |
e44b7b75 PM |
81 | header->realmode_flags = acpi_realmode_flags; |
82 | header->real_magic = 0x12345678; | |
83 | ||
84 | #ifndef CONFIG_64BIT | |
85 | header->pmode_entry = (u32)&wakeup_pmode_return; | |
afd51a0e | 86 | header->pmode_cr3 = (u32)__pa_symbol(initial_page_table); |
e44b7b75 PM |
87 | saved_magic = 0x12345678; |
88 | #else /* CONFIG_64BIT */ | |
1ea598c2 | 89 | #ifdef CONFIG_SMP |
11d4c3f9 | 90 | stack_start = (unsigned long)temp_stack + sizeof(temp_stack); |
3038edab RW |
91 | early_gdt_descr.address = |
92 | (unsigned long)get_cpu_gdt_table(smp_processor_id()); | |
004aa322 | 93 | initial_gs = per_cpu_offset(smp_processor_id()); |
1ea598c2 | 94 | #endif |
e44b7b75 | 95 | initial_code = (unsigned long)wakeup_long64; |
ce4b3c55 | 96 | saved_magic = 0x123456789abcdef0L; |
e44b7b75 | 97 | #endif /* CONFIG_64BIT */ |
4fc2fba8 | 98 | |
f1a2003e | 99 | do_suspend_lowlevel(); |
4fc2fba8 PM |
100 | return 0; |
101 | } | |
102 | ||
4fc2fba8 PM |
103 | static int __init acpi_sleep_setup(char *str) |
104 | { | |
105 | while ((str != NULL) && (*str != '\0')) { | |
106 | if (strncmp(str, "s3_bios", 7) == 0) | |
107 | acpi_realmode_flags |= 1; | |
108 | if (strncmp(str, "s3_mode", 7) == 0) | |
109 | acpi_realmode_flags |= 2; | |
110 | if (strncmp(str, "s3_beep", 7) == 0) | |
111 | acpi_realmode_flags |= 4; | |
bdfe6b7c SL |
112 | #ifdef CONFIG_HIBERNATION |
113 | if (strncmp(str, "s4_nohwsig", 10) == 0) | |
114 | acpi_no_s4_hw_signature(); | |
115 | #endif | |
72ad5d77 RW |
116 | if (strncmp(str, "nonvs", 5) == 0) |
117 | acpi_nvs_nosave(); | |
1bad2f19 KCA |
118 | if (strncmp(str, "nonvs_s3", 8) == 0) |
119 | acpi_nvs_nosave_s3(); | |
d8f3de0d RW |
120 | if (strncmp(str, "old_ordering", 12) == 0) |
121 | acpi_old_suspend_ordering(); | |
4fc2fba8 PM |
122 | str = strchr(str, ','); |
123 | if (str != NULL) | |
124 | str += strspn(str, ", \t"); | |
125 | } | |
126 | return 1; | |
127 | } | |
128 | ||
129 | __setup("acpi_sleep=", acpi_sleep_setup); |