]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * kernel/power/disk.c - Suspend-to-disk support. | |
3 | * | |
4 | * Copyright (c) 2003 Patrick Mochel | |
5 | * Copyright (c) 2003 Open Source Development Lab | |
6 | * Copyright (c) 2004 Pavel Machek <pavel@suse.cz> | |
7 | * | |
8 | * This file is released under the GPLv2. | |
9 | * | |
10 | */ | |
11 | ||
12 | #include <linux/suspend.h> | |
13 | #include <linux/syscalls.h> | |
14 | #include <linux/reboot.h> | |
15 | #include <linux/string.h> | |
16 | #include <linux/device.h> | |
17 | #include <linux/delay.h> | |
18 | #include <linux/fs.h> | |
d53d9f16 | 19 | #include <linux/mount.h> |
88d10bba | 20 | #include <linux/pm.h> |
97c7801c | 21 | #include <linux/console.h> |
e3920fb4 | 22 | #include <linux/cpu.h> |
7dfb7103 | 23 | #include <linux/freezer.h> |
d53d9f16 | 24 | |
1da177e4 LT |
25 | #include "power.h" |
26 | ||
27 | ||
1da177e4 LT |
28 | static int noresume = 0; |
29 | char resume_file[256] = CONFIG_PM_STD_PARTITION; | |
30 | dev_t swsusp_resume_device; | |
9a154d9d | 31 | sector_t swsusp_resume_block; |
1da177e4 | 32 | |
a3d25c27 RW |
33 | enum { |
34 | HIBERNATION_INVALID, | |
35 | HIBERNATION_PLATFORM, | |
36 | HIBERNATION_TEST, | |
37 | HIBERNATION_TESTPROC, | |
38 | HIBERNATION_SHUTDOWN, | |
39 | HIBERNATION_REBOOT, | |
40 | /* keep last */ | |
41 | __HIBERNATION_AFTER_LAST | |
42 | }; | |
43 | #define HIBERNATION_MAX (__HIBERNATION_AFTER_LAST-1) | |
44 | #define HIBERNATION_FIRST (HIBERNATION_INVALID + 1) | |
45 | ||
46 | static int hibernation_mode = HIBERNATION_SHUTDOWN; | |
47 | ||
b3dac3b3 | 48 | static struct platform_hibernation_ops *hibernation_ops; |
a3d25c27 RW |
49 | |
50 | /** | |
51 | * hibernation_set_ops - set the global hibernate operations | |
52 | * @ops: the hibernation operations to use in subsequent hibernation transitions | |
53 | */ | |
54 | ||
b3dac3b3 | 55 | void hibernation_set_ops(struct platform_hibernation_ops *ops) |
a3d25c27 | 56 | { |
74f270af RW |
57 | if (ops && !(ops->start && ops->pre_snapshot && ops->finish |
58 | && ops->prepare && ops->enter && ops->pre_restore | |
59 | && ops->restore_cleanup)) { | |
a3d25c27 RW |
60 | WARN_ON(1); |
61 | return; | |
62 | } | |
63 | mutex_lock(&pm_mutex); | |
64 | hibernation_ops = ops; | |
65 | if (ops) | |
66 | hibernation_mode = HIBERNATION_PLATFORM; | |
67 | else if (hibernation_mode == HIBERNATION_PLATFORM) | |
68 | hibernation_mode = HIBERNATION_SHUTDOWN; | |
69 | ||
70 | mutex_unlock(&pm_mutex); | |
71 | } | |
72 | ||
4cc79776 RW |
73 | #ifdef CONFIG_PM_DEBUG |
74 | static void hibernation_debug_sleep(void) | |
75 | { | |
76 | printk(KERN_INFO "hibernation debug: Waiting for 5 seconds.\n"); | |
77 | mdelay(5000); | |
78 | } | |
79 | ||
80 | static int hibernation_testmode(int mode) | |
81 | { | |
82 | if (hibernation_mode == mode) { | |
83 | hibernation_debug_sleep(); | |
84 | return 1; | |
85 | } | |
86 | return 0; | |
87 | } | |
88 | ||
89 | static int hibernation_test(int level) | |
90 | { | |
91 | if (pm_test_level == level) { | |
92 | hibernation_debug_sleep(); | |
93 | return 1; | |
94 | } | |
95 | return 0; | |
96 | } | |
97 | #else /* !CONFIG_PM_DEBUG */ | |
98 | static int hibernation_testmode(int mode) { return 0; } | |
99 | static int hibernation_test(int level) { return 0; } | |
100 | #endif /* !CONFIG_PM_DEBUG */ | |
101 | ||
74f270af RW |
102 | /** |
103 | * platform_start - tell the platform driver that we're starting | |
104 | * hibernation | |
105 | */ | |
106 | ||
107 | static int platform_start(int platform_mode) | |
108 | { | |
109 | return (platform_mode && hibernation_ops) ? | |
110 | hibernation_ops->start() : 0; | |
111 | } | |
a3d25c27 | 112 | |
8a05aac2 | 113 | /** |
74f270af | 114 | * platform_pre_snapshot - prepare the machine for hibernation using the |
8a05aac2 SS |
115 | * platform driver if so configured and return an error code if it fails |
116 | */ | |
117 | ||
74f270af | 118 | static int platform_pre_snapshot(int platform_mode) |
8a05aac2 | 119 | { |
7777fab9 | 120 | return (platform_mode && hibernation_ops) ? |
74f270af | 121 | hibernation_ops->pre_snapshot() : 0; |
a3d25c27 | 122 | } |
8a05aac2 | 123 | |
c7e0831d RW |
124 | /** |
125 | * platform_leave - prepare the machine for switching to the normal mode | |
126 | * of operation using the platform driver (called with interrupts disabled) | |
127 | */ | |
128 | ||
129 | static void platform_leave(int platform_mode) | |
130 | { | |
131 | if (platform_mode && hibernation_ops) | |
132 | hibernation_ops->leave(); | |
133 | } | |
134 | ||
a3d25c27 RW |
135 | /** |
136 | * platform_finish - switch the machine to the normal mode of operation | |
137 | * using the platform driver (must be called after platform_prepare()) | |
138 | */ | |
139 | ||
7777fab9 | 140 | static void platform_finish(int platform_mode) |
a3d25c27 | 141 | { |
7777fab9 | 142 | if (platform_mode && hibernation_ops) |
a3d25c27 | 143 | hibernation_ops->finish(); |
8a05aac2 SS |
144 | } |
145 | ||
a634cc10 RW |
146 | /** |
147 | * platform_pre_restore - prepare the platform for the restoration from a | |
148 | * hibernation image. If the restore fails after this function has been | |
149 | * called, platform_restore_cleanup() must be called. | |
150 | */ | |
151 | ||
152 | static int platform_pre_restore(int platform_mode) | |
153 | { | |
154 | return (platform_mode && hibernation_ops) ? | |
155 | hibernation_ops->pre_restore() : 0; | |
156 | } | |
157 | ||
158 | /** | |
159 | * platform_restore_cleanup - switch the platform to the normal mode of | |
160 | * operation after a failing restore. If platform_pre_restore() has been | |
161 | * called before the failing restore, this function must be called too, | |
162 | * regardless of the result of platform_pre_restore(). | |
163 | */ | |
164 | ||
165 | static void platform_restore_cleanup(int platform_mode) | |
166 | { | |
167 | if (platform_mode && hibernation_ops) | |
168 | hibernation_ops->restore_cleanup(); | |
169 | } | |
170 | ||
c7e0831d RW |
171 | /** |
172 | * create_image - freeze devices that need to be frozen with interrupts | |
173 | * off, create the hibernation image and thaw those devices. Control | |
174 | * reappears in this routine after a restore. | |
175 | */ | |
176 | ||
177 | int create_image(int platform_mode) | |
178 | { | |
179 | int error; | |
180 | ||
181 | error = arch_prepare_suspend(); | |
182 | if (error) | |
183 | return error; | |
184 | ||
185 | local_irq_disable(); | |
186 | /* At this point, device_suspend() has been called, but *not* | |
187 | * device_power_down(). We *must* call device_power_down() now. | |
188 | * Otherwise, drivers for some devices (e.g. interrupt controllers) | |
189 | * become desynchronized with the actual state of the hardware | |
190 | * at resume time, and evil weirdness ensues. | |
191 | */ | |
192 | error = device_power_down(PMSG_FREEZE); | |
193 | if (error) { | |
194 | printk(KERN_ERR "Some devices failed to power down, " | |
195 | KERN_ERR "aborting suspend\n"); | |
196 | goto Enable_irqs; | |
197 | } | |
198 | ||
4cc79776 RW |
199 | if (hibernation_test(TEST_CORE)) |
200 | goto Power_up; | |
201 | ||
202 | in_suspend = 1; | |
c7e0831d RW |
203 | save_processor_state(); |
204 | error = swsusp_arch_suspend(); | |
205 | if (error) | |
206 | printk(KERN_ERR "Error %d while creating the image\n", error); | |
207 | /* Restore control flow magically appears here */ | |
208 | restore_processor_state(); | |
209 | if (!in_suspend) | |
210 | platform_leave(platform_mode); | |
4cc79776 | 211 | Power_up: |
c7e0831d RW |
212 | /* NOTE: device_power_up() is just a resume() for devices |
213 | * that suspended with irqs off ... no overall powerup. | |
214 | */ | |
215 | device_power_up(); | |
216 | Enable_irqs: | |
217 | local_irq_enable(); | |
218 | return error; | |
219 | } | |
220 | ||
7777fab9 RW |
221 | /** |
222 | * hibernation_snapshot - quiesce devices and create the hibernation | |
223 | * snapshot image. | |
224 | * @platform_mode - if set, use the platform driver, if available, to | |
225 | * prepare the platform frimware for the power transition. | |
226 | * | |
227 | * Must be called with pm_mutex held | |
228 | */ | |
229 | ||
230 | int hibernation_snapshot(int platform_mode) | |
231 | { | |
232 | int error; | |
233 | ||
234 | /* Free memory before shutting down devices. */ | |
235 | error = swsusp_shrink_memory(); | |
236 | if (error) | |
10a1803d | 237 | return error; |
7777fab9 | 238 | |
74f270af RW |
239 | error = platform_start(platform_mode); |
240 | if (error) | |
241 | return error; | |
242 | ||
7777fab9 RW |
243 | suspend_console(); |
244 | error = device_suspend(PMSG_FREEZE); | |
10a1803d RW |
245 | if (error) |
246 | goto Resume_console; | |
247 | ||
4cc79776 | 248 | if (hibernation_test(TEST_DEVICES)) |
7777fab9 RW |
249 | goto Resume_devices; |
250 | ||
4cc79776 RW |
251 | error = platform_pre_snapshot(platform_mode); |
252 | if (error || hibernation_test(TEST_PLATFORM)) | |
253 | goto Finish; | |
254 | ||
7777fab9 RW |
255 | error = disable_nonboot_cpus(); |
256 | if (!error) { | |
4cc79776 RW |
257 | if (hibernation_test(TEST_CPUS)) |
258 | goto Enable_cpus; | |
259 | ||
260 | if (hibernation_testmode(HIBERNATION_TEST)) | |
261 | goto Enable_cpus; | |
262 | ||
263 | error = create_image(platform_mode); | |
264 | /* Control returns here after successful restore */ | |
7777fab9 | 265 | } |
4cc79776 | 266 | Enable_cpus: |
7777fab9 | 267 | enable_nonboot_cpus(); |
4cc79776 | 268 | Finish: |
7777fab9 | 269 | platform_finish(platform_mode); |
4cc79776 | 270 | Resume_devices: |
7777fab9 | 271 | device_resume(); |
10a1803d | 272 | Resume_console: |
7777fab9 | 273 | resume_console(); |
7777fab9 RW |
274 | return error; |
275 | } | |
276 | ||
72df68ca RW |
277 | /** |
278 | * resume_target_kernel - prepare devices that need to be suspended with | |
279 | * interrupts off, restore the contents of highmem that have not been | |
280 | * restored yet from the image and run the low level code that will restore | |
281 | * the remaining contents of memory and switch to the just restored target | |
282 | * kernel. | |
283 | */ | |
284 | ||
285 | static int resume_target_kernel(void) | |
286 | { | |
287 | int error; | |
288 | ||
289 | local_irq_disable(); | |
290 | error = device_power_down(PMSG_PRETHAW); | |
291 | if (error) { | |
292 | printk(KERN_ERR "Some devices failed to power down, " | |
293 | "aborting resume\n"); | |
294 | goto Enable_irqs; | |
295 | } | |
296 | /* We'll ignore saved state, but this gets preempt count (etc) right */ | |
297 | save_processor_state(); | |
298 | error = restore_highmem(); | |
299 | if (!error) { | |
300 | error = swsusp_arch_resume(); | |
301 | /* | |
302 | * The code below is only ever reached in case of a failure. | |
303 | * Otherwise execution continues at place where | |
304 | * swsusp_arch_suspend() was called | |
305 | */ | |
306 | BUG_ON(!error); | |
307 | /* This call to restore_highmem() undos the previous one */ | |
308 | restore_highmem(); | |
309 | } | |
310 | /* | |
311 | * The only reason why swsusp_arch_resume() can fail is memory being | |
312 | * very tight, so we have to free it as soon as we can to avoid | |
313 | * subsequent failures | |
314 | */ | |
315 | swsusp_free(); | |
316 | restore_processor_state(); | |
317 | touch_softlockup_watchdog(); | |
318 | device_power_up(); | |
319 | Enable_irqs: | |
320 | local_irq_enable(); | |
321 | return error; | |
322 | } | |
323 | ||
7777fab9 RW |
324 | /** |
325 | * hibernation_restore - quiesce devices and restore the hibernation | |
326 | * snapshot image. If successful, control returns in hibernation_snaphot() | |
a634cc10 RW |
327 | * @platform_mode - if set, use the platform driver, if available, to |
328 | * prepare the platform frimware for the transition. | |
7777fab9 RW |
329 | * |
330 | * Must be called with pm_mutex held | |
331 | */ | |
332 | ||
a634cc10 | 333 | int hibernation_restore(int platform_mode) |
7777fab9 RW |
334 | { |
335 | int error; | |
336 | ||
337 | pm_prepare_console(); | |
338 | suspend_console(); | |
339 | error = device_suspend(PMSG_PRETHAW); | |
340 | if (error) | |
341 | goto Finish; | |
342 | ||
a634cc10 RW |
343 | error = platform_pre_restore(platform_mode); |
344 | if (!error) { | |
345 | error = disable_nonboot_cpus(); | |
346 | if (!error) | |
72df68ca | 347 | error = resume_target_kernel(); |
a634cc10 RW |
348 | enable_nonboot_cpus(); |
349 | } | |
350 | platform_restore_cleanup(platform_mode); | |
7777fab9 | 351 | device_resume(); |
10a1803d | 352 | Finish: |
7777fab9 RW |
353 | resume_console(); |
354 | pm_restore_console(); | |
355 | return error; | |
356 | } | |
357 | ||
358 | /** | |
359 | * hibernation_platform_enter - enter the hibernation state using the | |
360 | * platform driver (if available) | |
361 | */ | |
362 | ||
363 | int hibernation_platform_enter(void) | |
364 | { | |
b1457bcc RW |
365 | int error; |
366 | ||
9cd9a005 RW |
367 | if (!hibernation_ops) |
368 | return -ENOSYS; | |
369 | ||
370 | /* | |
371 | * We have cancelled the power transition by running | |
372 | * hibernation_ops->finish() before saving the image, so we should let | |
373 | * the firmware know that we're going to enter the sleep state after all | |
374 | */ | |
375 | error = hibernation_ops->start(); | |
376 | if (error) | |
377 | return error; | |
378 | ||
379 | suspend_console(); | |
380 | error = device_suspend(PMSG_SUSPEND); | |
381 | if (error) | |
382 | goto Resume_console; | |
383 | ||
384 | error = hibernation_ops->prepare(); | |
385 | if (error) | |
386 | goto Resume_devices; | |
387 | ||
388 | error = disable_nonboot_cpus(); | |
389 | if (error) | |
390 | goto Finish; | |
391 | ||
392 | local_irq_disable(); | |
393 | error = device_power_down(PMSG_SUSPEND); | |
394 | if (!error) { | |
395 | hibernation_ops->enter(); | |
396 | /* We should never get here */ | |
397 | while (1); | |
7777fab9 | 398 | } |
9cd9a005 RW |
399 | local_irq_enable(); |
400 | ||
401 | /* | |
402 | * We don't need to reenable the nonboot CPUs or resume consoles, since | |
403 | * the system is going to be halted anyway. | |
404 | */ | |
405 | Finish: | |
406 | hibernation_ops->finish(); | |
407 | Resume_devices: | |
408 | device_resume(); | |
409 | Resume_console: | |
410 | resume_console(); | |
b1457bcc | 411 | return error; |
7777fab9 RW |
412 | } |
413 | ||
1da177e4 | 414 | /** |
a3d25c27 | 415 | * power_down - Shut the machine down for hibernation. |
1da177e4 | 416 | * |
fe0c935a JB |
417 | * Use the platform driver, if configured so; otherwise try |
418 | * to power off or reboot. | |
1da177e4 LT |
419 | */ |
420 | ||
fe0c935a | 421 | static void power_down(void) |
1da177e4 | 422 | { |
a3d25c27 RW |
423 | switch (hibernation_mode) { |
424 | case HIBERNATION_TEST: | |
425 | case HIBERNATION_TESTPROC: | |
fe0c935a | 426 | break; |
a3d25c27 | 427 | case HIBERNATION_REBOOT: |
fdde86ac | 428 | kernel_restart(NULL); |
1da177e4 | 429 | break; |
a3d25c27 | 430 | case HIBERNATION_PLATFORM: |
7777fab9 | 431 | hibernation_platform_enter(); |
9cd9a005 RW |
432 | case HIBERNATION_SHUTDOWN: |
433 | kernel_power_off(); | |
434 | break; | |
1da177e4 | 435 | } |
fdde86ac | 436 | kernel_halt(); |
fe0c935a JB |
437 | /* |
438 | * Valid image is on the disk, if we continue we risk serious data | |
439 | * corruption after resume. | |
440 | */ | |
1da177e4 LT |
441 | printk(KERN_CRIT "Please power me down manually\n"); |
442 | while(1); | |
443 | } | |
444 | ||
ed746e3b RW |
445 | static void unprepare_processes(void) |
446 | { | |
447 | thaw_processes(); | |
448 | pm_restore_console(); | |
449 | } | |
450 | ||
1da177e4 LT |
451 | static int prepare_processes(void) |
452 | { | |
b918f6e6 | 453 | int error = 0; |
1da177e4 LT |
454 | |
455 | pm_prepare_console(); | |
1da177e4 LT |
456 | if (freeze_processes()) { |
457 | error = -EBUSY; | |
ed746e3b | 458 | unprepare_processes(); |
1da177e4 | 459 | } |
5a72e04d | 460 | return error; |
1da177e4 LT |
461 | } |
462 | ||
1da177e4 | 463 | /** |
a3d25c27 | 464 | * hibernate - The granpappy of the built-in hibernation management |
1da177e4 LT |
465 | */ |
466 | ||
a3d25c27 | 467 | int hibernate(void) |
1da177e4 LT |
468 | { |
469 | int error; | |
470 | ||
b10d9117 | 471 | mutex_lock(&pm_mutex); |
0709db60 | 472 | /* The snapshot device should not be opened while we're running */ |
b10d9117 RW |
473 | if (!atomic_add_unless(&snapshot_device_available, -1, 0)) { |
474 | error = -EBUSY; | |
475 | goto Unlock; | |
476 | } | |
477 | ||
478 | error = pm_notifier_call_chain(PM_HIBERNATION_PREPARE); | |
479 | if (error) | |
480 | goto Exit; | |
0709db60 RW |
481 | |
482 | /* Allocate memory management structures */ | |
483 | error = create_basic_memory_bitmaps(); | |
484 | if (error) | |
485 | goto Exit; | |
486 | ||
232b1432 RW |
487 | printk("Syncing filesystems ... "); |
488 | sys_sync(); | |
489 | printk("done.\n"); | |
490 | ||
1da177e4 | 491 | error = prepare_processes(); |
5a72e04d | 492 | if (error) |
0709db60 | 493 | goto Finish; |
1da177e4 | 494 | |
4cc79776 | 495 | if (hibernation_test(TEST_FREEZER)) |
ed746e3b | 496 | goto Thaw; |
4cc79776 RW |
497 | |
498 | if (hibernation_testmode(HIBERNATION_TESTPROC)) | |
499 | goto Thaw; | |
500 | ||
7777fab9 RW |
501 | error = hibernation_snapshot(hibernation_mode == HIBERNATION_PLATFORM); |
502 | if (in_suspend && !error) { | |
a634cc10 RW |
503 | unsigned int flags = 0; |
504 | ||
505 | if (hibernation_mode == HIBERNATION_PLATFORM) | |
506 | flags |= SF_PLATFORM_MODE; | |
1da177e4 | 507 | pr_debug("PM: writing image.\n"); |
a634cc10 | 508 | error = swsusp_write(flags); |
7777fab9 | 509 | swsusp_free(); |
1da177e4 | 510 | if (!error) |
fe0c935a | 511 | power_down(); |
b918f6e6 | 512 | } else { |
1da177e4 | 513 | pr_debug("PM: Image restored successfully.\n"); |
7777fab9 | 514 | swsusp_free(); |
b918f6e6 | 515 | } |
b918f6e6 | 516 | Thaw: |
99dc7d63 | 517 | unprepare_processes(); |
0709db60 RW |
518 | Finish: |
519 | free_basic_memory_bitmaps(); | |
520 | Exit: | |
b10d9117 | 521 | pm_notifier_call_chain(PM_POST_HIBERNATION); |
0709db60 | 522 | atomic_inc(&snapshot_device_available); |
b10d9117 RW |
523 | Unlock: |
524 | mutex_unlock(&pm_mutex); | |
1da177e4 LT |
525 | return error; |
526 | } | |
527 | ||
528 | ||
529 | /** | |
530 | * software_resume - Resume from a saved image. | |
531 | * | |
532 | * Called as a late_initcall (so all devices are discovered and | |
533 | * initialized), we call swsusp to see if we have a saved image or not. | |
534 | * If so, we quiesce devices, the restore the saved image. We will | |
a3d25c27 | 535 | * return above (in hibernate() ) if everything goes well. |
1da177e4 LT |
536 | * Otherwise, we fail gracefully and return to the normally |
537 | * scheduled program. | |
538 | * | |
539 | */ | |
540 | ||
541 | static int software_resume(void) | |
542 | { | |
543 | int error; | |
a634cc10 | 544 | unsigned int flags; |
1da177e4 | 545 | |
60a0d233 JB |
546 | /* |
547 | * name_to_dev_t() below takes a sysfs buffer mutex when sysfs | |
548 | * is configured into the kernel. Since the regular hibernate | |
549 | * trigger path is via sysfs which takes a buffer mutex before | |
550 | * calling hibernate functions (which take pm_mutex) this can | |
551 | * cause lockdep to complain about a possible ABBA deadlock | |
552 | * which cannot happen since we're in the boot code here and | |
553 | * sysfs can't be invoked yet. Therefore, we use a subclass | |
554 | * here to avoid lockdep complaining. | |
555 | */ | |
556 | mutex_lock_nested(&pm_mutex, SINGLE_DEPTH_NESTING); | |
3efa147a | 557 | if (!swsusp_resume_device) { |
dd5d666b | 558 | if (!strlen(resume_file)) { |
a6d70980 | 559 | mutex_unlock(&pm_mutex); |
3efa147a | 560 | return -ENOENT; |
dd5d666b | 561 | } |
3efa147a PM |
562 | swsusp_resume_device = name_to_dev_t(resume_file); |
563 | pr_debug("swsusp: Resume From Partition %s\n", resume_file); | |
564 | } else { | |
565 | pr_debug("swsusp: Resume From Partition %d:%d\n", | |
566 | MAJOR(swsusp_resume_device), MINOR(swsusp_resume_device)); | |
567 | } | |
568 | ||
1da177e4 LT |
569 | if (noresume) { |
570 | /** | |
9575809c RW |
571 | * FIXME: If noresume is specified, we need to find the |
572 | * partition and reset it back to normal swap space. | |
1da177e4 | 573 | */ |
a6d70980 | 574 | mutex_unlock(&pm_mutex); |
1da177e4 LT |
575 | return 0; |
576 | } | |
577 | ||
578 | pr_debug("PM: Checking swsusp image.\n"); | |
ed746e3b RW |
579 | error = swsusp_check(); |
580 | if (error) | |
74dfd666 | 581 | goto Unlock; |
1da177e4 | 582 | |
0709db60 RW |
583 | /* The snapshot device should not be opened while we're running */ |
584 | if (!atomic_add_unless(&snapshot_device_available, -1, 0)) { | |
585 | error = -EBUSY; | |
586 | goto Unlock; | |
587 | } | |
588 | ||
c3e94d89 AS |
589 | error = pm_notifier_call_chain(PM_RESTORE_PREPARE); |
590 | if (error) | |
591 | goto Finish; | |
592 | ||
74dfd666 RW |
593 | error = create_basic_memory_bitmaps(); |
594 | if (error) | |
0709db60 | 595 | goto Finish; |
1da177e4 | 596 | |
74dfd666 | 597 | pr_debug("PM: Preparing processes for restore.\n"); |
ed746e3b RW |
598 | error = prepare_processes(); |
599 | if (error) { | |
1da177e4 | 600 | swsusp_close(); |
5a72e04d | 601 | goto Done; |
1da177e4 LT |
602 | } |
603 | ||
604 | pr_debug("PM: Reading swsusp image.\n"); | |
605 | ||
a634cc10 | 606 | error = swsusp_read(&flags); |
ed746e3b | 607 | if (!error) |
a634cc10 | 608 | hibernation_restore(flags & SF_PLATFORM_MODE); |
1da177e4 | 609 | |
ed746e3b | 610 | printk(KERN_ERR "PM: Restore failed, recovering.\n"); |
7777fab9 | 611 | swsusp_free(); |
1da177e4 LT |
612 | unprepare_processes(); |
613 | Done: | |
74dfd666 | 614 | free_basic_memory_bitmaps(); |
0709db60 | 615 | Finish: |
c3e94d89 | 616 | pm_notifier_call_chain(PM_POST_RESTORE); |
0709db60 | 617 | atomic_inc(&snapshot_device_available); |
dd5d666b | 618 | /* For success case, the suspend path will release the lock */ |
74dfd666 | 619 | Unlock: |
a6d70980 | 620 | mutex_unlock(&pm_mutex); |
1da177e4 | 621 | pr_debug("PM: Resume from disk failed.\n"); |
7777fab9 | 622 | return error; |
1da177e4 LT |
623 | } |
624 | ||
625 | late_initcall(software_resume); | |
626 | ||
627 | ||
a3d25c27 RW |
628 | static const char * const hibernation_modes[] = { |
629 | [HIBERNATION_PLATFORM] = "platform", | |
630 | [HIBERNATION_SHUTDOWN] = "shutdown", | |
631 | [HIBERNATION_REBOOT] = "reboot", | |
632 | [HIBERNATION_TEST] = "test", | |
633 | [HIBERNATION_TESTPROC] = "testproc", | |
1da177e4 LT |
634 | }; |
635 | ||
636 | /** | |
a3d25c27 | 637 | * disk - Control hibernation mode |
1da177e4 | 638 | * |
11d77d0c JB |
639 | * Suspend-to-disk can be handled in several ways. We have a few options |
640 | * for putting the system to sleep - using the platform driver (e.g. ACPI | |
a3d25c27 RW |
641 | * or other hibernation_ops), powering off the system or rebooting the |
642 | * system (for testing) as well as the two test modes. | |
1da177e4 | 643 | * |
11d77d0c | 644 | * The system can support 'platform', and that is known a priori (and |
a3d25c27 RW |
645 | * encoded by the presence of hibernation_ops). However, the user may |
646 | * choose 'shutdown' or 'reboot' as alternatives, as well as one fo the | |
647 | * test modes, 'test' or 'testproc'. | |
1da177e4 LT |
648 | * |
649 | * show() will display what the mode is currently set to. | |
650 | * store() will accept one of | |
651 | * | |
1da177e4 LT |
652 | * 'platform' |
653 | * 'shutdown' | |
654 | * 'reboot' | |
11d77d0c JB |
655 | * 'test' |
656 | * 'testproc' | |
1da177e4 | 657 | * |
11d77d0c | 658 | * It will only change to 'platform' if the system |
a3d25c27 | 659 | * supports it (as determined by having hibernation_ops). |
1da177e4 LT |
660 | */ |
661 | ||
386f275f KS |
662 | static ssize_t disk_show(struct kobject *kobj, struct kobj_attribute *attr, |
663 | char *buf) | |
1da177e4 | 664 | { |
f0ced9b2 JB |
665 | int i; |
666 | char *start = buf; | |
667 | ||
a3d25c27 RW |
668 | for (i = HIBERNATION_FIRST; i <= HIBERNATION_MAX; i++) { |
669 | if (!hibernation_modes[i]) | |
f0ced9b2 JB |
670 | continue; |
671 | switch (i) { | |
a3d25c27 RW |
672 | case HIBERNATION_SHUTDOWN: |
673 | case HIBERNATION_REBOOT: | |
674 | case HIBERNATION_TEST: | |
675 | case HIBERNATION_TESTPROC: | |
f0ced9b2 | 676 | break; |
a3d25c27 RW |
677 | case HIBERNATION_PLATFORM: |
678 | if (hibernation_ops) | |
f0ced9b2 JB |
679 | break; |
680 | /* not a valid mode, continue with loop */ | |
681 | continue; | |
682 | } | |
a3d25c27 RW |
683 | if (i == hibernation_mode) |
684 | buf += sprintf(buf, "[%s] ", hibernation_modes[i]); | |
f0ced9b2 | 685 | else |
a3d25c27 | 686 | buf += sprintf(buf, "%s ", hibernation_modes[i]); |
f0ced9b2 JB |
687 | } |
688 | buf += sprintf(buf, "\n"); | |
689 | return buf-start; | |
1da177e4 LT |
690 | } |
691 | ||
692 | ||
386f275f KS |
693 | static ssize_t disk_store(struct kobject *kobj, struct kobj_attribute *attr, |
694 | const char *buf, size_t n) | |
1da177e4 LT |
695 | { |
696 | int error = 0; | |
697 | int i; | |
698 | int len; | |
699 | char *p; | |
a3d25c27 | 700 | int mode = HIBERNATION_INVALID; |
1da177e4 LT |
701 | |
702 | p = memchr(buf, '\n', n); | |
703 | len = p ? p - buf : n; | |
704 | ||
a6d70980 | 705 | mutex_lock(&pm_mutex); |
a3d25c27 | 706 | for (i = HIBERNATION_FIRST; i <= HIBERNATION_MAX; i++) { |
8d98a690 RW |
707 | if (len == strlen(hibernation_modes[i]) |
708 | && !strncmp(buf, hibernation_modes[i], len)) { | |
1da177e4 LT |
709 | mode = i; |
710 | break; | |
711 | } | |
712 | } | |
a3d25c27 | 713 | if (mode != HIBERNATION_INVALID) { |
fe0c935a | 714 | switch (mode) { |
a3d25c27 RW |
715 | case HIBERNATION_SHUTDOWN: |
716 | case HIBERNATION_REBOOT: | |
717 | case HIBERNATION_TEST: | |
718 | case HIBERNATION_TESTPROC: | |
719 | hibernation_mode = mode; | |
fe0c935a | 720 | break; |
a3d25c27 RW |
721 | case HIBERNATION_PLATFORM: |
722 | if (hibernation_ops) | |
723 | hibernation_mode = mode; | |
1da177e4 LT |
724 | else |
725 | error = -EINVAL; | |
726 | } | |
a3d25c27 | 727 | } else |
1da177e4 LT |
728 | error = -EINVAL; |
729 | ||
a3d25c27 RW |
730 | if (!error) |
731 | pr_debug("PM: suspend-to-disk mode set to '%s'\n", | |
732 | hibernation_modes[mode]); | |
a6d70980 | 733 | mutex_unlock(&pm_mutex); |
1da177e4 LT |
734 | return error ? error : n; |
735 | } | |
736 | ||
737 | power_attr(disk); | |
738 | ||
386f275f KS |
739 | static ssize_t resume_show(struct kobject *kobj, struct kobj_attribute *attr, |
740 | char *buf) | |
1da177e4 LT |
741 | { |
742 | return sprintf(buf,"%d:%d\n", MAJOR(swsusp_resume_device), | |
743 | MINOR(swsusp_resume_device)); | |
744 | } | |
745 | ||
386f275f KS |
746 | static ssize_t resume_store(struct kobject *kobj, struct kobj_attribute *attr, |
747 | const char *buf, size_t n) | |
1da177e4 | 748 | { |
1da177e4 | 749 | unsigned int maj, min; |
1da177e4 | 750 | dev_t res; |
a576219a | 751 | int ret = -EINVAL; |
1da177e4 | 752 | |
a576219a AM |
753 | if (sscanf(buf, "%u:%u", &maj, &min) != 2) |
754 | goto out; | |
1da177e4 | 755 | |
a576219a AM |
756 | res = MKDEV(maj,min); |
757 | if (maj != MAJOR(res) || min != MINOR(res)) | |
758 | goto out; | |
1da177e4 | 759 | |
a6d70980 | 760 | mutex_lock(&pm_mutex); |
a576219a | 761 | swsusp_resume_device = res; |
a6d70980 | 762 | mutex_unlock(&pm_mutex); |
a576219a AM |
763 | printk("Attempting manual resume\n"); |
764 | noresume = 0; | |
765 | software_resume(); | |
766 | ret = n; | |
59a49335 | 767 | out: |
a576219a | 768 | return ret; |
1da177e4 LT |
769 | } |
770 | ||
771 | power_attr(resume); | |
772 | ||
386f275f KS |
773 | static ssize_t image_size_show(struct kobject *kobj, struct kobj_attribute *attr, |
774 | char *buf) | |
ca0aec0f | 775 | { |
853609b6 | 776 | return sprintf(buf, "%lu\n", image_size); |
ca0aec0f RW |
777 | } |
778 | ||
386f275f KS |
779 | static ssize_t image_size_store(struct kobject *kobj, struct kobj_attribute *attr, |
780 | const char *buf, size_t n) | |
ca0aec0f | 781 | { |
853609b6 | 782 | unsigned long size; |
ca0aec0f | 783 | |
853609b6 | 784 | if (sscanf(buf, "%lu", &size) == 1) { |
ca0aec0f RW |
785 | image_size = size; |
786 | return n; | |
787 | } | |
788 | ||
789 | return -EINVAL; | |
790 | } | |
791 | ||
792 | power_attr(image_size); | |
793 | ||
1da177e4 LT |
794 | static struct attribute * g[] = { |
795 | &disk_attr.attr, | |
796 | &resume_attr.attr, | |
ca0aec0f | 797 | &image_size_attr.attr, |
1da177e4 LT |
798 | NULL, |
799 | }; | |
800 | ||
801 | ||
802 | static struct attribute_group attr_group = { | |
803 | .attrs = g, | |
804 | }; | |
805 | ||
806 | ||
807 | static int __init pm_disk_init(void) | |
808 | { | |
d76e15fb | 809 | return sysfs_create_group(power_kobj, &attr_group); |
1da177e4 LT |
810 | } |
811 | ||
812 | core_initcall(pm_disk_init); | |
813 | ||
814 | ||
815 | static int __init resume_setup(char *str) | |
816 | { | |
817 | if (noresume) | |
818 | return 1; | |
819 | ||
820 | strncpy( resume_file, str, 255 ); | |
821 | return 1; | |
822 | } | |
823 | ||
9a154d9d RW |
824 | static int __init resume_offset_setup(char *str) |
825 | { | |
826 | unsigned long long offset; | |
827 | ||
828 | if (noresume) | |
829 | return 1; | |
830 | ||
831 | if (sscanf(str, "%llu", &offset) == 1) | |
832 | swsusp_resume_block = offset; | |
833 | ||
834 | return 1; | |
835 | } | |
836 | ||
1da177e4 LT |
837 | static int __init noresume_setup(char *str) |
838 | { | |
839 | noresume = 1; | |
840 | return 1; | |
841 | } | |
842 | ||
843 | __setup("noresume", noresume_setup); | |
9a154d9d | 844 | __setup("resume_offset=", resume_offset_setup); |
1da177e4 | 845 | __setup("resume=", resume_setup); |