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