Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * kernel/power/main.c - PM subsystem core functionality. | |
3 | * | |
4 | * Copyright (c) 2003 Patrick Mochel | |
5 | * Copyright (c) 2003 Open Source Development Lab | |
6 | * | |
7 | * This file is released under the GPLv2 | |
8 | * | |
9 | */ | |
10 | ||
11 | #include <linux/suspend.h> | |
12 | #include <linux/kobject.h> | |
13 | #include <linux/string.h> | |
14 | #include <linux/delay.h> | |
15 | #include <linux/errno.h> | |
16 | #include <linux/init.h> | |
17 | #include <linux/pm.h> | |
6cc07191 | 18 | #include <linux/console.h> |
e3920fb4 | 19 | #include <linux/cpu.h> |
1da177e4 LT |
20 | |
21 | #include "power.h" | |
22 | ||
5ae947ec DSL |
23 | /*This is just an arbitrary number */ |
24 | #define FREE_PAGE_NUMBER (100) | |
25 | ||
1da177e4 LT |
26 | DECLARE_MUTEX(pm_sem); |
27 | ||
123d3c13 | 28 | struct pm_ops *pm_ops; |
1da177e4 LT |
29 | suspend_disk_method_t pm_disk_mode = PM_DISK_SHUTDOWN; |
30 | ||
31 | /** | |
32 | * pm_set_ops - Set the global power method table. | |
33 | * @ops: Pointer to ops structure. | |
34 | */ | |
35 | ||
36 | void pm_set_ops(struct pm_ops * ops) | |
37 | { | |
38 | down(&pm_sem); | |
39 | pm_ops = ops; | |
40 | up(&pm_sem); | |
41 | } | |
42 | ||
43 | ||
44 | /** | |
45 | * suspend_prepare - Do prep work before entering low-power state. | |
46 | * @state: State we're entering. | |
47 | * | |
48 | * This is common code that is called for each state that we're | |
49 | * entering. Allocate a console, stop all processes, then make sure | |
50 | * the platform can enter the requested state. | |
51 | */ | |
52 | ||
53 | static int suspend_prepare(suspend_state_t state) | |
54 | { | |
e3920fb4 | 55 | int error; |
5ae947ec | 56 | unsigned int free_pages; |
1da177e4 LT |
57 | |
58 | if (!pm_ops || !pm_ops->enter) | |
59 | return -EPERM; | |
60 | ||
61 | pm_prepare_console(); | |
62 | ||
e3920fb4 RW |
63 | error = disable_nonboot_cpus(); |
64 | if (error) | |
5a72e04d | 65 | goto Enable_cpu; |
5a72e04d | 66 | |
1da177e4 LT |
67 | if (freeze_processes()) { |
68 | error = -EAGAIN; | |
69 | goto Thaw; | |
70 | } | |
71 | ||
5ae947ec DSL |
72 | if ((free_pages = nr_free_pages()) < FREE_PAGE_NUMBER) { |
73 | pr_debug("PM: free some memory\n"); | |
74 | shrink_all_memory(FREE_PAGE_NUMBER - free_pages); | |
75 | if (nr_free_pages() < FREE_PAGE_NUMBER) { | |
76 | error = -ENOMEM; | |
77 | printk(KERN_ERR "PM: No enough memory\n"); | |
78 | goto Thaw; | |
79 | } | |
80 | } | |
81 | ||
1da177e4 LT |
82 | if (pm_ops->prepare) { |
83 | if ((error = pm_ops->prepare(state))) | |
84 | goto Thaw; | |
85 | } | |
86 | ||
557240b4 | 87 | suspend_console(); |
1da177e4 LT |
88 | if ((error = device_suspend(PMSG_SUSPEND))) { |
89 | printk(KERN_ERR "Some devices failed to suspend\n"); | |
90 | goto Finish; | |
91 | } | |
92 | return 0; | |
93 | Finish: | |
94 | if (pm_ops->finish) | |
95 | pm_ops->finish(state); | |
96 | Thaw: | |
97 | thaw_processes(); | |
5a72e04d LS |
98 | Enable_cpu: |
99 | enable_nonboot_cpus(); | |
1da177e4 LT |
100 | pm_restore_console(); |
101 | return error; | |
102 | } | |
103 | ||
104 | ||
9b238205 | 105 | int suspend_enter(suspend_state_t state) |
1da177e4 LT |
106 | { |
107 | int error = 0; | |
108 | unsigned long flags; | |
109 | ||
110 | local_irq_save(flags); | |
111 | ||
112 | if ((error = device_power_down(PMSG_SUSPEND))) { | |
113 | printk(KERN_ERR "Some devices failed to power down\n"); | |
114 | goto Done; | |
115 | } | |
116 | error = pm_ops->enter(state); | |
117 | device_power_up(); | |
118 | Done: | |
119 | local_irq_restore(flags); | |
120 | return error; | |
121 | } | |
122 | ||
123 | ||
124 | /** | |
125 | * suspend_finish - Do final work before exiting suspend sequence. | |
126 | * @state: State we're coming out of. | |
127 | * | |
128 | * Call platform code to clean up, restart processes, and free the | |
129 | * console that we've allocated. This is not called for suspend-to-disk. | |
130 | */ | |
131 | ||
132 | static void suspend_finish(suspend_state_t state) | |
133 | { | |
134 | device_resume(); | |
557240b4 | 135 | resume_console(); |
1da177e4 | 136 | thaw_processes(); |
5a72e04d | 137 | enable_nonboot_cpus(); |
1a38416c DSL |
138 | if (pm_ops && pm_ops->finish) |
139 | pm_ops->finish(state); | |
1da177e4 LT |
140 | pm_restore_console(); |
141 | } | |
142 | ||
143 | ||
144 | ||
145 | ||
3b364b8d | 146 | static const char * const pm_states[PM_SUSPEND_MAX] = { |
1da177e4 LT |
147 | [PM_SUSPEND_STANDBY] = "standby", |
148 | [PM_SUSPEND_MEM] = "mem", | |
57c4ce3c | 149 | #ifdef CONFIG_SOFTWARE_SUSPEND |
1da177e4 | 150 | [PM_SUSPEND_DISK] = "disk", |
57c4ce3c | 151 | #endif |
1da177e4 LT |
152 | }; |
153 | ||
123d3c13 PM |
154 | static inline int valid_state(suspend_state_t state) |
155 | { | |
156 | /* Suspend-to-disk does not really need low-level support. | |
157 | * It can work with reboot if needed. */ | |
158 | if (state == PM_SUSPEND_DISK) | |
159 | return 1; | |
160 | ||
161 | if (pm_ops && pm_ops->valid && !pm_ops->valid(state)) | |
162 | return 0; | |
163 | return 1; | |
164 | } | |
165 | ||
1da177e4 LT |
166 | |
167 | /** | |
168 | * enter_state - Do common work of entering low-power state. | |
169 | * @state: pm_state structure for state we're entering. | |
170 | * | |
171 | * Make sure we're the only ones trying to enter a sleep state. Fail | |
172 | * if someone has beat us to it, since we don't want anything weird to | |
173 | * happen when we wake up. | |
174 | * Then, do the setup for suspend, enter the state, and cleaup (after | |
175 | * we've woken up). | |
176 | */ | |
177 | ||
178 | static int enter_state(suspend_state_t state) | |
179 | { | |
180 | int error; | |
181 | ||
123d3c13 | 182 | if (!valid_state(state)) |
eb9289eb | 183 | return -ENODEV; |
1da177e4 LT |
184 | if (down_trylock(&pm_sem)) |
185 | return -EBUSY; | |
186 | ||
187 | if (state == PM_SUSPEND_DISK) { | |
188 | error = pm_suspend_disk(); | |
189 | goto Unlock; | |
190 | } | |
191 | ||
82428b62 | 192 | pr_debug("PM: Preparing system for %s sleep\n", pm_states[state]); |
1da177e4 LT |
193 | if ((error = suspend_prepare(state))) |
194 | goto Unlock; | |
195 | ||
82428b62 | 196 | pr_debug("PM: Entering %s sleep\n", pm_states[state]); |
1da177e4 LT |
197 | error = suspend_enter(state); |
198 | ||
82428b62 | 199 | pr_debug("PM: Finishing wakeup.\n"); |
1da177e4 LT |
200 | suspend_finish(state); |
201 | Unlock: | |
202 | up(&pm_sem); | |
203 | return error; | |
204 | } | |
205 | ||
206 | /* | |
207 | * This is main interface to the outside world. It needs to be | |
208 | * called from process context. | |
209 | */ | |
210 | int software_suspend(void) | |
211 | { | |
212 | return enter_state(PM_SUSPEND_DISK); | |
213 | } | |
214 | ||
215 | ||
216 | /** | |
217 | * pm_suspend - Externally visible function for suspending system. | |
218 | * @state: Enumarted value of state to enter. | |
219 | * | |
220 | * Determine whether or not value is within range, get state | |
221 | * structure, and enter (above). | |
222 | */ | |
223 | ||
224 | int pm_suspend(suspend_state_t state) | |
225 | { | |
e2a5b420 | 226 | if (state > PM_SUSPEND_ON && state <= PM_SUSPEND_MAX) |
1da177e4 LT |
227 | return enter_state(state); |
228 | return -EINVAL; | |
229 | } | |
230 | ||
231 | ||
232 | ||
233 | decl_subsys(power,NULL,NULL); | |
234 | ||
235 | ||
236 | /** | |
237 | * state - control system power state. | |
238 | * | |
239 | * show() returns what states are supported, which is hard-coded to | |
240 | * 'standby' (Power-On Suspend), 'mem' (Suspend-to-RAM), and | |
241 | * 'disk' (Suspend-to-Disk). | |
242 | * | |
243 | * store() accepts one of those strings, translates it into the | |
244 | * proper enumerated value, and initiates a suspend transition. | |
245 | */ | |
246 | ||
247 | static ssize_t state_show(struct subsystem * subsys, char * buf) | |
248 | { | |
249 | int i; | |
250 | char * s = buf; | |
251 | ||
252 | for (i = 0; i < PM_SUSPEND_MAX; i++) { | |
123d3c13 PM |
253 | if (pm_states[i] && valid_state(i)) |
254 | s += sprintf(s,"%s ", pm_states[i]); | |
1da177e4 LT |
255 | } |
256 | s += sprintf(s,"\n"); | |
257 | return (s - buf); | |
258 | } | |
259 | ||
260 | static ssize_t state_store(struct subsystem * subsys, const char * buf, size_t n) | |
261 | { | |
262 | suspend_state_t state = PM_SUSPEND_STANDBY; | |
3b364b8d | 263 | const char * const *s; |
1da177e4 LT |
264 | char *p; |
265 | int error; | |
266 | int len; | |
267 | ||
268 | p = memchr(buf, '\n', n); | |
269 | len = p ? p - buf : n; | |
270 | ||
271 | for (s = &pm_states[state]; state < PM_SUSPEND_MAX; s++, state++) { | |
272 | if (*s && !strncmp(buf, *s, len)) | |
273 | break; | |
274 | } | |
47bb7899 | 275 | if (state < PM_SUSPEND_MAX && *s) |
1da177e4 LT |
276 | error = enter_state(state); |
277 | else | |
278 | error = -EINVAL; | |
279 | return error ? error : n; | |
280 | } | |
281 | ||
282 | power_attr(state); | |
283 | ||
284 | static struct attribute * g[] = { | |
285 | &state_attr.attr, | |
286 | NULL, | |
287 | }; | |
288 | ||
289 | static struct attribute_group attr_group = { | |
290 | .attrs = g, | |
291 | }; | |
292 | ||
293 | ||
294 | static int __init pm_init(void) | |
295 | { | |
296 | int error = subsystem_register(&power_subsys); | |
297 | if (!error) | |
298 | error = sysfs_create_group(&power_subsys.kset.kobj,&attr_group); | |
299 | return error; | |
300 | } | |
301 | ||
302 | core_initcall(pm_init); |