at v2.6.32-rc8 1227 lines 30 kB view raw
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/string.h> 14#include <linux/platform_device.h> 15#include <linux/module.h> 16#include <linux/init.h> 17#include <linux/dma-mapping.h> 18#include <linux/bootmem.h> 19#include <linux/err.h> 20#include <linux/slab.h> 21#include <linux/pm_runtime.h> 22 23#include "base.h" 24 25#define to_platform_driver(drv) (container_of((drv), struct platform_driver, \ 26 driver)) 27 28struct device platform_bus = { 29 .init_name = "platform", 30}; 31EXPORT_SYMBOL_GPL(platform_bus); 32 33/** 34 * platform_get_resource - get a resource for a device 35 * @dev: platform device 36 * @type: resource type 37 * @num: resource index 38 */ 39struct resource *platform_get_resource(struct platform_device *dev, 40 unsigned int type, unsigned int num) 41{ 42 int i; 43 44 for (i = 0; i < dev->num_resources; i++) { 45 struct resource *r = &dev->resource[i]; 46 47 if (type == resource_type(r) && num-- == 0) 48 return r; 49 } 50 return NULL; 51} 52EXPORT_SYMBOL_GPL(platform_get_resource); 53 54/** 55 * platform_get_irq - get an IRQ for a device 56 * @dev: platform device 57 * @num: IRQ number index 58 */ 59int platform_get_irq(struct platform_device *dev, unsigned int num) 60{ 61 struct resource *r = platform_get_resource(dev, IORESOURCE_IRQ, num); 62 63 return r ? r->start : -ENXIO; 64} 65EXPORT_SYMBOL_GPL(platform_get_irq); 66 67/** 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 72 */ 73struct resource *platform_get_resource_byname(struct platform_device *dev, 74 unsigned int type, 75 const char *name) 76{ 77 int i; 78 79 for (i = 0; i < dev->num_resources; i++) { 80 struct resource *r = &dev->resource[i]; 81 82 if (type == resource_type(r) && !strcmp(r->name, name)) 83 return r; 84 } 85 return NULL; 86} 87EXPORT_SYMBOL_GPL(platform_get_resource_byname); 88 89/** 90 * platform_get_irq - get an IRQ for a device 91 * @dev: platform device 92 * @name: IRQ name 93 */ 94int platform_get_irq_byname(struct platform_device *dev, const char *name) 95{ 96 struct resource *r = platform_get_resource_byname(dev, IORESOURCE_IRQ, 97 name); 98 99 return r ? r->start : -ENXIO; 100} 101EXPORT_SYMBOL_GPL(platform_get_irq_byname); 102 103/** 104 * platform_add_devices - add a numbers of platform devices 105 * @devs: array of platform devices to add 106 * @num: number of platform devices in array 107 */ 108int platform_add_devices(struct platform_device **devs, int num) 109{ 110 int i, ret = 0; 111 112 for (i = 0; i < num; i++) { 113 ret = platform_device_register(devs[i]); 114 if (ret) { 115 while (--i >= 0) 116 platform_device_unregister(devs[i]); 117 break; 118 } 119 } 120 121 return ret; 122} 123EXPORT_SYMBOL_GPL(platform_add_devices); 124 125struct platform_object { 126 struct platform_device pdev; 127 char name[1]; 128}; 129 130/** 131 * platform_device_put 132 * @pdev: platform device to free 133 * 134 * Free all memory associated with a platform device. This function must 135 * _only_ be externally called in error cases. All other usage is a bug. 136 */ 137void platform_device_put(struct platform_device *pdev) 138{ 139 if (pdev) 140 put_device(&pdev->dev); 141} 142EXPORT_SYMBOL_GPL(platform_device_put); 143 144static void platform_device_release(struct device *dev) 145{ 146 struct platform_object *pa = container_of(dev, struct platform_object, 147 pdev.dev); 148 149 kfree(pa->pdev.dev.platform_data); 150 kfree(pa->pdev.resource); 151 kfree(pa); 152} 153 154/** 155 * platform_device_alloc 156 * @name: base name of the device we're adding 157 * @id: instance id 158 * 159 * Create a platform device object which can have other objects attached 160 * to it, and which will have attached objects freed when it is released. 161 */ 162struct platform_device *platform_device_alloc(const char *name, int id) 163{ 164 struct platform_object *pa; 165 166 pa = kzalloc(sizeof(struct platform_object) + strlen(name), GFP_KERNEL); 167 if (pa) { 168 strcpy(pa->name, name); 169 pa->pdev.name = pa->name; 170 pa->pdev.id = id; 171 device_initialize(&pa->pdev.dev); 172 pa->pdev.dev.release = platform_device_release; 173 } 174 175 return pa ? &pa->pdev : NULL; 176} 177EXPORT_SYMBOL_GPL(platform_device_alloc); 178 179/** 180 * platform_device_add_resources 181 * @pdev: platform device allocated by platform_device_alloc to add resources to 182 * @res: set of resources that needs to be allocated for the device 183 * @num: number of resources 184 * 185 * Add a copy of the resources to the platform device. The memory 186 * associated with the resources will be freed when the platform device is 187 * released. 188 */ 189int platform_device_add_resources(struct platform_device *pdev, 190 struct resource *res, unsigned int num) 191{ 192 struct resource *r; 193 194 r = kmalloc(sizeof(struct resource) * num, GFP_KERNEL); 195 if (r) { 196 memcpy(r, res, sizeof(struct resource) * num); 197 pdev->resource = r; 198 pdev->num_resources = num; 199 } 200 return r ? 0 : -ENOMEM; 201} 202EXPORT_SYMBOL_GPL(platform_device_add_resources); 203 204/** 205 * platform_device_add_data 206 * @pdev: platform device allocated by platform_device_alloc to add resources to 207 * @data: platform specific data for this platform device 208 * @size: size of platform specific data 209 * 210 * Add a copy of platform specific data to the platform device's 211 * platform_data pointer. The memory associated with the platform data 212 * will be freed when the platform device is released. 213 */ 214int platform_device_add_data(struct platform_device *pdev, const void *data, 215 size_t size) 216{ 217 void *d = kmemdup(data, size, GFP_KERNEL); 218 219 if (d) { 220 pdev->dev.platform_data = d; 221 return 0; 222 } 223 return -ENOMEM; 224} 225EXPORT_SYMBOL_GPL(platform_device_add_data); 226 227/** 228 * platform_device_add - add a platform device to device hierarchy 229 * @pdev: platform device we're adding 230 * 231 * This is part 2 of platform_device_register(), though may be called 232 * separately _iff_ pdev was allocated by platform_device_alloc(). 233 */ 234int platform_device_add(struct platform_device *pdev) 235{ 236 int i, ret = 0; 237 238 if (!pdev) 239 return -EINVAL; 240 241 if (!pdev->dev.parent) 242 pdev->dev.parent = &platform_bus; 243 244 pdev->dev.bus = &platform_bus_type; 245 246 if (pdev->id != -1) 247 dev_set_name(&pdev->dev, "%s.%d", pdev->name, pdev->id); 248 else 249 dev_set_name(&pdev->dev, "%s", pdev->name); 250 251 for (i = 0; i < pdev->num_resources; i++) { 252 struct resource *p, *r = &pdev->resource[i]; 253 254 if (r->name == NULL) 255 r->name = dev_name(&pdev->dev); 256 257 p = r->parent; 258 if (!p) { 259 if (resource_type(r) == IORESOURCE_MEM) 260 p = &iomem_resource; 261 else if (resource_type(r) == IORESOURCE_IO) 262 p = &ioport_resource; 263 } 264 265 if (p && insert_resource(p, r)) { 266 printk(KERN_ERR 267 "%s: failed to claim resource %d\n", 268 dev_name(&pdev->dev), i); 269 ret = -EBUSY; 270 goto failed; 271 } 272 } 273 274 pr_debug("Registering platform device '%s'. Parent at %s\n", 275 dev_name(&pdev->dev), dev_name(pdev->dev.parent)); 276 277 ret = device_add(&pdev->dev); 278 if (ret == 0) 279 return ret; 280 281 failed: 282 while (--i >= 0) { 283 struct resource *r = &pdev->resource[i]; 284 unsigned long type = resource_type(r); 285 286 if (type == IORESOURCE_MEM || type == IORESOURCE_IO) 287 release_resource(r); 288 } 289 290 return ret; 291} 292EXPORT_SYMBOL_GPL(platform_device_add); 293 294/** 295 * platform_device_del - remove a platform-level device 296 * @pdev: platform device we're removing 297 * 298 * Note that this function will also release all memory- and port-based 299 * resources owned by the device (@dev->resource). This function must 300 * _only_ be externally called in error cases. All other usage is a bug. 301 */ 302void platform_device_del(struct platform_device *pdev) 303{ 304 int i; 305 306 if (pdev) { 307 device_del(&pdev->dev); 308 309 for (i = 0; i < pdev->num_resources; i++) { 310 struct resource *r = &pdev->resource[i]; 311 unsigned long type = resource_type(r); 312 313 if (type == IORESOURCE_MEM || type == IORESOURCE_IO) 314 release_resource(r); 315 } 316 } 317} 318EXPORT_SYMBOL_GPL(platform_device_del); 319 320/** 321 * platform_device_register - add a platform-level device 322 * @pdev: platform device we're adding 323 */ 324int platform_device_register(struct platform_device *pdev) 325{ 326 device_initialize(&pdev->dev); 327 return platform_device_add(pdev); 328} 329EXPORT_SYMBOL_GPL(platform_device_register); 330 331/** 332 * platform_device_unregister - unregister a platform-level device 333 * @pdev: platform device we're unregistering 334 * 335 * Unregistration is done in 2 steps. First we release all resources 336 * and remove it from the subsystem, then we drop reference count by 337 * calling platform_device_put(). 338 */ 339void platform_device_unregister(struct platform_device *pdev) 340{ 341 platform_device_del(pdev); 342 platform_device_put(pdev); 343} 344EXPORT_SYMBOL_GPL(platform_device_unregister); 345 346/** 347 * platform_device_register_simple 348 * @name: base name of the device we're adding 349 * @id: instance id 350 * @res: set of resources that needs to be allocated for the device 351 * @num: number of resources 352 * 353 * This function creates a simple platform device that requires minimal 354 * resource and memory management. Canned release function freeing memory 355 * allocated for the device allows drivers using such devices to be 356 * unloaded without waiting for the last reference to the device to be 357 * dropped. 358 * 359 * This interface is primarily intended for use with legacy drivers which 360 * probe hardware directly. Because such drivers create sysfs device nodes 361 * themselves, rather than letting system infrastructure handle such device 362 * enumeration tasks, they don't fully conform to the Linux driver model. 363 * In particular, when such drivers are built as modules, they can't be 364 * "hotplugged". 365 */ 366struct platform_device *platform_device_register_simple(const char *name, 367 int id, 368 struct resource *res, 369 unsigned int num) 370{ 371 struct platform_device *pdev; 372 int retval; 373 374 pdev = platform_device_alloc(name, id); 375 if (!pdev) { 376 retval = -ENOMEM; 377 goto error; 378 } 379 380 if (num) { 381 retval = platform_device_add_resources(pdev, res, num); 382 if (retval) 383 goto error; 384 } 385 386 retval = platform_device_add(pdev); 387 if (retval) 388 goto error; 389 390 return pdev; 391 392error: 393 platform_device_put(pdev); 394 return ERR_PTR(retval); 395} 396EXPORT_SYMBOL_GPL(platform_device_register_simple); 397 398/** 399 * platform_device_register_data 400 * @parent: parent device for the device we're adding 401 * @name: base name of the device we're adding 402 * @id: instance id 403 * @data: platform specific data for this platform device 404 * @size: size of platform specific data 405 * 406 * This function creates a simple platform device that requires minimal 407 * resource and memory management. Canned release function freeing memory 408 * allocated for the device allows drivers using such devices to be 409 * unloaded without waiting for the last reference to the device to be 410 * dropped. 411 */ 412struct platform_device *platform_device_register_data( 413 struct device *parent, 414 const char *name, int id, 415 const void *data, size_t size) 416{ 417 struct platform_device *pdev; 418 int retval; 419 420 pdev = platform_device_alloc(name, id); 421 if (!pdev) { 422 retval = -ENOMEM; 423 goto error; 424 } 425 426 pdev->dev.parent = parent; 427 428 if (size) { 429 retval = platform_device_add_data(pdev, data, size); 430 if (retval) 431 goto error; 432 } 433 434 retval = platform_device_add(pdev); 435 if (retval) 436 goto error; 437 438 return pdev; 439 440error: 441 platform_device_put(pdev); 442 return ERR_PTR(retval); 443} 444 445static int platform_drv_probe(struct device *_dev) 446{ 447 struct platform_driver *drv = to_platform_driver(_dev->driver); 448 struct platform_device *dev = to_platform_device(_dev); 449 450 return drv->probe(dev); 451} 452 453static int platform_drv_probe_fail(struct device *_dev) 454{ 455 return -ENXIO; 456} 457 458static int platform_drv_remove(struct device *_dev) 459{ 460 struct platform_driver *drv = to_platform_driver(_dev->driver); 461 struct platform_device *dev = to_platform_device(_dev); 462 463 return drv->remove(dev); 464} 465 466static void platform_drv_shutdown(struct device *_dev) 467{ 468 struct platform_driver *drv = to_platform_driver(_dev->driver); 469 struct platform_device *dev = to_platform_device(_dev); 470 471 drv->shutdown(dev); 472} 473 474/** 475 * platform_driver_register 476 * @drv: platform driver structure 477 */ 478int platform_driver_register(struct platform_driver *drv) 479{ 480 drv->driver.bus = &platform_bus_type; 481 if (drv->probe) 482 drv->driver.probe = platform_drv_probe; 483 if (drv->remove) 484 drv->driver.remove = platform_drv_remove; 485 if (drv->shutdown) 486 drv->driver.shutdown = platform_drv_shutdown; 487 488 return driver_register(&drv->driver); 489} 490EXPORT_SYMBOL_GPL(platform_driver_register); 491 492/** 493 * platform_driver_unregister 494 * @drv: platform driver structure 495 */ 496void platform_driver_unregister(struct platform_driver *drv) 497{ 498 driver_unregister(&drv->driver); 499} 500EXPORT_SYMBOL_GPL(platform_driver_unregister); 501 502/** 503 * platform_driver_probe - register driver for non-hotpluggable device 504 * @drv: platform driver structure 505 * @probe: the driver probe routine, probably from an __init section 506 * 507 * Use this instead of platform_driver_register() when you know the device 508 * is not hotpluggable and has already been registered, and you want to 509 * remove its run-once probe() infrastructure from memory after the driver 510 * has bound to the device. 511 * 512 * One typical use for this would be with drivers for controllers integrated 513 * into system-on-chip processors, where the controller devices have been 514 * configured as part of board setup. 515 * 516 * Returns zero if the driver registered and bound to a device, else returns 517 * a negative error code and with the driver not registered. 518 */ 519int __init_or_module platform_driver_probe(struct platform_driver *drv, 520 int (*probe)(struct platform_device *)) 521{ 522 int retval, code; 523 524 /* make sure driver won't have bind/unbind attributes */ 525 drv->driver.suppress_bind_attrs = true; 526 527 /* temporary section violation during probe() */ 528 drv->probe = probe; 529 retval = code = platform_driver_register(drv); 530 531 /* 532 * Fixup that section violation, being paranoid about code scanning 533 * the list of drivers in order to probe new devices. Check to see 534 * if the probe was successful, and make sure any forced probes of 535 * new devices fail. 536 */ 537 spin_lock(&platform_bus_type.p->klist_drivers.k_lock); 538 drv->probe = NULL; 539 if (code == 0 && list_empty(&drv->driver.p->klist_devices.k_list)) 540 retval = -ENODEV; 541 drv->driver.probe = platform_drv_probe_fail; 542 spin_unlock(&platform_bus_type.p->klist_drivers.k_lock); 543 544 if (code != retval) 545 platform_driver_unregister(drv); 546 return retval; 547} 548EXPORT_SYMBOL_GPL(platform_driver_probe); 549 550/* modalias support enables more hands-off userspace setup: 551 * (a) environment variable lets new-style hotplug events work once system is 552 * fully running: "modprobe $MODALIAS" 553 * (b) sysfs attribute lets new-style coldplug recover from hotplug events 554 * mishandled before system is fully running: "modprobe $(cat modalias)" 555 */ 556static ssize_t modalias_show(struct device *dev, struct device_attribute *a, 557 char *buf) 558{ 559 struct platform_device *pdev = to_platform_device(dev); 560 int len = snprintf(buf, PAGE_SIZE, "platform:%s\n", pdev->name); 561 562 return (len >= PAGE_SIZE) ? (PAGE_SIZE - 1) : len; 563} 564 565static struct device_attribute platform_dev_attrs[] = { 566 __ATTR_RO(modalias), 567 __ATTR_NULL, 568}; 569 570static int platform_uevent(struct device *dev, struct kobj_uevent_env *env) 571{ 572 struct platform_device *pdev = to_platform_device(dev); 573 574 add_uevent_var(env, "MODALIAS=%s%s", PLATFORM_MODULE_PREFIX, 575 (pdev->id_entry) ? pdev->id_entry->name : pdev->name); 576 return 0; 577} 578 579static const struct platform_device_id *platform_match_id( 580 struct platform_device_id *id, 581 struct platform_device *pdev) 582{ 583 while (id->name[0]) { 584 if (strcmp(pdev->name, id->name) == 0) { 585 pdev->id_entry = id; 586 return id; 587 } 588 id++; 589 } 590 return NULL; 591} 592 593/** 594 * platform_match - bind platform device to platform driver. 595 * @dev: device. 596 * @drv: driver. 597 * 598 * Platform device IDs are assumed to be encoded like this: 599 * "<name><instance>", where <name> is a short description of the type of 600 * device, like "pci" or "floppy", and <instance> is the enumerated 601 * instance of the device, like '0' or '42'. Driver IDs are simply 602 * "<name>". So, extract the <name> from the platform_device structure, 603 * and compare it against the name of the driver. Return whether they match 604 * or not. 605 */ 606static int platform_match(struct device *dev, struct device_driver *drv) 607{ 608 struct platform_device *pdev = to_platform_device(dev); 609 struct platform_driver *pdrv = to_platform_driver(drv); 610 611 /* match against the id table first */ 612 if (pdrv->id_table) 613 return platform_match_id(pdrv->id_table, pdev) != NULL; 614 615 /* fall-back to driver name match */ 616 return (strcmp(pdev->name, drv->name) == 0); 617} 618 619#ifdef CONFIG_PM_SLEEP 620 621static int platform_legacy_suspend(struct device *dev, pm_message_t mesg) 622{ 623 struct platform_driver *pdrv = to_platform_driver(dev->driver); 624 struct platform_device *pdev = to_platform_device(dev); 625 int ret = 0; 626 627 if (dev->driver && pdrv->suspend) 628 ret = pdrv->suspend(pdev, mesg); 629 630 return ret; 631} 632 633static int platform_legacy_resume(struct device *dev) 634{ 635 struct platform_driver *pdrv = to_platform_driver(dev->driver); 636 struct platform_device *pdev = to_platform_device(dev); 637 int ret = 0; 638 639 if (dev->driver && pdrv->resume) 640 ret = pdrv->resume(pdev); 641 642 return ret; 643} 644 645static int platform_pm_prepare(struct device *dev) 646{ 647 struct device_driver *drv = dev->driver; 648 int ret = 0; 649 650 if (drv && drv->pm && drv->pm->prepare) 651 ret = drv->pm->prepare(dev); 652 653 return ret; 654} 655 656static void platform_pm_complete(struct device *dev) 657{ 658 struct device_driver *drv = dev->driver; 659 660 if (drv && drv->pm && drv->pm->complete) 661 drv->pm->complete(dev); 662} 663 664#else /* !CONFIG_PM_SLEEP */ 665 666#define platform_pm_prepare NULL 667#define platform_pm_complete NULL 668 669#endif /* !CONFIG_PM_SLEEP */ 670 671#ifdef CONFIG_SUSPEND 672 673static int platform_pm_suspend(struct device *dev) 674{ 675 struct device_driver *drv = dev->driver; 676 int ret = 0; 677 678 if (!drv) 679 return 0; 680 681 if (drv->pm) { 682 if (drv->pm->suspend) 683 ret = drv->pm->suspend(dev); 684 } else { 685 ret = platform_legacy_suspend(dev, PMSG_SUSPEND); 686 } 687 688 return ret; 689} 690 691static int platform_pm_suspend_noirq(struct device *dev) 692{ 693 struct device_driver *drv = dev->driver; 694 int ret = 0; 695 696 if (!drv) 697 return 0; 698 699 if (drv->pm) { 700 if (drv->pm->suspend_noirq) 701 ret = drv->pm->suspend_noirq(dev); 702 } 703 704 return ret; 705} 706 707static int platform_pm_resume(struct device *dev) 708{ 709 struct device_driver *drv = dev->driver; 710 int ret = 0; 711 712 if (!drv) 713 return 0; 714 715 if (drv->pm) { 716 if (drv->pm->resume) 717 ret = drv->pm->resume(dev); 718 } else { 719 ret = platform_legacy_resume(dev); 720 } 721 722 return ret; 723} 724 725static int platform_pm_resume_noirq(struct device *dev) 726{ 727 struct device_driver *drv = dev->driver; 728 int ret = 0; 729 730 if (!drv) 731 return 0; 732 733 if (drv->pm) { 734 if (drv->pm->resume_noirq) 735 ret = drv->pm->resume_noirq(dev); 736 } 737 738 return ret; 739} 740 741#else /* !CONFIG_SUSPEND */ 742 743#define platform_pm_suspend NULL 744#define platform_pm_resume NULL 745#define platform_pm_suspend_noirq NULL 746#define platform_pm_resume_noirq NULL 747 748#endif /* !CONFIG_SUSPEND */ 749 750#ifdef CONFIG_HIBERNATION 751 752static int platform_pm_freeze(struct device *dev) 753{ 754 struct device_driver *drv = dev->driver; 755 int ret = 0; 756 757 if (!drv) 758 return 0; 759 760 if (drv->pm) { 761 if (drv->pm->freeze) 762 ret = drv->pm->freeze(dev); 763 } else { 764 ret = platform_legacy_suspend(dev, PMSG_FREEZE); 765 } 766 767 return ret; 768} 769 770static int platform_pm_freeze_noirq(struct device *dev) 771{ 772 struct device_driver *drv = dev->driver; 773 int ret = 0; 774 775 if (!drv) 776 return 0; 777 778 if (drv->pm) { 779 if (drv->pm->freeze_noirq) 780 ret = drv->pm->freeze_noirq(dev); 781 } 782 783 return ret; 784} 785 786static int platform_pm_thaw(struct device *dev) 787{ 788 struct device_driver *drv = dev->driver; 789 int ret = 0; 790 791 if (!drv) 792 return 0; 793 794 if (drv->pm) { 795 if (drv->pm->thaw) 796 ret = drv->pm->thaw(dev); 797 } else { 798 ret = platform_legacy_resume(dev); 799 } 800 801 return ret; 802} 803 804static int platform_pm_thaw_noirq(struct device *dev) 805{ 806 struct device_driver *drv = dev->driver; 807 int ret = 0; 808 809 if (!drv) 810 return 0; 811 812 if (drv->pm) { 813 if (drv->pm->thaw_noirq) 814 ret = drv->pm->thaw_noirq(dev); 815 } 816 817 return ret; 818} 819 820static int platform_pm_poweroff(struct device *dev) 821{ 822 struct device_driver *drv = dev->driver; 823 int ret = 0; 824 825 if (!drv) 826 return 0; 827 828 if (drv->pm) { 829 if (drv->pm->poweroff) 830 ret = drv->pm->poweroff(dev); 831 } else { 832 ret = platform_legacy_suspend(dev, PMSG_HIBERNATE); 833 } 834 835 return ret; 836} 837 838static int platform_pm_poweroff_noirq(struct device *dev) 839{ 840 struct device_driver *drv = dev->driver; 841 int ret = 0; 842 843 if (!drv) 844 return 0; 845 846 if (drv->pm) { 847 if (drv->pm->poweroff_noirq) 848 ret = drv->pm->poweroff_noirq(dev); 849 } 850 851 return ret; 852} 853 854static int platform_pm_restore(struct device *dev) 855{ 856 struct device_driver *drv = dev->driver; 857 int ret = 0; 858 859 if (!drv) 860 return 0; 861 862 if (drv->pm) { 863 if (drv->pm->restore) 864 ret = drv->pm->restore(dev); 865 } else { 866 ret = platform_legacy_resume(dev); 867 } 868 869 return ret; 870} 871 872static int platform_pm_restore_noirq(struct device *dev) 873{ 874 struct device_driver *drv = dev->driver; 875 int ret = 0; 876 877 if (!drv) 878 return 0; 879 880 if (drv->pm) { 881 if (drv->pm->restore_noirq) 882 ret = drv->pm->restore_noirq(dev); 883 } 884 885 return ret; 886} 887 888#else /* !CONFIG_HIBERNATION */ 889 890#define platform_pm_freeze NULL 891#define platform_pm_thaw NULL 892#define platform_pm_poweroff NULL 893#define platform_pm_restore NULL 894#define platform_pm_freeze_noirq NULL 895#define platform_pm_thaw_noirq NULL 896#define platform_pm_poweroff_noirq NULL 897#define platform_pm_restore_noirq NULL 898 899#endif /* !CONFIG_HIBERNATION */ 900 901#ifdef CONFIG_PM_RUNTIME 902 903int __weak platform_pm_runtime_suspend(struct device *dev) 904{ 905 return -ENOSYS; 906}; 907 908int __weak platform_pm_runtime_resume(struct device *dev) 909{ 910 return -ENOSYS; 911}; 912 913int __weak platform_pm_runtime_idle(struct device *dev) 914{ 915 return -ENOSYS; 916}; 917 918#else /* !CONFIG_PM_RUNTIME */ 919 920#define platform_pm_runtime_suspend NULL 921#define platform_pm_runtime_resume NULL 922#define platform_pm_runtime_idle NULL 923 924#endif /* !CONFIG_PM_RUNTIME */ 925 926static const struct dev_pm_ops platform_dev_pm_ops = { 927 .prepare = platform_pm_prepare, 928 .complete = platform_pm_complete, 929 .suspend = platform_pm_suspend, 930 .resume = platform_pm_resume, 931 .freeze = platform_pm_freeze, 932 .thaw = platform_pm_thaw, 933 .poweroff = platform_pm_poweroff, 934 .restore = platform_pm_restore, 935 .suspend_noirq = platform_pm_suspend_noirq, 936 .resume_noirq = platform_pm_resume_noirq, 937 .freeze_noirq = platform_pm_freeze_noirq, 938 .thaw_noirq = platform_pm_thaw_noirq, 939 .poweroff_noirq = platform_pm_poweroff_noirq, 940 .restore_noirq = platform_pm_restore_noirq, 941 .runtime_suspend = platform_pm_runtime_suspend, 942 .runtime_resume = platform_pm_runtime_resume, 943 .runtime_idle = platform_pm_runtime_idle, 944}; 945 946struct bus_type platform_bus_type = { 947 .name = "platform", 948 .dev_attrs = platform_dev_attrs, 949 .match = platform_match, 950 .uevent = platform_uevent, 951 .pm = &platform_dev_pm_ops, 952}; 953EXPORT_SYMBOL_GPL(platform_bus_type); 954 955int __init platform_bus_init(void) 956{ 957 int error; 958 959 early_platform_cleanup(); 960 961 error = device_register(&platform_bus); 962 if (error) 963 return error; 964 error = bus_register(&platform_bus_type); 965 if (error) 966 device_unregister(&platform_bus); 967 return error; 968} 969 970#ifndef ARCH_HAS_DMA_GET_REQUIRED_MASK 971u64 dma_get_required_mask(struct device *dev) 972{ 973 u32 low_totalram = ((max_pfn - 1) << PAGE_SHIFT); 974 u32 high_totalram = ((max_pfn - 1) >> (32 - PAGE_SHIFT)); 975 u64 mask; 976 977 if (!high_totalram) { 978 /* convert to mask just covering totalram */ 979 low_totalram = (1 << (fls(low_totalram) - 1)); 980 low_totalram += low_totalram - 1; 981 mask = low_totalram; 982 } else { 983 high_totalram = (1 << (fls(high_totalram) - 1)); 984 high_totalram += high_totalram - 1; 985 mask = (((u64)high_totalram) << 32) + 0xffffffff; 986 } 987 return mask; 988} 989EXPORT_SYMBOL_GPL(dma_get_required_mask); 990#endif 991 992static __initdata LIST_HEAD(early_platform_driver_list); 993static __initdata LIST_HEAD(early_platform_device_list); 994 995/** 996 * early_platform_driver_register 997 * @epdrv: early_platform driver structure 998 * @buf: string passed from early_param() 999 */ 1000int __init early_platform_driver_register(struct early_platform_driver *epdrv, 1001 char *buf) 1002{ 1003 unsigned long index; 1004 int n; 1005 1006 /* Simply add the driver to the end of the global list. 1007 * Drivers will by default be put on the list in compiled-in order. 1008 */ 1009 if (!epdrv->list.next) { 1010 INIT_LIST_HEAD(&epdrv->list); 1011 list_add_tail(&epdrv->list, &early_platform_driver_list); 1012 } 1013 1014 /* If the user has specified device then make sure the driver 1015 * gets prioritized. The driver of the last device specified on 1016 * command line will be put first on the list. 1017 */ 1018 n = strlen(epdrv->pdrv->driver.name); 1019 if (buf && !strncmp(buf, epdrv->pdrv->driver.name, n)) { 1020 list_move(&epdrv->list, &early_platform_driver_list); 1021 1022 if (!strcmp(buf, epdrv->pdrv->driver.name)) 1023 epdrv->requested_id = -1; 1024 else if (buf[n] == '.' && strict_strtoul(&buf[n + 1], 10, 1025 &index) == 0) 1026 epdrv->requested_id = index; 1027 else 1028 epdrv->requested_id = EARLY_PLATFORM_ID_ERROR; 1029 } 1030 1031 return 0; 1032} 1033 1034/** 1035 * early_platform_add_devices - add a numbers of early platform devices 1036 * @devs: array of early platform devices to add 1037 * @num: number of early platform devices in array 1038 */ 1039void __init early_platform_add_devices(struct platform_device **devs, int num) 1040{ 1041 struct device *dev; 1042 int i; 1043 1044 /* simply add the devices to list */ 1045 for (i = 0; i < num; i++) { 1046 dev = &devs[i]->dev; 1047 1048 if (!dev->devres_head.next) { 1049 INIT_LIST_HEAD(&dev->devres_head); 1050 list_add_tail(&dev->devres_head, 1051 &early_platform_device_list); 1052 } 1053 } 1054} 1055 1056/** 1057 * early_platform_driver_register_all 1058 * @class_str: string to identify early platform driver class 1059 */ 1060void __init early_platform_driver_register_all(char *class_str) 1061{ 1062 /* The "class_str" parameter may or may not be present on the kernel 1063 * command line. If it is present then there may be more than one 1064 * matching parameter. 1065 * 1066 * Since we register our early platform drivers using early_param() 1067 * we need to make sure that they also get registered in the case 1068 * when the parameter is missing from the kernel command line. 1069 * 1070 * We use parse_early_options() to make sure the early_param() gets 1071 * called at least once. The early_param() may be called more than 1072 * once since the name of the preferred device may be specified on 1073 * the kernel command line. early_platform_driver_register() handles 1074 * this case for us. 1075 */ 1076 parse_early_options(class_str); 1077} 1078 1079/** 1080 * early_platform_match 1081 * @epdrv: early platform driver structure 1082 * @id: id to match against 1083 */ 1084static __init struct platform_device * 1085early_platform_match(struct early_platform_driver *epdrv, int id) 1086{ 1087 struct platform_device *pd; 1088 1089 list_for_each_entry(pd, &early_platform_device_list, dev.devres_head) 1090 if (platform_match(&pd->dev, &epdrv->pdrv->driver)) 1091 if (pd->id == id) 1092 return pd; 1093 1094 return NULL; 1095} 1096 1097/** 1098 * early_platform_left 1099 * @epdrv: early platform driver structure 1100 * @id: return true if id or above exists 1101 */ 1102static __init int early_platform_left(struct early_platform_driver *epdrv, 1103 int id) 1104{ 1105 struct platform_device *pd; 1106 1107 list_for_each_entry(pd, &early_platform_device_list, dev.devres_head) 1108 if (platform_match(&pd->dev, &epdrv->pdrv->driver)) 1109 if (pd->id >= id) 1110 return 1; 1111 1112 return 0; 1113} 1114 1115/** 1116 * early_platform_driver_probe_id 1117 * @class_str: string to identify early platform driver class 1118 * @id: id to match against 1119 * @nr_probe: number of platform devices to successfully probe before exiting 1120 */ 1121static int __init early_platform_driver_probe_id(char *class_str, 1122 int id, 1123 int nr_probe) 1124{ 1125 struct early_platform_driver *epdrv; 1126 struct platform_device *match; 1127 int match_id; 1128 int n = 0; 1129 int left = 0; 1130 1131 list_for_each_entry(epdrv, &early_platform_driver_list, list) { 1132 /* only use drivers matching our class_str */ 1133 if (strcmp(class_str, epdrv->class_str)) 1134 continue; 1135 1136 if (id == -2) { 1137 match_id = epdrv->requested_id; 1138 left = 1; 1139 1140 } else { 1141 match_id = id; 1142 left += early_platform_left(epdrv, id); 1143 1144 /* skip requested id */ 1145 switch (epdrv->requested_id) { 1146 case EARLY_PLATFORM_ID_ERROR: 1147 case EARLY_PLATFORM_ID_UNSET: 1148 break; 1149 default: 1150 if (epdrv->requested_id == id) 1151 match_id = EARLY_PLATFORM_ID_UNSET; 1152 } 1153 } 1154 1155 switch (match_id) { 1156 case EARLY_PLATFORM_ID_ERROR: 1157 pr_warning("%s: unable to parse %s parameter\n", 1158 class_str, epdrv->pdrv->driver.name); 1159 /* fall-through */ 1160 case EARLY_PLATFORM_ID_UNSET: 1161 match = NULL; 1162 break; 1163 default: 1164 match = early_platform_match(epdrv, match_id); 1165 } 1166 1167 if (match) { 1168 if (epdrv->pdrv->probe(match)) 1169 pr_warning("%s: unable to probe %s early.\n", 1170 class_str, match->name); 1171 else 1172 n++; 1173 } 1174 1175 if (n >= nr_probe) 1176 break; 1177 } 1178 1179 if (left) 1180 return n; 1181 else 1182 return -ENODEV; 1183} 1184 1185/** 1186 * early_platform_driver_probe 1187 * @class_str: string to identify early platform driver class 1188 * @nr_probe: number of platform devices to successfully probe before exiting 1189 * @user_only: only probe user specified early platform devices 1190 */ 1191int __init early_platform_driver_probe(char *class_str, 1192 int nr_probe, 1193 int user_only) 1194{ 1195 int k, n, i; 1196 1197 n = 0; 1198 for (i = -2; n < nr_probe; i++) { 1199 k = early_platform_driver_probe_id(class_str, i, nr_probe - n); 1200 1201 if (k < 0) 1202 break; 1203 1204 n += k; 1205 1206 if (user_only) 1207 break; 1208 } 1209 1210 return n; 1211} 1212 1213/** 1214 * early_platform_cleanup - clean up early platform code 1215 */ 1216void __init early_platform_cleanup(void) 1217{ 1218 struct platform_device *pd, *pd2; 1219 1220 /* clean up the devres list used to chain devices */ 1221 list_for_each_entry_safe(pd, pd2, &early_platform_device_list, 1222 dev.devres_head) { 1223 list_del(&pd->dev.devres_head); 1224 memset(&pd->dev.devres_head, 0, sizeof(pd->dev.devres_head)); 1225 } 1226} 1227