]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * sleep.c - ACPI sleep support. | |
3 | * | |
e2a5b420 | 4 | * Copyright (c) 2005 Alexey Starikovskiy <alexey.y.starikovskiy@intel.com> |
1da177e4 LT |
5 | * Copyright (c) 2004 David Shaohua Li <shaohua.li@intel.com> |
6 | * Copyright (c) 2000-2003 Patrick Mochel | |
7 | * Copyright (c) 2003 Open Source Development Lab | |
8 | * | |
9 | * This file is released under the GPLv2. | |
10 | * | |
11 | */ | |
12 | ||
13 | #include <linux/delay.h> | |
14 | #include <linux/irq.h> | |
15 | #include <linux/dmi.h> | |
16 | #include <linux/device.h> | |
17 | #include <linux/suspend.h> | |
1da177e4 LT |
18 | #include <acpi/acpi_bus.h> |
19 | #include <acpi/acpi_drivers.h> | |
20 | #include "sleep.h" | |
21 | ||
22 | u8 sleep_states[ACPI_S_STATE_COUNT]; | |
23 | ||
24 | static struct pm_ops acpi_pm_ops; | |
25 | ||
1da177e4 LT |
26 | extern void do_suspend_lowlevel(void); |
27 | ||
28 | static u32 acpi_suspend_states[] = { | |
e2a5b420 AS |
29 | [PM_SUSPEND_ON] = ACPI_STATE_S0, |
30 | [PM_SUSPEND_STANDBY] = ACPI_STATE_S1, | |
31 | [PM_SUSPEND_MEM] = ACPI_STATE_S3, | |
32 | [PM_SUSPEND_DISK] = ACPI_STATE_S4, | |
33 | [PM_SUSPEND_MAX] = ACPI_STATE_S5 | |
1da177e4 LT |
34 | }; |
35 | ||
36 | static int init_8259A_after_S1; | |
37 | ||
38 | /** | |
39 | * acpi_pm_prepare - Do preliminary suspend work. | |
40 | * @pm_state: suspend state we're entering. | |
41 | * | |
42 | * Make sure we support the state. If we do, and we need it, set the | |
43 | * firmware waking vector and do arch-specific nastiness to get the | |
44 | * wakeup code to the waking vector. | |
45 | */ | |
46 | ||
e2a5b420 AS |
47 | extern int acpi_sleep_prepare(u32 acpi_state); |
48 | extern void acpi_power_off(void); | |
49 | ||
1da177e4 LT |
50 | static int acpi_pm_prepare(suspend_state_t pm_state) |
51 | { | |
52 | u32 acpi_state = acpi_suspend_states[pm_state]; | |
53 | ||
e2a5b420 AS |
54 | if (!sleep_states[acpi_state]) { |
55 | printk("acpi_pm_prepare does not support %d \n", pm_state); | |
1da177e4 | 56 | return -EPERM; |
1da177e4 | 57 | } |
e2a5b420 | 58 | return acpi_sleep_prepare(acpi_state); |
1da177e4 LT |
59 | } |
60 | ||
1da177e4 LT |
61 | /** |
62 | * acpi_pm_enter - Actually enter a sleep state. | |
63 | * @pm_state: State we're entering. | |
64 | * | |
65 | * Flush caches and go to sleep. For STR or STD, we have to call | |
66 | * arch-specific assembly, which in turn call acpi_enter_sleep_state(). | |
67 | * It's unfortunate, but it works. Please fix if you're feeling frisky. | |
68 | */ | |
69 | ||
70 | static int acpi_pm_enter(suspend_state_t pm_state) | |
71 | { | |
72 | acpi_status status = AE_OK; | |
73 | unsigned long flags = 0; | |
74 | u32 acpi_state = acpi_suspend_states[pm_state]; | |
75 | ||
76 | ACPI_FLUSH_CPU_CACHE(); | |
77 | ||
78 | /* Do arch specific saving of state. */ | |
79 | if (pm_state > PM_SUSPEND_STANDBY) { | |
80 | int error = acpi_save_state_mem(); | |
81 | if (error) | |
82 | return error; | |
83 | } | |
84 | ||
1da177e4 LT |
85 | local_irq_save(flags); |
86 | acpi_enable_wakeup_device(acpi_state); | |
e2a5b420 | 87 | switch (pm_state) { |
1da177e4 LT |
88 | case PM_SUSPEND_STANDBY: |
89 | barrier(); | |
90 | status = acpi_enter_sleep_state(acpi_state); | |
91 | break; | |
92 | ||
93 | case PM_SUSPEND_MEM: | |
94 | do_suspend_lowlevel(); | |
95 | break; | |
96 | ||
97 | case PM_SUSPEND_DISK: | |
98 | if (acpi_pm_ops.pm_disk_mode == PM_DISK_PLATFORM) | |
99 | status = acpi_enter_sleep_state(acpi_state); | |
1da177e4 | 100 | break; |
e2a5b420 AS |
101 | case PM_SUSPEND_MAX: |
102 | acpi_power_off(); | |
103 | break; | |
104 | ||
1da177e4 LT |
105 | default: |
106 | return -EINVAL; | |
107 | } | |
108 | local_irq_restore(flags); | |
109 | printk(KERN_DEBUG "Back to C!\n"); | |
110 | ||
111 | /* restore processor state | |
112 | * We should only be here if we're coming back from STR or STD. | |
113 | * And, in the case of the latter, the memory image should have already | |
114 | * been loaded from disk. | |
115 | */ | |
116 | if (pm_state > PM_SUSPEND_STANDBY) | |
117 | acpi_restore_state_mem(); | |
118 | ||
1da177e4 LT |
119 | return ACPI_SUCCESS(status) ? 0 : -EFAULT; |
120 | } | |
121 | ||
1da177e4 LT |
122 | /** |
123 | * acpi_pm_finish - Finish up suspend sequence. | |
124 | * @pm_state: State we're coming out of. | |
125 | * | |
126 | * This is called after we wake back up (or if entering the sleep state | |
127 | * failed). | |
128 | */ | |
129 | ||
130 | static int acpi_pm_finish(suspend_state_t pm_state) | |
131 | { | |
132 | u32 acpi_state = acpi_suspend_states[pm_state]; | |
133 | ||
134 | acpi_leave_sleep_state(acpi_state); | |
135 | acpi_disable_wakeup_device(acpi_state); | |
136 | ||
137 | /* reset firmware waking vector */ | |
138 | acpi_set_firmware_waking_vector((acpi_physical_address) 0); | |
139 | ||
140 | if (init_8259A_after_S1) { | |
141 | printk("Broken toshiba laptop -> kicking interrupts\n"); | |
142 | init_8259A(0); | |
143 | } | |
144 | return 0; | |
145 | } | |
146 | ||
1da177e4 LT |
147 | int acpi_suspend(u32 acpi_state) |
148 | { | |
149 | suspend_state_t states[] = { | |
e2a5b420 AS |
150 | [1] = PM_SUSPEND_STANDBY, |
151 | [3] = PM_SUSPEND_MEM, | |
152 | [4] = PM_SUSPEND_DISK, | |
153 | [5] = PM_SUSPEND_MAX | |
1da177e4 LT |
154 | }; |
155 | ||
e2a5b420 | 156 | if (acpi_state < 6 && states[acpi_state]) |
1da177e4 LT |
157 | return pm_suspend(states[acpi_state]); |
158 | return -EINVAL; | |
159 | } | |
160 | ||
eb9289eb SL |
161 | static int acpi_pm_state_valid(suspend_state_t pm_state) |
162 | { | |
163 | u32 acpi_state = acpi_suspend_states[pm_state]; | |
164 | ||
165 | return sleep_states[acpi_state]; | |
166 | } | |
167 | ||
1da177e4 | 168 | static struct pm_ops acpi_pm_ops = { |
eb9289eb | 169 | .valid = acpi_pm_state_valid, |
e2a5b420 AS |
170 | .prepare = acpi_pm_prepare, |
171 | .enter = acpi_pm_enter, | |
172 | .finish = acpi_pm_finish, | |
1da177e4 LT |
173 | }; |
174 | ||
1da177e4 LT |
175 | /* |
176 | * Toshiba fails to preserve interrupts over S1, reinitialization | |
177 | * of 8259 is needed after S1 resume. | |
178 | */ | |
179 | static int __init init_ints_after_s1(struct dmi_system_id *d) | |
180 | { | |
181 | printk(KERN_WARNING "%s with broken S1 detected.\n", d->ident); | |
182 | init_8259A_after_S1 = 1; | |
183 | return 0; | |
184 | } | |
185 | ||
186 | static struct dmi_system_id __initdata acpisleep_dmi_table[] = { | |
187 | { | |
e2a5b420 AS |
188 | .callback = init_ints_after_s1, |
189 | .ident = "Toshiba Satellite 4030cdt", | |
190 | .matches = {DMI_MATCH(DMI_PRODUCT_NAME, "S4030CDT/4.3"),}, | |
191 | }, | |
192 | {}, | |
1da177e4 LT |
193 | }; |
194 | ||
195 | static int __init acpi_sleep_init(void) | |
196 | { | |
e2a5b420 | 197 | int i = 0; |
1da177e4 LT |
198 | |
199 | dmi_check_system(acpisleep_dmi_table); | |
200 | ||
201 | if (acpi_disabled) | |
202 | return 0; | |
203 | ||
204 | printk(KERN_INFO PREFIX "(supports"); | |
e2a5b420 | 205 | for (i = 0; i < ACPI_S_STATE_COUNT; i++) { |
1da177e4 LT |
206 | acpi_status status; |
207 | u8 type_a, type_b; | |
208 | status = acpi_get_sleep_type_data(i, &type_a, &type_b); | |
209 | if (ACPI_SUCCESS(status)) { | |
210 | sleep_states[i] = 1; | |
211 | printk(" S%d", i); | |
212 | } | |
213 | if (i == ACPI_STATE_S4) { | |
1da177e4 LT |
214 | if (sleep_states[i]) |
215 | acpi_pm_ops.pm_disk_mode = PM_DISK_PLATFORM; | |
216 | } | |
217 | } | |
218 | printk(")\n"); | |
219 | ||
220 | pm_set_ops(&acpi_pm_ops); | |
221 | return 0; | |
222 | } | |
223 | ||
224 | late_initcall(acpi_sleep_init); |