| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
 | 2 |  * resume.c - Functions for waking devices up. | 
 | 3 |  * | 
 | 4 |  * Copyright (c) 2003 Patrick Mochel | 
 | 5 |  * Copyright (c) 2003 Open Source Development Labs | 
 | 6 |  * | 
 | 7 |  * This file is released under the GPLv2 | 
 | 8 |  * | 
 | 9 |  */ | 
 | 10 |  | 
 | 11 | #include <linux/device.h> | 
| Linus Torvalds | d02f40e | 2006-06-24 14:32:18 -0700 | [diff] [blame] | 12 | #include <linux/resume-trace.h> | 
| Adrian Bunk | f67d115 | 2006-01-19 17:30:17 +0100 | [diff] [blame] | 13 | #include "../base.h" | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 14 | #include "power.h" | 
 | 15 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 16 |  | 
 | 17 | /** | 
 | 18 |  *	resume_device - Restore state for one device. | 
 | 19 |  *	@dev:	Device. | 
 | 20 |  * | 
 | 21 |  */ | 
 | 22 |  | 
 | 23 | int resume_device(struct device * dev) | 
 | 24 | { | 
| mochel@digitalimplant.org | af70316 | 2005-03-21 10:41:04 -0800 | [diff] [blame] | 25 | 	int error = 0; | 
 | 26 |  | 
| Linus Torvalds | d02f40e | 2006-06-24 14:32:18 -0700 | [diff] [blame] | 27 | 	TRACE_DEVICE(dev); | 
 | 28 | 	TRACE_RESUME(0); | 
| mochel@digitalimplant.org | af70316 | 2005-03-21 10:41:04 -0800 | [diff] [blame] | 29 | 	down(&dev->sem); | 
| David Brownell | 82428b6 | 2005-05-09 08:07:00 -0700 | [diff] [blame] | 30 | 	if (dev->power.pm_parent | 
| Pavel Machek | ca078ba | 2005-09-03 15:56:57 -0700 | [diff] [blame] | 31 | 			&& dev->power.pm_parent->power.power_state.event) { | 
| David Brownell | 82428b6 | 2005-05-09 08:07:00 -0700 | [diff] [blame] | 32 | 		dev_err(dev, "PM: resume from %d, parent %s still %d\n", | 
| Pavel Machek | ca078ba | 2005-09-03 15:56:57 -0700 | [diff] [blame] | 33 | 			dev->power.power_state.event, | 
| David Brownell | 82428b6 | 2005-05-09 08:07:00 -0700 | [diff] [blame] | 34 | 			dev->power.pm_parent->bus_id, | 
| Pavel Machek | ca078ba | 2005-09-03 15:56:57 -0700 | [diff] [blame] | 35 | 			dev->power.pm_parent->power.power_state.event); | 
| David Brownell | 82428b6 | 2005-05-09 08:07:00 -0700 | [diff] [blame] | 36 | 	} | 
 | 37 | 	if (dev->bus && dev->bus->resume) { | 
 | 38 | 		dev_dbg(dev,"resuming\n"); | 
| mochel@digitalimplant.org | af70316 | 2005-03-21 10:41:04 -0800 | [diff] [blame] | 39 | 		error = dev->bus->resume(dev); | 
| David Brownell | 82428b6 | 2005-05-09 08:07:00 -0700 | [diff] [blame] | 40 | 	} | 
| Linus Torvalds | 7c8265f | 2006-06-24 14:50:29 -0700 | [diff] [blame] | 41 | 	if (dev->class && dev->class->resume) { | 
 | 42 | 		dev_dbg(dev,"class resume\n"); | 
 | 43 | 		error = dev->class->resume(dev); | 
 | 44 | 	} | 
| mochel@digitalimplant.org | af70316 | 2005-03-21 10:41:04 -0800 | [diff] [blame] | 45 | 	up(&dev->sem); | 
| Linus Torvalds | d02f40e | 2006-06-24 14:32:18 -0700 | [diff] [blame] | 46 | 	TRACE_RESUME(error); | 
| mochel@digitalimplant.org | af70316 | 2005-03-21 10:41:04 -0800 | [diff] [blame] | 47 | 	return error; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 48 | } | 
 | 49 |  | 
 | 50 |  | 
| Linus Torvalds | 7c8265f | 2006-06-24 14:50:29 -0700 | [diff] [blame] | 51 | static int resume_device_early(struct device * dev) | 
 | 52 | { | 
 | 53 | 	int error = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 54 |  | 
| Linus Torvalds | 7c8265f | 2006-06-24 14:50:29 -0700 | [diff] [blame] | 55 | 	TRACE_DEVICE(dev); | 
 | 56 | 	TRACE_RESUME(0); | 
 | 57 | 	if (dev->bus && dev->bus->resume_early) { | 
 | 58 | 		dev_dbg(dev,"EARLY resume\n"); | 
 | 59 | 		error = dev->bus->resume_early(dev); | 
 | 60 | 	} | 
 | 61 | 	TRACE_RESUME(error); | 
 | 62 | 	return error; | 
 | 63 | } | 
 | 64 |  | 
 | 65 | /* | 
 | 66 |  * Resume the devices that have either not gone through | 
 | 67 |  * the late suspend, or that did go through it but also | 
 | 68 |  * went through the early resume | 
 | 69 |  */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 70 | void dpm_resume(void) | 
 | 71 | { | 
 | 72 | 	down(&dpm_list_sem); | 
 | 73 | 	while(!list_empty(&dpm_off)) { | 
 | 74 | 		struct list_head * entry = dpm_off.next; | 
 | 75 | 		struct device * dev = to_device(entry); | 
 | 76 |  | 
 | 77 | 		get_device(dev); | 
| Akinobu Mita | 1bfba4e | 2006-06-26 00:24:40 -0700 | [diff] [blame] | 78 | 		list_move_tail(entry, &dpm_active); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 79 |  | 
 | 80 | 		up(&dpm_list_sem); | 
| Pavel Machek | ca078ba | 2005-09-03 15:56:57 -0700 | [diff] [blame] | 81 | 		if (!dev->power.prev_state.event) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 82 | 			resume_device(dev); | 
 | 83 | 		down(&dpm_list_sem); | 
 | 84 | 		put_device(dev); | 
 | 85 | 	} | 
 | 86 | 	up(&dpm_list_sem); | 
 | 87 | } | 
 | 88 |  | 
 | 89 |  | 
 | 90 | /** | 
 | 91 |  *	device_resume - Restore state of each device in system. | 
 | 92 |  * | 
 | 93 |  *	Walk the dpm_off list, remove each entry, resume the device, | 
 | 94 |  *	then add it to the dpm_active list. | 
 | 95 |  */ | 
 | 96 |  | 
 | 97 | void device_resume(void) | 
 | 98 | { | 
| Pavel Machek | bb84c89 | 2006-08-31 22:02:11 -0700 | [diff] [blame] | 99 | 	might_sleep(); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 100 | 	down(&dpm_sem); | 
 | 101 | 	dpm_resume(); | 
 | 102 | 	up(&dpm_sem); | 
 | 103 | } | 
 | 104 |  | 
 | 105 | EXPORT_SYMBOL_GPL(device_resume); | 
 | 106 |  | 
 | 107 |  | 
 | 108 | /** | 
| Dmitry Torokhov | 9de72ee | 2006-07-15 00:31:54 -0400 | [diff] [blame] | 109 |  *	dpm_power_up - Power on some devices. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 110 |  * | 
 | 111 |  *	Walk the dpm_off_irq list and power each device up. This | 
 | 112 |  *	is used for devices that required they be powered down with | 
| Dmitry Torokhov | 9de72ee | 2006-07-15 00:31:54 -0400 | [diff] [blame] | 113 |  *	interrupts disabled. As devices are powered on, they are moved | 
 | 114 |  *	to the dpm_active list. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 115 |  * | 
 | 116 |  *	Interrupts must be disabled when calling this. | 
 | 117 |  */ | 
 | 118 |  | 
 | 119 | void dpm_power_up(void) | 
 | 120 | { | 
 | 121 | 	while(!list_empty(&dpm_off_irq)) { | 
 | 122 | 		struct list_head * entry = dpm_off_irq.next; | 
 | 123 | 		struct device * dev = to_device(entry); | 
 | 124 |  | 
| Linus Torvalds | 7c8265f | 2006-06-24 14:50:29 -0700 | [diff] [blame] | 125 | 		list_move_tail(entry, &dpm_off); | 
 | 126 | 		resume_device_early(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 127 | 	} | 
 | 128 | } | 
 | 129 |  | 
 | 130 |  | 
 | 131 | /** | 
| Dmitry Torokhov | 9de72ee | 2006-07-15 00:31:54 -0400 | [diff] [blame] | 132 |  *	device_power_up - Turn on all devices that need special attention. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 133 |  * | 
 | 134 |  *	Power on system devices then devices that required we shut them down | 
 | 135 |  *	with interrupts disabled. | 
 | 136 |  *	Called with interrupts disabled. | 
 | 137 |  */ | 
 | 138 |  | 
 | 139 | void device_power_up(void) | 
 | 140 | { | 
 | 141 | 	sysdev_resume(); | 
 | 142 | 	dpm_power_up(); | 
 | 143 | } | 
 | 144 |  | 
 | 145 | EXPORT_SYMBOL_GPL(device_power_up); | 
 | 146 |  | 
 | 147 |  |