| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
 | 2 |  * platform.c - platform 'pseudo' bus for legacy devices | 
 | 3 |  * | 
 | 4 |  * Copyright (c) 2002-3 Patrick Mochel | 
 | 5 |  * Copyright (c) 2002-3 Open Source Development Labs | 
 | 6 |  * | 
 | 7 |  * This file is released under the GPLv2 | 
 | 8 |  * | 
 | 9 |  * Please see Documentation/driver-model/platform.txt for more | 
 | 10 |  * information. | 
 | 11 |  */ | 
 | 12 |  | 
| Russell King | d052d1b | 2005-10-29 19:07:23 +0100 | [diff] [blame] | 13 | #include <linux/platform_device.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 14 | #include <linux/module.h> | 
 | 15 | #include <linux/init.h> | 
 | 16 | #include <linux/dma-mapping.h> | 
 | 17 | #include <linux/bootmem.h> | 
 | 18 | #include <linux/err.h> | 
| Tim Schmielau | 4e57b68 | 2005-10-30 15:03:48 -0800 | [diff] [blame] | 19 | #include <linux/slab.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 20 |  | 
| Ben Dooks | a1bdc7a | 2005-10-13 17:54:41 +0100 | [diff] [blame] | 21 | #include "base.h" | 
 | 22 |  | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 23 | #define to_platform_driver(drv)	(container_of((drv), struct platform_driver, \ | 
 | 24 | 				 driver)) | 
| Russell King | 00d3dcd | 2005-11-09 17:23:39 +0000 | [diff] [blame] | 25 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 26 | struct device platform_bus = { | 
 | 27 | 	.bus_id		= "platform", | 
 | 28 | }; | 
| Dmitry Torokhov | a96b204 | 2005-12-10 01:36:28 -0500 | [diff] [blame] | 29 | EXPORT_SYMBOL_GPL(platform_bus); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 30 |  | 
 | 31 | /** | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 32 |  * platform_get_resource - get a resource for a device | 
 | 33 |  * @dev: platform device | 
 | 34 |  * @type: resource type | 
 | 35 |  * @num: resource index | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 36 |  */ | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 37 | struct resource *platform_get_resource(struct platform_device *dev, | 
 | 38 | 				       unsigned int type, unsigned int num) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 39 | { | 
 | 40 | 	int i; | 
 | 41 |  | 
 | 42 | 	for (i = 0; i < dev->num_resources; i++) { | 
 | 43 | 		struct resource *r = &dev->resource[i]; | 
 | 44 |  | 
 | 45 | 		if ((r->flags & (IORESOURCE_IO|IORESOURCE_MEM| | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 46 | 				 IORESOURCE_IRQ|IORESOURCE_DMA)) == type) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 47 | 			if (num-- == 0) | 
 | 48 | 				return r; | 
 | 49 | 	} | 
 | 50 | 	return NULL; | 
 | 51 | } | 
| Dmitry Torokhov | a96b204 | 2005-12-10 01:36:28 -0500 | [diff] [blame] | 52 | EXPORT_SYMBOL_GPL(platform_get_resource); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 53 |  | 
 | 54 | /** | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 55 |  * platform_get_irq - get an IRQ for a device | 
 | 56 |  * @dev: platform device | 
 | 57 |  * @num: IRQ number index | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 58 |  */ | 
 | 59 | int platform_get_irq(struct platform_device *dev, unsigned int num) | 
 | 60 | { | 
 | 61 | 	struct resource *r = platform_get_resource(dev, IORESOURCE_IRQ, num); | 
 | 62 |  | 
| David Vrabel | 305b322 | 2006-01-19 17:52:27 +0000 | [diff] [blame] | 63 | 	return r ? r->start : -ENXIO; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 64 | } | 
| Dmitry Torokhov | a96b204 | 2005-12-10 01:36:28 -0500 | [diff] [blame] | 65 | EXPORT_SYMBOL_GPL(platform_get_irq); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 66 |  | 
 | 67 | /** | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 68 |  * platform_get_resource_byname - get a resource for a device by name | 
 | 69 |  * @dev: platform device | 
 | 70 |  * @type: resource type | 
 | 71 |  * @name: resource name | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 72 |  */ | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 73 | struct resource *platform_get_resource_byname(struct platform_device *dev, | 
 | 74 | 					      unsigned int type, char *name) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 75 | { | 
 | 76 | 	int i; | 
 | 77 |  | 
 | 78 | 	for (i = 0; i < dev->num_resources; i++) { | 
 | 79 | 		struct resource *r = &dev->resource[i]; | 
 | 80 |  | 
 | 81 | 		if ((r->flags & (IORESOURCE_IO|IORESOURCE_MEM| | 
 | 82 | 				 IORESOURCE_IRQ|IORESOURCE_DMA)) == type) | 
 | 83 | 			if (!strcmp(r->name, name)) | 
 | 84 | 				return r; | 
 | 85 | 	} | 
 | 86 | 	return NULL; | 
 | 87 | } | 
| Dmitry Torokhov | a96b204 | 2005-12-10 01:36:28 -0500 | [diff] [blame] | 88 | EXPORT_SYMBOL_GPL(platform_get_resource_byname); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 89 |  | 
 | 90 | /** | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 91 |  * platform_get_irq - get an IRQ for a device | 
 | 92 |  * @dev: platform device | 
 | 93 |  * @name: IRQ name | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 94 |  */ | 
 | 95 | int platform_get_irq_byname(struct platform_device *dev, char *name) | 
 | 96 | { | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 97 | 	struct resource *r = platform_get_resource_byname(dev, IORESOURCE_IRQ, | 
 | 98 | 							  name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 99 |  | 
| David Vrabel | 305b322 | 2006-01-19 17:52:27 +0000 | [diff] [blame] | 100 | 	return r ? r->start : -ENXIO; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 101 | } | 
| Dmitry Torokhov | a96b204 | 2005-12-10 01:36:28 -0500 | [diff] [blame] | 102 | EXPORT_SYMBOL_GPL(platform_get_irq_byname); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 103 |  | 
 | 104 | /** | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 105 |  * platform_add_devices - add a numbers of platform devices | 
 | 106 |  * @devs: array of platform devices to add | 
 | 107 |  * @num: number of platform devices in array | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 108 |  */ | 
 | 109 | int platform_add_devices(struct platform_device **devs, int num) | 
 | 110 | { | 
 | 111 | 	int i, ret = 0; | 
 | 112 |  | 
 | 113 | 	for (i = 0; i < num; i++) { | 
 | 114 | 		ret = platform_device_register(devs[i]); | 
 | 115 | 		if (ret) { | 
 | 116 | 			while (--i >= 0) | 
 | 117 | 				platform_device_unregister(devs[i]); | 
 | 118 | 			break; | 
 | 119 | 		} | 
 | 120 | 	} | 
 | 121 |  | 
 | 122 | 	return ret; | 
 | 123 | } | 
| Dmitry Torokhov | a96b204 | 2005-12-10 01:36:28 -0500 | [diff] [blame] | 124 | EXPORT_SYMBOL_GPL(platform_add_devices); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 125 |  | 
| Russell King | 37c12e7 | 2005-11-05 21:19:33 +0000 | [diff] [blame] | 126 | struct platform_object { | 
 | 127 | 	struct platform_device pdev; | 
 | 128 | 	char name[1]; | 
 | 129 | }; | 
 | 130 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 131 | /** | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 132 |  * platform_device_put | 
 | 133 |  * @pdev: platform device to free | 
| Russell King | 37c12e7 | 2005-11-05 21:19:33 +0000 | [diff] [blame] | 134 |  * | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 135 |  * Free all memory associated with a platform device.  This function must | 
 | 136 |  * _only_ be externally called in error cases.  All other usage is a bug. | 
| Russell King | 37c12e7 | 2005-11-05 21:19:33 +0000 | [diff] [blame] | 137 |  */ | 
 | 138 | void platform_device_put(struct platform_device *pdev) | 
 | 139 | { | 
 | 140 | 	if (pdev) | 
 | 141 | 		put_device(&pdev->dev); | 
 | 142 | } | 
 | 143 | EXPORT_SYMBOL_GPL(platform_device_put); | 
 | 144 |  | 
 | 145 | static void platform_device_release(struct device *dev) | 
 | 146 | { | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 147 | 	struct platform_object *pa = container_of(dev, struct platform_object, | 
 | 148 | 						  pdev.dev); | 
| Russell King | 37c12e7 | 2005-11-05 21:19:33 +0000 | [diff] [blame] | 149 |  | 
 | 150 | 	kfree(pa->pdev.dev.platform_data); | 
 | 151 | 	kfree(pa->pdev.resource); | 
 | 152 | 	kfree(pa); | 
 | 153 | } | 
 | 154 |  | 
 | 155 | /** | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 156 |  * platform_device_alloc | 
 | 157 |  * @name: base name of the device we're adding | 
 | 158 |  * @id: instance id | 
| Russell King | 37c12e7 | 2005-11-05 21:19:33 +0000 | [diff] [blame] | 159 |  * | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 160 |  * Create a platform device object which can have other objects attached | 
 | 161 |  * to it, and which will have attached objects freed when it is released. | 
| Russell King | 37c12e7 | 2005-11-05 21:19:33 +0000 | [diff] [blame] | 162 |  */ | 
| Jean Delvare | 1359555 | 2007-09-09 12:54:16 +0200 | [diff] [blame] | 163 | struct platform_device *platform_device_alloc(const char *name, int id) | 
| Russell King | 37c12e7 | 2005-11-05 21:19:33 +0000 | [diff] [blame] | 164 | { | 
 | 165 | 	struct platform_object *pa; | 
 | 166 |  | 
 | 167 | 	pa = kzalloc(sizeof(struct platform_object) + strlen(name), GFP_KERNEL); | 
 | 168 | 	if (pa) { | 
 | 169 | 		strcpy(pa->name, name); | 
 | 170 | 		pa->pdev.name = pa->name; | 
 | 171 | 		pa->pdev.id = id; | 
 | 172 | 		device_initialize(&pa->pdev.dev); | 
 | 173 | 		pa->pdev.dev.release = platform_device_release; | 
 | 174 | 	} | 
 | 175 |  | 
| Dmitry Torokhov | 93ce306 | 2005-12-10 01:36:27 -0500 | [diff] [blame] | 176 | 	return pa ? &pa->pdev : NULL; | 
| Russell King | 37c12e7 | 2005-11-05 21:19:33 +0000 | [diff] [blame] | 177 | } | 
 | 178 | EXPORT_SYMBOL_GPL(platform_device_alloc); | 
 | 179 |  | 
 | 180 | /** | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 181 |  * platform_device_add_resources | 
 | 182 |  * @pdev: platform device allocated by platform_device_alloc to add resources to | 
 | 183 |  * @res: set of resources that needs to be allocated for the device | 
 | 184 |  * @num: number of resources | 
| Russell King | 37c12e7 | 2005-11-05 21:19:33 +0000 | [diff] [blame] | 185 |  * | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 186 |  * Add a copy of the resources to the platform device.  The memory | 
 | 187 |  * associated with the resources will be freed when the platform device is | 
 | 188 |  * released. | 
| Russell King | 37c12e7 | 2005-11-05 21:19:33 +0000 | [diff] [blame] | 189 |  */ | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 190 | int platform_device_add_resources(struct platform_device *pdev, | 
 | 191 | 				  struct resource *res, unsigned int num) | 
| Russell King | 37c12e7 | 2005-11-05 21:19:33 +0000 | [diff] [blame] | 192 | { | 
 | 193 | 	struct resource *r; | 
 | 194 |  | 
 | 195 | 	r = kmalloc(sizeof(struct resource) * num, GFP_KERNEL); | 
 | 196 | 	if (r) { | 
 | 197 | 		memcpy(r, res, sizeof(struct resource) * num); | 
 | 198 | 		pdev->resource = r; | 
 | 199 | 		pdev->num_resources = num; | 
 | 200 | 	} | 
 | 201 | 	return r ? 0 : -ENOMEM; | 
 | 202 | } | 
 | 203 | EXPORT_SYMBOL_GPL(platform_device_add_resources); | 
 | 204 |  | 
 | 205 | /** | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 206 |  * platform_device_add_data | 
 | 207 |  * @pdev: platform device allocated by platform_device_alloc to add resources to | 
 | 208 |  * @data: platform specific data for this platform device | 
 | 209 |  * @size: size of platform specific data | 
| Russell King | 37c12e7 | 2005-11-05 21:19:33 +0000 | [diff] [blame] | 210 |  * | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 211 |  * Add a copy of platform specific data to the platform device's | 
 | 212 |  * platform_data pointer.  The memory associated with the platform data | 
 | 213 |  * will be freed when the platform device is released. | 
| Russell King | 37c12e7 | 2005-11-05 21:19:33 +0000 | [diff] [blame] | 214 |  */ | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 215 | int platform_device_add_data(struct platform_device *pdev, const void *data, | 
 | 216 | 			     size_t size) | 
| Russell King | 37c12e7 | 2005-11-05 21:19:33 +0000 | [diff] [blame] | 217 | { | 
 | 218 | 	void *d; | 
 | 219 |  | 
 | 220 | 	d = kmalloc(size, GFP_KERNEL); | 
 | 221 | 	if (d) { | 
 | 222 | 		memcpy(d, data, size); | 
 | 223 | 		pdev->dev.platform_data = d; | 
 | 224 | 	} | 
 | 225 | 	return d ? 0 : -ENOMEM; | 
 | 226 | } | 
 | 227 | EXPORT_SYMBOL_GPL(platform_device_add_data); | 
 | 228 |  | 
 | 229 | /** | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 230 |  * platform_device_add - add a platform device to device hierarchy | 
 | 231 |  * @pdev: platform device we're adding | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 232 |  * | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 233 |  * This is part 2 of platform_device_register(), though may be called | 
 | 234 |  * separately _iff_ pdev was allocated by platform_device_alloc(). | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 235 |  */ | 
| Russell King | 37c12e7 | 2005-11-05 21:19:33 +0000 | [diff] [blame] | 236 | int platform_device_add(struct platform_device *pdev) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 237 | { | 
 | 238 | 	int i, ret = 0; | 
 | 239 |  | 
 | 240 | 	if (!pdev) | 
 | 241 | 		return -EINVAL; | 
 | 242 |  | 
 | 243 | 	if (!pdev->dev.parent) | 
 | 244 | 		pdev->dev.parent = &platform_bus; | 
 | 245 |  | 
 | 246 | 	pdev->dev.bus = &platform_bus_type; | 
 | 247 |  | 
 | 248 | 	if (pdev->id != -1) | 
| Jean Delvare | 1359555 | 2007-09-09 12:54:16 +0200 | [diff] [blame] | 249 | 		snprintf(pdev->dev.bus_id, BUS_ID_SIZE, "%s.%d", pdev->name, | 
 | 250 | 			 pdev->id); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 251 | 	else | 
 | 252 | 		strlcpy(pdev->dev.bus_id, pdev->name, BUS_ID_SIZE); | 
 | 253 |  | 
 | 254 | 	for (i = 0; i < pdev->num_resources; i++) { | 
 | 255 | 		struct resource *p, *r = &pdev->resource[i]; | 
 | 256 |  | 
 | 257 | 		if (r->name == NULL) | 
 | 258 | 			r->name = pdev->dev.bus_id; | 
 | 259 |  | 
 | 260 | 		p = r->parent; | 
 | 261 | 		if (!p) { | 
 | 262 | 			if (r->flags & IORESOURCE_MEM) | 
 | 263 | 				p = &iomem_resource; | 
 | 264 | 			else if (r->flags & IORESOURCE_IO) | 
 | 265 | 				p = &ioport_resource; | 
 | 266 | 		} | 
 | 267 |  | 
| Kumar Gala | d960bb4 | 2005-11-28 10:15:39 -0600 | [diff] [blame] | 268 | 		if (p && insert_resource(p, r)) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 269 | 			printk(KERN_ERR | 
 | 270 | 			       "%s: failed to claim resource %d\n", | 
 | 271 | 			       pdev->dev.bus_id, i); | 
 | 272 | 			ret = -EBUSY; | 
 | 273 | 			goto failed; | 
 | 274 | 		} | 
 | 275 | 	} | 
 | 276 |  | 
 | 277 | 	pr_debug("Registering platform device '%s'. Parent at %s\n", | 
 | 278 | 		 pdev->dev.bus_id, pdev->dev.parent->bus_id); | 
 | 279 |  | 
| Russell King | e391553 | 2006-05-06 08:15:26 +0100 | [diff] [blame] | 280 | 	ret = device_add(&pdev->dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 281 | 	if (ret == 0) | 
 | 282 | 		return ret; | 
 | 283 |  | 
 | 284 |  failed: | 
 | 285 | 	while (--i >= 0) | 
 | 286 | 		if (pdev->resource[i].flags & (IORESOURCE_MEM|IORESOURCE_IO)) | 
 | 287 | 			release_resource(&pdev->resource[i]); | 
 | 288 | 	return ret; | 
 | 289 | } | 
| Russell King | 37c12e7 | 2005-11-05 21:19:33 +0000 | [diff] [blame] | 290 | EXPORT_SYMBOL_GPL(platform_device_add); | 
 | 291 |  | 
 | 292 | /** | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 293 |  * platform_device_del - remove a platform-level device | 
 | 294 |  * @pdev: platform device we're removing | 
| Dmitry Torokhov | 93ce306 | 2005-12-10 01:36:27 -0500 | [diff] [blame] | 295 |  * | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 296 |  * Note that this function will also release all memory- and port-based | 
 | 297 |  * resources owned by the device (@dev->resource).  This function must | 
 | 298 |  * _only_ be externally called in error cases.  All other usage is a bug. | 
| Dmitry Torokhov | 93ce306 | 2005-12-10 01:36:27 -0500 | [diff] [blame] | 299 |  */ | 
 | 300 | void platform_device_del(struct platform_device *pdev) | 
 | 301 | { | 
 | 302 | 	int i; | 
 | 303 |  | 
 | 304 | 	if (pdev) { | 
| Jean Delvare | dc4c15d | 2007-05-02 20:55:54 +0200 | [diff] [blame] | 305 | 		device_del(&pdev->dev); | 
 | 306 |  | 
| Dmitry Torokhov | 93ce306 | 2005-12-10 01:36:27 -0500 | [diff] [blame] | 307 | 		for (i = 0; i < pdev->num_resources; i++) { | 
 | 308 | 			struct resource *r = &pdev->resource[i]; | 
 | 309 | 			if (r->flags & (IORESOURCE_MEM|IORESOURCE_IO)) | 
 | 310 | 				release_resource(r); | 
 | 311 | 		} | 
| Dmitry Torokhov | 93ce306 | 2005-12-10 01:36:27 -0500 | [diff] [blame] | 312 | 	} | 
 | 313 | } | 
 | 314 | EXPORT_SYMBOL_GPL(platform_device_del); | 
 | 315 |  | 
 | 316 | /** | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 317 |  * platform_device_register - add a platform-level device | 
 | 318 |  * @pdev: platform device we're adding | 
| Russell King | 37c12e7 | 2005-11-05 21:19:33 +0000 | [diff] [blame] | 319 |  */ | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 320 | int platform_device_register(struct platform_device *pdev) | 
| Russell King | 37c12e7 | 2005-11-05 21:19:33 +0000 | [diff] [blame] | 321 | { | 
 | 322 | 	device_initialize(&pdev->dev); | 
 | 323 | 	return platform_device_add(pdev); | 
 | 324 | } | 
| Dmitry Torokhov | a96b204 | 2005-12-10 01:36:28 -0500 | [diff] [blame] | 325 | EXPORT_SYMBOL_GPL(platform_device_register); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 326 |  | 
 | 327 | /** | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 328 |  * platform_device_unregister - unregister a platform-level device | 
 | 329 |  * @pdev: platform device we're unregistering | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 330 |  * | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 331 |  * Unregistration is done in 2 steps. First we release all resources | 
 | 332 |  * and remove it from the subsystem, then we drop reference count by | 
 | 333 |  * calling platform_device_put(). | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 334 |  */ | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 335 | void platform_device_unregister(struct platform_device *pdev) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 336 | { | 
| Dmitry Torokhov | 93ce306 | 2005-12-10 01:36:27 -0500 | [diff] [blame] | 337 | 	platform_device_del(pdev); | 
 | 338 | 	platform_device_put(pdev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 339 | } | 
| Dmitry Torokhov | a96b204 | 2005-12-10 01:36:28 -0500 | [diff] [blame] | 340 | EXPORT_SYMBOL_GPL(platform_device_unregister); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 341 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 342 | /** | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 343 |  * platform_device_register_simple | 
 | 344 |  * @name: base name of the device we're adding | 
 | 345 |  * @id: instance id | 
 | 346 |  * @res: set of resources that needs to be allocated for the device | 
 | 347 |  * @num: number of resources | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 348 |  * | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 349 |  * This function creates a simple platform device that requires minimal | 
 | 350 |  * resource and memory management. Canned release function freeing memory | 
 | 351 |  * allocated for the device allows drivers using such devices to be | 
 | 352 |  * unloaded without waiting for the last reference to the device to be | 
 | 353 |  * dropped. | 
| David Brownell | 49a4ec1 | 2007-05-08 00:29:39 -0700 | [diff] [blame] | 354 |  * | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 355 |  * This interface is primarily intended for use with legacy drivers which | 
 | 356 |  * probe hardware directly.  Because such drivers create sysfs device nodes | 
 | 357 |  * themselves, rather than letting system infrastructure handle such device | 
 | 358 |  * enumeration tasks, they don't fully conform to the Linux driver model. | 
 | 359 |  * In particular, when such drivers are built as modules, they can't be | 
 | 360 |  * "hotplugged". | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 361 |  */ | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 362 | struct platform_device *platform_device_register_simple(const char *name, | 
 | 363 | 							int id, | 
 | 364 | 							struct resource *res, | 
 | 365 | 							unsigned int num) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 366 | { | 
| Russell King | 37c12e7 | 2005-11-05 21:19:33 +0000 | [diff] [blame] | 367 | 	struct platform_device *pdev; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 368 | 	int retval; | 
 | 369 |  | 
| Russell King | 37c12e7 | 2005-11-05 21:19:33 +0000 | [diff] [blame] | 370 | 	pdev = platform_device_alloc(name, id); | 
 | 371 | 	if (!pdev) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 372 | 		retval = -ENOMEM; | 
 | 373 | 		goto error; | 
 | 374 | 	} | 
 | 375 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 376 | 	if (num) { | 
| Russell King | 37c12e7 | 2005-11-05 21:19:33 +0000 | [diff] [blame] | 377 | 		retval = platform_device_add_resources(pdev, res, num); | 
 | 378 | 		if (retval) | 
 | 379 | 			goto error; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 380 | 	} | 
 | 381 |  | 
| Russell King | 37c12e7 | 2005-11-05 21:19:33 +0000 | [diff] [blame] | 382 | 	retval = platform_device_add(pdev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 383 | 	if (retval) | 
 | 384 | 		goto error; | 
 | 385 |  | 
| Russell King | 37c12e7 | 2005-11-05 21:19:33 +0000 | [diff] [blame] | 386 | 	return pdev; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 387 |  | 
 | 388 | error: | 
| Russell King | 37c12e7 | 2005-11-05 21:19:33 +0000 | [diff] [blame] | 389 | 	platform_device_put(pdev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 390 | 	return ERR_PTR(retval); | 
 | 391 | } | 
| Dmitry Torokhov | a96b204 | 2005-12-10 01:36:28 -0500 | [diff] [blame] | 392 | EXPORT_SYMBOL_GPL(platform_device_register_simple); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 393 |  | 
| Russell King | 00d3dcd | 2005-11-09 17:23:39 +0000 | [diff] [blame] | 394 | static int platform_drv_probe(struct device *_dev) | 
 | 395 | { | 
 | 396 | 	struct platform_driver *drv = to_platform_driver(_dev->driver); | 
 | 397 | 	struct platform_device *dev = to_platform_device(_dev); | 
 | 398 |  | 
 | 399 | 	return drv->probe(dev); | 
 | 400 | } | 
 | 401 |  | 
| David Brownell | c67334f | 2006-11-16 23:28:47 -0800 | [diff] [blame] | 402 | static int platform_drv_probe_fail(struct device *_dev) | 
 | 403 | { | 
 | 404 | 	return -ENXIO; | 
 | 405 | } | 
 | 406 |  | 
| Russell King | 00d3dcd | 2005-11-09 17:23:39 +0000 | [diff] [blame] | 407 | static int platform_drv_remove(struct device *_dev) | 
 | 408 | { | 
 | 409 | 	struct platform_driver *drv = to_platform_driver(_dev->driver); | 
 | 410 | 	struct platform_device *dev = to_platform_device(_dev); | 
 | 411 |  | 
 | 412 | 	return drv->remove(dev); | 
 | 413 | } | 
 | 414 |  | 
 | 415 | static void platform_drv_shutdown(struct device *_dev) | 
 | 416 | { | 
 | 417 | 	struct platform_driver *drv = to_platform_driver(_dev->driver); | 
 | 418 | 	struct platform_device *dev = to_platform_device(_dev); | 
 | 419 |  | 
 | 420 | 	drv->shutdown(dev); | 
 | 421 | } | 
 | 422 |  | 
 | 423 | static int platform_drv_suspend(struct device *_dev, pm_message_t state) | 
 | 424 | { | 
 | 425 | 	struct platform_driver *drv = to_platform_driver(_dev->driver); | 
 | 426 | 	struct platform_device *dev = to_platform_device(_dev); | 
 | 427 |  | 
 | 428 | 	return drv->suspend(dev, state); | 
 | 429 | } | 
 | 430 |  | 
 | 431 | static int platform_drv_resume(struct device *_dev) | 
 | 432 | { | 
 | 433 | 	struct platform_driver *drv = to_platform_driver(_dev->driver); | 
 | 434 | 	struct platform_device *dev = to_platform_device(_dev); | 
 | 435 |  | 
 | 436 | 	return drv->resume(dev); | 
 | 437 | } | 
 | 438 |  | 
 | 439 | /** | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 440 |  * platform_driver_register | 
 | 441 |  * @drv: platform driver structure | 
| Russell King | 00d3dcd | 2005-11-09 17:23:39 +0000 | [diff] [blame] | 442 |  */ | 
 | 443 | int platform_driver_register(struct platform_driver *drv) | 
 | 444 | { | 
 | 445 | 	drv->driver.bus = &platform_bus_type; | 
 | 446 | 	if (drv->probe) | 
 | 447 | 		drv->driver.probe = platform_drv_probe; | 
 | 448 | 	if (drv->remove) | 
 | 449 | 		drv->driver.remove = platform_drv_remove; | 
 | 450 | 	if (drv->shutdown) | 
 | 451 | 		drv->driver.shutdown = platform_drv_shutdown; | 
 | 452 | 	if (drv->suspend) | 
 | 453 | 		drv->driver.suspend = platform_drv_suspend; | 
 | 454 | 	if (drv->resume) | 
 | 455 | 		drv->driver.resume = platform_drv_resume; | 
| Rafael J. Wysocki | 25e1849 | 2008-05-21 01:40:43 +0200 | [diff] [blame] | 456 | 	if (drv->pm) | 
 | 457 | 		drv->driver.pm = &drv->pm->base; | 
| Russell King | 00d3dcd | 2005-11-09 17:23:39 +0000 | [diff] [blame] | 458 | 	return driver_register(&drv->driver); | 
 | 459 | } | 
 | 460 | EXPORT_SYMBOL_GPL(platform_driver_register); | 
 | 461 |  | 
 | 462 | /** | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 463 |  * platform_driver_unregister | 
 | 464 |  * @drv: platform driver structure | 
| Russell King | 00d3dcd | 2005-11-09 17:23:39 +0000 | [diff] [blame] | 465 |  */ | 
 | 466 | void platform_driver_unregister(struct platform_driver *drv) | 
 | 467 | { | 
 | 468 | 	driver_unregister(&drv->driver); | 
 | 469 | } | 
 | 470 | EXPORT_SYMBOL_GPL(platform_driver_unregister); | 
 | 471 |  | 
| David Brownell | c67334f | 2006-11-16 23:28:47 -0800 | [diff] [blame] | 472 | /** | 
 | 473 |  * platform_driver_probe - register driver for non-hotpluggable device | 
 | 474 |  * @drv: platform driver structure | 
 | 475 |  * @probe: the driver probe routine, probably from an __init section | 
 | 476 |  * | 
 | 477 |  * Use this instead of platform_driver_register() when you know the device | 
 | 478 |  * is not hotpluggable and has already been registered, and you want to | 
 | 479 |  * remove its run-once probe() infrastructure from memory after the driver | 
 | 480 |  * has bound to the device. | 
 | 481 |  * | 
 | 482 |  * One typical use for this would be with drivers for controllers integrated | 
 | 483 |  * into system-on-chip processors, where the controller devices have been | 
 | 484 |  * configured as part of board setup. | 
 | 485 |  * | 
 | 486 |  * Returns zero if the driver registered and bound to a device, else returns | 
 | 487 |  * a negative error code and with the driver not registered. | 
 | 488 |  */ | 
| Andrew Morton | c63e078 | 2006-12-04 14:56:36 -0800 | [diff] [blame] | 489 | int __init_or_module platform_driver_probe(struct platform_driver *drv, | 
| David Brownell | c67334f | 2006-11-16 23:28:47 -0800 | [diff] [blame] | 490 | 		int (*probe)(struct platform_device *)) | 
 | 491 | { | 
 | 492 | 	int retval, code; | 
 | 493 |  | 
 | 494 | 	/* temporary section violation during probe() */ | 
 | 495 | 	drv->probe = probe; | 
 | 496 | 	retval = code = platform_driver_register(drv); | 
 | 497 |  | 
 | 498 | 	/* Fixup that section violation, being paranoid about code scanning | 
 | 499 | 	 * the list of drivers in order to probe new devices.  Check to see | 
 | 500 | 	 * if the probe was successful, and make sure any forced probes of | 
 | 501 | 	 * new devices fail. | 
 | 502 | 	 */ | 
| Greg Kroah-Hartman | c6f7e72 | 2007-11-01 19:41:16 -0700 | [diff] [blame] | 503 | 	spin_lock(&platform_bus_type.p->klist_drivers.k_lock); | 
| David Brownell | c67334f | 2006-11-16 23:28:47 -0800 | [diff] [blame] | 504 | 	drv->probe = NULL; | 
| Greg Kroah-Hartman | e5dd127 | 2007-11-28 15:59:15 -0800 | [diff] [blame] | 505 | 	if (code == 0 && list_empty(&drv->driver.p->klist_devices.k_list)) | 
| David Brownell | c67334f | 2006-11-16 23:28:47 -0800 | [diff] [blame] | 506 | 		retval = -ENODEV; | 
 | 507 | 	drv->driver.probe = platform_drv_probe_fail; | 
| Greg Kroah-Hartman | c6f7e72 | 2007-11-01 19:41:16 -0700 | [diff] [blame] | 508 | 	spin_unlock(&platform_bus_type.p->klist_drivers.k_lock); | 
| David Brownell | c67334f | 2006-11-16 23:28:47 -0800 | [diff] [blame] | 509 |  | 
 | 510 | 	if (code != retval) | 
 | 511 | 		platform_driver_unregister(drv); | 
 | 512 | 	return retval; | 
 | 513 | } | 
 | 514 | EXPORT_SYMBOL_GPL(platform_driver_probe); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 515 |  | 
| David Brownell | a0245f7 | 2006-05-29 10:37:33 -0700 | [diff] [blame] | 516 | /* modalias support enables more hands-off userspace setup: | 
 | 517 |  * (a) environment variable lets new-style hotplug events work once system is | 
 | 518 |  *     fully running:  "modprobe $MODALIAS" | 
 | 519 |  * (b) sysfs attribute lets new-style coldplug recover from hotplug events | 
 | 520 |  *     mishandled before system is fully running:  "modprobe $(cat modalias)" | 
 | 521 |  */ | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 522 | static ssize_t modalias_show(struct device *dev, struct device_attribute *a, | 
 | 523 | 			     char *buf) | 
| David Brownell | a0245f7 | 2006-05-29 10:37:33 -0700 | [diff] [blame] | 524 | { | 
 | 525 | 	struct platform_device	*pdev = to_platform_device(dev); | 
| Kay Sievers | 43cc71e | 2007-08-18 04:40:39 +0200 | [diff] [blame] | 526 | 	int len = snprintf(buf, PAGE_SIZE, "platform:%s\n", pdev->name); | 
| David Brownell | a0245f7 | 2006-05-29 10:37:33 -0700 | [diff] [blame] | 527 |  | 
 | 528 | 	return (len >= PAGE_SIZE) ? (PAGE_SIZE - 1) : len; | 
 | 529 | } | 
 | 530 |  | 
 | 531 | static struct device_attribute platform_dev_attrs[] = { | 
 | 532 | 	__ATTR_RO(modalias), | 
 | 533 | 	__ATTR_NULL, | 
 | 534 | }; | 
 | 535 |  | 
| Kay Sievers | 7eff2e7 | 2007-08-14 15:15:12 +0200 | [diff] [blame] | 536 | static int platform_uevent(struct device *dev, struct kobj_uevent_env *env) | 
| David Brownell | a0245f7 | 2006-05-29 10:37:33 -0700 | [diff] [blame] | 537 | { | 
 | 538 | 	struct platform_device	*pdev = to_platform_device(dev); | 
 | 539 |  | 
| Kay Sievers | 7eff2e7 | 2007-08-14 15:15:12 +0200 | [diff] [blame] | 540 | 	add_uevent_var(env, "MODALIAS=platform:%s", pdev->name); | 
| David Brownell | a0245f7 | 2006-05-29 10:37:33 -0700 | [diff] [blame] | 541 | 	return 0; | 
 | 542 | } | 
 | 543 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 544 | /** | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 545 |  * platform_match - bind platform device to platform driver. | 
 | 546 |  * @dev: device. | 
 | 547 |  * @drv: driver. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 548 |  * | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 549 |  * Platform device IDs are assumed to be encoded like this: | 
 | 550 |  * "<name><instance>", where <name> is a short description of the type of | 
 | 551 |  * device, like "pci" or "floppy", and <instance> is the enumerated | 
 | 552 |  * instance of the device, like '0' or '42'.  Driver IDs are simply | 
 | 553 |  * "<name>".  So, extract the <name> from the platform_device structure, | 
 | 554 |  * and compare it against the name of the driver. Return whether they match | 
 | 555 |  * or not. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 556 |  */ | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 557 | static int platform_match(struct device *dev, struct device_driver *drv) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 558 | { | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 559 | 	struct platform_device *pdev; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 560 |  | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 561 | 	pdev = container_of(dev, struct platform_device, dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 562 | 	return (strncmp(pdev->name, drv->name, BUS_ID_SIZE) == 0); | 
 | 563 | } | 
 | 564 |  | 
| Rafael J. Wysocki | 25e1849 | 2008-05-21 01:40:43 +0200 | [diff] [blame] | 565 | #ifdef CONFIG_PM_SLEEP | 
 | 566 |  | 
 | 567 | static int platform_legacy_suspend(struct device *dev, pm_message_t mesg) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 568 | { | 
 | 569 | 	int ret = 0; | 
 | 570 |  | 
| Russell King | 9480e30 | 2005-10-28 09:52:56 -0700 | [diff] [blame] | 571 | 	if (dev->driver && dev->driver->suspend) | 
| David Brownell | 386415d8 | 2006-09-03 13:16:45 -0700 | [diff] [blame] | 572 | 		ret = dev->driver->suspend(dev, mesg); | 
 | 573 |  | 
 | 574 | 	return ret; | 
 | 575 | } | 
 | 576 |  | 
| Rafael J. Wysocki | 25e1849 | 2008-05-21 01:40:43 +0200 | [diff] [blame] | 577 | static int platform_legacy_suspend_late(struct device *dev, pm_message_t mesg) | 
| David Brownell | 386415d8 | 2006-09-03 13:16:45 -0700 | [diff] [blame] | 578 | { | 
 | 579 | 	struct platform_driver *drv = to_platform_driver(dev->driver); | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 580 | 	struct platform_device *pdev; | 
| David Brownell | 386415d8 | 2006-09-03 13:16:45 -0700 | [diff] [blame] | 581 | 	int ret = 0; | 
 | 582 |  | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 583 | 	pdev = container_of(dev, struct platform_device, dev); | 
| David Brownell | 386415d8 | 2006-09-03 13:16:45 -0700 | [diff] [blame] | 584 | 	if (dev->driver && drv->suspend_late) | 
 | 585 | 		ret = drv->suspend_late(pdev, mesg); | 
 | 586 |  | 
 | 587 | 	return ret; | 
 | 588 | } | 
 | 589 |  | 
| Rafael J. Wysocki | 25e1849 | 2008-05-21 01:40:43 +0200 | [diff] [blame] | 590 | static int platform_legacy_resume_early(struct device *dev) | 
| David Brownell | 386415d8 | 2006-09-03 13:16:45 -0700 | [diff] [blame] | 591 | { | 
 | 592 | 	struct platform_driver *drv = to_platform_driver(dev->driver); | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 593 | 	struct platform_device *pdev; | 
| David Brownell | 386415d8 | 2006-09-03 13:16:45 -0700 | [diff] [blame] | 594 | 	int ret = 0; | 
 | 595 |  | 
| Greg Kroah-Hartman | 4a3ad20 | 2008-01-24 22:50:12 -0800 | [diff] [blame] | 596 | 	pdev = container_of(dev, struct platform_device, dev); | 
| David Brownell | 386415d8 | 2006-09-03 13:16:45 -0700 | [diff] [blame] | 597 | 	if (dev->driver && drv->resume_early) | 
 | 598 | 		ret = drv->resume_early(pdev); | 
| Russell King | 9480e30 | 2005-10-28 09:52:56 -0700 | [diff] [blame] | 599 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 600 | 	return ret; | 
 | 601 | } | 
 | 602 |  | 
| Rafael J. Wysocki | 25e1849 | 2008-05-21 01:40:43 +0200 | [diff] [blame] | 603 | static int platform_legacy_resume(struct device *dev) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 604 | { | 
 | 605 | 	int ret = 0; | 
 | 606 |  | 
| Russell King | 9480e30 | 2005-10-28 09:52:56 -0700 | [diff] [blame] | 607 | 	if (dev->driver && dev->driver->resume) | 
 | 608 | 		ret = dev->driver->resume(dev); | 
 | 609 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 610 | 	return ret; | 
 | 611 | } | 
 | 612 |  | 
| Rafael J. Wysocki | 25e1849 | 2008-05-21 01:40:43 +0200 | [diff] [blame] | 613 | static int platform_pm_prepare(struct device *dev) | 
 | 614 | { | 
 | 615 | 	struct device_driver *drv = dev->driver; | 
 | 616 | 	int ret = 0; | 
 | 617 |  | 
 | 618 | 	if (drv && drv->pm && drv->pm->prepare) | 
 | 619 | 		ret = drv->pm->prepare(dev); | 
 | 620 |  | 
 | 621 | 	return ret; | 
 | 622 | } | 
 | 623 |  | 
 | 624 | static void platform_pm_complete(struct device *dev) | 
 | 625 | { | 
 | 626 | 	struct device_driver *drv = dev->driver; | 
 | 627 |  | 
 | 628 | 	if (drv && drv->pm && drv->pm->complete) | 
 | 629 | 		drv->pm->complete(dev); | 
 | 630 | } | 
 | 631 |  | 
 | 632 | #ifdef CONFIG_SUSPEND | 
 | 633 |  | 
 | 634 | static int platform_pm_suspend(struct device *dev) | 
 | 635 | { | 
 | 636 | 	struct device_driver *drv = dev->driver; | 
 | 637 | 	int ret = 0; | 
 | 638 |  | 
 | 639 | 	if (drv && drv->pm) { | 
 | 640 | 		if (drv->pm->suspend) | 
 | 641 | 			ret = drv->pm->suspend(dev); | 
 | 642 | 	} else { | 
 | 643 | 		ret = platform_legacy_suspend(dev, PMSG_SUSPEND); | 
 | 644 | 	} | 
 | 645 |  | 
 | 646 | 	return ret; | 
 | 647 | } | 
 | 648 |  | 
 | 649 | static int platform_pm_suspend_noirq(struct device *dev) | 
 | 650 | { | 
 | 651 | 	struct platform_driver *pdrv; | 
 | 652 | 	int ret = 0; | 
 | 653 |  | 
 | 654 | 	if (!dev->driver) | 
 | 655 | 		return 0; | 
 | 656 |  | 
 | 657 | 	pdrv = to_platform_driver(dev->driver); | 
 | 658 | 	if (pdrv->pm) { | 
 | 659 | 		if (pdrv->pm->suspend_noirq) | 
 | 660 | 			ret = pdrv->pm->suspend_noirq(dev); | 
 | 661 | 	} else { | 
 | 662 | 		ret = platform_legacy_suspend_late(dev, PMSG_SUSPEND); | 
 | 663 | 	} | 
 | 664 |  | 
 | 665 | 	return ret; | 
 | 666 | } | 
 | 667 |  | 
 | 668 | static int platform_pm_resume(struct device *dev) | 
 | 669 | { | 
 | 670 | 	struct device_driver *drv = dev->driver; | 
 | 671 | 	int ret = 0; | 
 | 672 |  | 
 | 673 | 	if (drv && drv->pm) { | 
 | 674 | 		if (drv->pm->resume) | 
 | 675 | 			ret = drv->pm->resume(dev); | 
 | 676 | 	} else { | 
 | 677 | 		ret = platform_legacy_resume(dev); | 
 | 678 | 	} | 
 | 679 |  | 
 | 680 | 	return ret; | 
 | 681 | } | 
 | 682 |  | 
 | 683 | static int platform_pm_resume_noirq(struct device *dev) | 
 | 684 | { | 
 | 685 | 	struct platform_driver *pdrv; | 
 | 686 | 	int ret = 0; | 
 | 687 |  | 
 | 688 | 	if (!dev->driver) | 
 | 689 | 		return 0; | 
 | 690 |  | 
 | 691 | 	pdrv = to_platform_driver(dev->driver); | 
 | 692 | 	if (pdrv->pm) { | 
 | 693 | 		if (pdrv->pm->resume_noirq) | 
 | 694 | 			ret = pdrv->pm->resume_noirq(dev); | 
 | 695 | 	} else { | 
 | 696 | 		ret = platform_legacy_resume_early(dev); | 
 | 697 | 	} | 
 | 698 |  | 
 | 699 | 	return ret; | 
 | 700 | } | 
 | 701 |  | 
 | 702 | #else /* !CONFIG_SUSPEND */ | 
 | 703 |  | 
 | 704 | #define platform_pm_suspend		NULL | 
 | 705 | #define platform_pm_resume		NULL | 
 | 706 | #define platform_pm_suspend_noirq	NULL | 
 | 707 | #define platform_pm_resume_noirq	NULL | 
 | 708 |  | 
 | 709 | #endif /* !CONFIG_SUSPEND */ | 
 | 710 |  | 
 | 711 | #ifdef CONFIG_HIBERNATION | 
 | 712 |  | 
 | 713 | static int platform_pm_freeze(struct device *dev) | 
 | 714 | { | 
 | 715 | 	struct device_driver *drv = dev->driver; | 
 | 716 | 	int ret = 0; | 
 | 717 |  | 
 | 718 | 	if (!drv) | 
 | 719 | 		return 0; | 
 | 720 |  | 
 | 721 | 	if (drv->pm) { | 
 | 722 | 		if (drv->pm->freeze) | 
 | 723 | 			ret = drv->pm->freeze(dev); | 
 | 724 | 	} else { | 
 | 725 | 		ret = platform_legacy_suspend(dev, PMSG_FREEZE); | 
 | 726 | 	} | 
 | 727 |  | 
 | 728 | 	return ret; | 
 | 729 | } | 
 | 730 |  | 
 | 731 | static int platform_pm_freeze_noirq(struct device *dev) | 
 | 732 | { | 
 | 733 | 	struct platform_driver *pdrv; | 
 | 734 | 	int ret = 0; | 
 | 735 |  | 
 | 736 | 	if (!dev->driver) | 
 | 737 | 		return 0; | 
 | 738 |  | 
 | 739 | 	pdrv = to_platform_driver(dev->driver); | 
 | 740 | 	if (pdrv->pm) { | 
 | 741 | 		if (pdrv->pm->freeze_noirq) | 
 | 742 | 			ret = pdrv->pm->freeze_noirq(dev); | 
 | 743 | 	} else { | 
 | 744 | 		ret = platform_legacy_suspend_late(dev, PMSG_FREEZE); | 
 | 745 | 	} | 
 | 746 |  | 
 | 747 | 	return ret; | 
 | 748 | } | 
 | 749 |  | 
 | 750 | static int platform_pm_thaw(struct device *dev) | 
 | 751 | { | 
 | 752 | 	struct device_driver *drv = dev->driver; | 
 | 753 | 	int ret = 0; | 
 | 754 |  | 
 | 755 | 	if (drv && drv->pm) { | 
 | 756 | 		if (drv->pm->thaw) | 
 | 757 | 			ret = drv->pm->thaw(dev); | 
 | 758 | 	} else { | 
 | 759 | 		ret = platform_legacy_resume(dev); | 
 | 760 | 	} | 
 | 761 |  | 
 | 762 | 	return ret; | 
 | 763 | } | 
 | 764 |  | 
 | 765 | static int platform_pm_thaw_noirq(struct device *dev) | 
 | 766 | { | 
 | 767 | 	struct platform_driver *pdrv; | 
 | 768 | 	int ret = 0; | 
 | 769 |  | 
 | 770 | 	if (!dev->driver) | 
 | 771 | 		return 0; | 
 | 772 |  | 
 | 773 | 	pdrv = to_platform_driver(dev->driver); | 
 | 774 | 	if (pdrv->pm) { | 
 | 775 | 		if (pdrv->pm->thaw_noirq) | 
 | 776 | 			ret = pdrv->pm->thaw_noirq(dev); | 
 | 777 | 	} else { | 
 | 778 | 		ret = platform_legacy_resume_early(dev); | 
 | 779 | 	} | 
 | 780 |  | 
 | 781 | 	return ret; | 
 | 782 | } | 
 | 783 |  | 
 | 784 | static int platform_pm_poweroff(struct device *dev) | 
 | 785 | { | 
 | 786 | 	struct device_driver *drv = dev->driver; | 
 | 787 | 	int ret = 0; | 
 | 788 |  | 
 | 789 | 	if (drv && drv->pm) { | 
 | 790 | 		if (drv->pm->poweroff) | 
 | 791 | 			ret = drv->pm->poweroff(dev); | 
 | 792 | 	} else { | 
 | 793 | 		ret = platform_legacy_suspend(dev, PMSG_HIBERNATE); | 
 | 794 | 	} | 
 | 795 |  | 
 | 796 | 	return ret; | 
 | 797 | } | 
 | 798 |  | 
 | 799 | static int platform_pm_poweroff_noirq(struct device *dev) | 
 | 800 | { | 
 | 801 | 	struct platform_driver *pdrv; | 
 | 802 | 	int ret = 0; | 
 | 803 |  | 
 | 804 | 	if (!dev->driver) | 
 | 805 | 		return 0; | 
 | 806 |  | 
 | 807 | 	pdrv = to_platform_driver(dev->driver); | 
 | 808 | 	if (pdrv->pm) { | 
 | 809 | 		if (pdrv->pm->poweroff_noirq) | 
 | 810 | 			ret = pdrv->pm->poweroff_noirq(dev); | 
 | 811 | 	} else { | 
 | 812 | 		ret = platform_legacy_suspend_late(dev, PMSG_HIBERNATE); | 
 | 813 | 	} | 
 | 814 |  | 
 | 815 | 	return ret; | 
 | 816 | } | 
 | 817 |  | 
 | 818 | static int platform_pm_restore(struct device *dev) | 
 | 819 | { | 
 | 820 | 	struct device_driver *drv = dev->driver; | 
 | 821 | 	int ret = 0; | 
 | 822 |  | 
 | 823 | 	if (drv && drv->pm) { | 
 | 824 | 		if (drv->pm->restore) | 
 | 825 | 			ret = drv->pm->restore(dev); | 
 | 826 | 	} else { | 
 | 827 | 		ret = platform_legacy_resume(dev); | 
 | 828 | 	} | 
 | 829 |  | 
 | 830 | 	return ret; | 
 | 831 | } | 
 | 832 |  | 
 | 833 | static int platform_pm_restore_noirq(struct device *dev) | 
 | 834 | { | 
 | 835 | 	struct platform_driver *pdrv; | 
 | 836 | 	int ret = 0; | 
 | 837 |  | 
 | 838 | 	if (!dev->driver) | 
 | 839 | 		return 0; | 
 | 840 |  | 
 | 841 | 	pdrv = to_platform_driver(dev->driver); | 
 | 842 | 	if (pdrv->pm) { | 
 | 843 | 		if (pdrv->pm->restore_noirq) | 
 | 844 | 			ret = pdrv->pm->restore_noirq(dev); | 
 | 845 | 	} else { | 
 | 846 | 		ret = platform_legacy_resume_early(dev); | 
 | 847 | 	} | 
 | 848 |  | 
 | 849 | 	return ret; | 
 | 850 | } | 
 | 851 |  | 
 | 852 | #else /* !CONFIG_HIBERNATION */ | 
 | 853 |  | 
 | 854 | #define platform_pm_freeze		NULL | 
 | 855 | #define platform_pm_thaw		NULL | 
 | 856 | #define platform_pm_poweroff		NULL | 
 | 857 | #define platform_pm_restore		NULL | 
 | 858 | #define platform_pm_freeze_noirq	NULL | 
 | 859 | #define platform_pm_thaw_noirq		NULL | 
 | 860 | #define platform_pm_poweroff_noirq	NULL | 
 | 861 | #define platform_pm_restore_noirq	NULL | 
 | 862 |  | 
 | 863 | #endif /* !CONFIG_HIBERNATION */ | 
 | 864 |  | 
 | 865 | struct pm_ext_ops platform_pm_ops = { | 
 | 866 | 	.base = { | 
 | 867 | 		.prepare = platform_pm_prepare, | 
 | 868 | 		.complete = platform_pm_complete, | 
 | 869 | 		.suspend = platform_pm_suspend, | 
 | 870 | 		.resume = platform_pm_resume, | 
 | 871 | 		.freeze = platform_pm_freeze, | 
 | 872 | 		.thaw = platform_pm_thaw, | 
 | 873 | 		.poweroff = platform_pm_poweroff, | 
 | 874 | 		.restore = platform_pm_restore, | 
 | 875 | 	}, | 
 | 876 | 	.suspend_noirq = platform_pm_suspend_noirq, | 
 | 877 | 	.resume_noirq = platform_pm_resume_noirq, | 
 | 878 | 	.freeze_noirq = platform_pm_freeze_noirq, | 
 | 879 | 	.thaw_noirq = platform_pm_thaw_noirq, | 
 | 880 | 	.poweroff_noirq = platform_pm_poweroff_noirq, | 
 | 881 | 	.restore_noirq = platform_pm_restore_noirq, | 
 | 882 | }; | 
 | 883 |  | 
 | 884 | #define PLATFORM_PM_OPS_PTR	&platform_pm_ops | 
 | 885 |  | 
 | 886 | #else /* !CONFIG_PM_SLEEP */ | 
 | 887 |  | 
 | 888 | #define PLATFORM_PM_OPS_PTR	NULL | 
 | 889 |  | 
 | 890 | #endif /* !CONFIG_PM_SLEEP */ | 
 | 891 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 892 | struct bus_type platform_bus_type = { | 
 | 893 | 	.name		= "platform", | 
| David Brownell | a0245f7 | 2006-05-29 10:37:33 -0700 | [diff] [blame] | 894 | 	.dev_attrs	= platform_dev_attrs, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 895 | 	.match		= platform_match, | 
| David Brownell | a0245f7 | 2006-05-29 10:37:33 -0700 | [diff] [blame] | 896 | 	.uevent		= platform_uevent, | 
| Rafael J. Wysocki | 25e1849 | 2008-05-21 01:40:43 +0200 | [diff] [blame] | 897 | 	.pm		= PLATFORM_PM_OPS_PTR, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 898 | }; | 
| Dmitry Torokhov | a96b204 | 2005-12-10 01:36:28 -0500 | [diff] [blame] | 899 | EXPORT_SYMBOL_GPL(platform_bus_type); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 900 |  | 
 | 901 | int __init platform_bus_init(void) | 
 | 902 | { | 
| Cornelia Huck | fbfb144 | 2006-11-27 10:35:08 +0100 | [diff] [blame] | 903 | 	int error; | 
 | 904 |  | 
 | 905 | 	error = device_register(&platform_bus); | 
 | 906 | 	if (error) | 
 | 907 | 		return error; | 
 | 908 | 	error =  bus_register(&platform_bus_type); | 
 | 909 | 	if (error) | 
 | 910 | 		device_unregister(&platform_bus); | 
 | 911 | 	return error; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 912 | } | 
 | 913 |  | 
 | 914 | #ifndef ARCH_HAS_DMA_GET_REQUIRED_MASK | 
 | 915 | u64 dma_get_required_mask(struct device *dev) | 
 | 916 | { | 
 | 917 | 	u32 low_totalram = ((max_pfn - 1) << PAGE_SHIFT); | 
 | 918 | 	u32 high_totalram = ((max_pfn - 1) >> (32 - PAGE_SHIFT)); | 
 | 919 | 	u64 mask; | 
 | 920 |  | 
 | 921 | 	if (!high_totalram) { | 
 | 922 | 		/* convert to mask just covering totalram */ | 
 | 923 | 		low_totalram = (1 << (fls(low_totalram) - 1)); | 
 | 924 | 		low_totalram += low_totalram - 1; | 
 | 925 | 		mask = low_totalram; | 
 | 926 | 	} else { | 
 | 927 | 		high_totalram = (1 << (fls(high_totalram) - 1)); | 
 | 928 | 		high_totalram += high_totalram - 1; | 
 | 929 | 		mask = (((u64)high_totalram) << 32) + 0xffffffff; | 
 | 930 | 	} | 
| James Bottomley | e88a0c2 | 2008-03-09 11:57:56 -0500 | [diff] [blame] | 931 | 	return mask; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 932 | } | 
 | 933 | EXPORT_SYMBOL_GPL(dma_get_required_mask); | 
 | 934 | #endif |