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 28 struct device platform_bus = { 29 .init_name = "platform", 30 }; 31 EXPORT_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 */ 39 struct 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 } 52 EXPORT_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 */ 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 63 return r ? r->start : -ENXIO; 64 } 65 EXPORT_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 */ 73 struct 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 } 87 EXPORT_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 */ 94 int 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 } 101 EXPORT_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 */ 108 int 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 } 123 EXPORT_SYMBOL_GPL(platform_add_devices); 124 125 struct 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 */ 137 void platform_device_put(struct platform_device *pdev) 138 { 139 if (pdev) 140 put_device(&pdev->dev); 141 } 142 EXPORT_SYMBOL_GPL(platform_device_put); 143 144 static 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 */ 162 struct 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 } 177 EXPORT_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 */ 189 int 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 } 202 EXPORT_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 */ 214 int 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 } 225 EXPORT_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 */ 234 int 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 } 292 EXPORT_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 */ 302 void 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 } 318 EXPORT_SYMBOL_GPL(platform_device_del); 319 320 /** 321 * platform_device_register - add a platform-level device 322 * @pdev: platform device we're adding 323 */ 324 int platform_device_register(struct platform_device *pdev) 325 { 326 device_initialize(&pdev->dev); 327 return platform_device_add(pdev); 328 } 329 EXPORT_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 */ 339 void platform_device_unregister(struct platform_device *pdev) 340 { 341 platform_device_del(pdev); 342 platform_device_put(pdev); 343 } 344 EXPORT_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 */ 366 struct 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 392 error: 393 platform_device_put(pdev); 394 return ERR_PTR(retval); 395 } 396 EXPORT_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 */ 412 struct 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 440 error: 441 platform_device_put(pdev); 442 return ERR_PTR(retval); 443 } 444 EXPORT_SYMBOL_GPL(platform_device_register_data); 445 446 static int platform_drv_probe(struct device *_dev) 447 { 448 struct platform_driver *drv = to_platform_driver(_dev->driver); 449 struct platform_device *dev = to_platform_device(_dev); 450 451 return drv->probe(dev); 452 } 453 454 static int platform_drv_probe_fail(struct device *_dev) 455 { 456 return -ENXIO; 457 } 458 459 static int platform_drv_remove(struct device *_dev) 460 { 461 struct platform_driver *drv = to_platform_driver(_dev->driver); 462 struct platform_device *dev = to_platform_device(_dev); 463 464 return drv->remove(dev); 465 } 466 467 static void platform_drv_shutdown(struct device *_dev) 468 { 469 struct platform_driver *drv = to_platform_driver(_dev->driver); 470 struct platform_device *dev = to_platform_device(_dev); 471 472 drv->shutdown(dev); 473 } 474 475 /** 476 * platform_driver_register 477 * @drv: platform driver structure 478 */ 479 int platform_driver_register(struct platform_driver *drv) 480 { 481 drv->driver.bus = &platform_bus_type; 482 if (drv->probe) 483 drv->driver.probe = platform_drv_probe; 484 if (drv->remove) 485 drv->driver.remove = platform_drv_remove; 486 if (drv->shutdown) 487 drv->driver.shutdown = platform_drv_shutdown; 488 489 return driver_register(&drv->driver); 490 } 491 EXPORT_SYMBOL_GPL(platform_driver_register); 492 493 /** 494 * platform_driver_unregister 495 * @drv: platform driver structure 496 */ 497 void platform_driver_unregister(struct platform_driver *drv) 498 { 499 driver_unregister(&drv->driver); 500 } 501 EXPORT_SYMBOL_GPL(platform_driver_unregister); 502 503 /** 504 * platform_driver_probe - register driver for non-hotpluggable device 505 * @drv: platform driver structure 506 * @probe: the driver probe routine, probably from an __init section 507 * 508 * Use this instead of platform_driver_register() when you know the device 509 * is not hotpluggable and has already been registered, and you want to 510 * remove its run-once probe() infrastructure from memory after the driver 511 * has bound to the device. 512 * 513 * One typical use for this would be with drivers for controllers integrated 514 * into system-on-chip processors, where the controller devices have been 515 * configured as part of board setup. 516 * 517 * Returns zero if the driver registered and bound to a device, else returns 518 * a negative error code and with the driver not registered. 519 */ 520 int __init_or_module platform_driver_probe(struct platform_driver *drv, 521 int (*probe)(struct platform_device *)) 522 { 523 int retval, code; 524 525 /* make sure driver won't have bind/unbind attributes */ 526 drv->driver.suppress_bind_attrs = true; 527 528 /* temporary section violation during probe() */ 529 drv->probe = probe; 530 retval = code = platform_driver_register(drv); 531 532 /* 533 * Fixup that section violation, being paranoid about code scanning 534 * the list of drivers in order to probe new devices. Check to see 535 * if the probe was successful, and make sure any forced probes of 536 * new devices fail. 537 */ 538 spin_lock(&platform_bus_type.p->klist_drivers.k_lock); 539 drv->probe = NULL; 540 if (code == 0 && list_empty(&drv->driver.p->klist_devices.k_list)) 541 retval = -ENODEV; 542 drv->driver.probe = platform_drv_probe_fail; 543 spin_unlock(&platform_bus_type.p->klist_drivers.k_lock); 544 545 if (code != retval) 546 platform_driver_unregister(drv); 547 return retval; 548 } 549 EXPORT_SYMBOL_GPL(platform_driver_probe); 550 551 /** 552 * platform_create_bundle - register driver and create corresponding device 553 * @driver: platform driver structure 554 * @probe: the driver probe routine, probably from an __init section 555 * @res: set of resources that needs to be allocated for the device 556 * @n_res: number of resources 557 * @data: platform specific data for this platform device 558 * @size: size of platform specific data 559 * 560 * Use this in legacy-style modules that probe hardware directly and 561 * register a single platform device and corresponding platform driver. 562 */ 563 struct platform_device * __init_or_module platform_create_bundle( 564 struct platform_driver *driver, 565 int (*probe)(struct platform_device *), 566 struct resource *res, unsigned int n_res, 567 const void *data, size_t size) 568 { 569 struct platform_device *pdev; 570 int error; 571 572 pdev = platform_device_alloc(driver->driver.name, -1); 573 if (!pdev) { 574 error = -ENOMEM; 575 goto err_out; 576 } 577 578 if (res) { 579 error = platform_device_add_resources(pdev, res, n_res); 580 if (error) 581 goto err_pdev_put; 582 } 583 584 if (data) { 585 error = platform_device_add_data(pdev, data, size); 586 if (error) 587 goto err_pdev_put; 588 } 589 590 error = platform_device_add(pdev); 591 if (error) 592 goto err_pdev_put; 593 594 error = platform_driver_probe(driver, probe); 595 if (error) 596 goto err_pdev_del; 597 598 return pdev; 599 600 err_pdev_del: 601 platform_device_del(pdev); 602 err_pdev_put: 603 platform_device_put(pdev); 604 err_out: 605 return ERR_PTR(error); 606 } 607 EXPORT_SYMBOL_GPL(platform_create_bundle); 608 609 /* modalias support enables more hands-off userspace setup: 610 * (a) environment variable lets new-style hotplug events work once system is 611 * fully running: "modprobe $MODALIAS" 612 * (b) sysfs attribute lets new-style coldplug recover from hotplug events 613 * mishandled before system is fully running: "modprobe $(cat modalias)" 614 */ 615 static ssize_t modalias_show(struct device *dev, struct device_attribute *a, 616 char *buf) 617 { 618 struct platform_device *pdev = to_platform_device(dev); 619 int len = snprintf(buf, PAGE_SIZE, "platform:%s\n", pdev->name); 620 621 return (len >= PAGE_SIZE) ? (PAGE_SIZE - 1) : len; 622 } 623 624 static struct device_attribute platform_dev_attrs[] = { 625 __ATTR_RO(modalias), 626 __ATTR_NULL, 627 }; 628 629 static int platform_uevent(struct device *dev, struct kobj_uevent_env *env) 630 { 631 struct platform_device *pdev = to_platform_device(dev); 632 633 add_uevent_var(env, "MODALIAS=%s%s", PLATFORM_MODULE_PREFIX, 634 (pdev->id_entry) ? pdev->id_entry->name : pdev->name); 635 return 0; 636 } 637 638 static const struct platform_device_id *platform_match_id( 639 struct platform_device_id *id, 640 struct platform_device *pdev) 641 { 642 while (id->name[0]) { 643 if (strcmp(pdev->name, id->name) == 0) { 644 pdev->id_entry = id; 645 return id; 646 } 647 id++; 648 } 649 return NULL; 650 } 651 652 /** 653 * platform_match - bind platform device to platform driver. 654 * @dev: device. 655 * @drv: driver. 656 * 657 * Platform device IDs are assumed to be encoded like this: 658 * "<name><instance>", where <name> is a short description of the type of 659 * device, like "pci" or "floppy", and <instance> is the enumerated 660 * instance of the device, like '0' or '42'. Driver IDs are simply 661 * "<name>". So, extract the <name> from the platform_device structure, 662 * and compare it against the name of the driver. Return whether they match 663 * or not. 664 */ 665 static int platform_match(struct device *dev, struct device_driver *drv) 666 { 667 struct platform_device *pdev = to_platform_device(dev); 668 struct platform_driver *pdrv = to_platform_driver(drv); 669 670 /* match against the id table first */ 671 if (pdrv->id_table) 672 return platform_match_id(pdrv->id_table, pdev) != NULL; 673 674 /* fall-back to driver name match */ 675 return (strcmp(pdev->name, drv->name) == 0); 676 } 677 678 #ifdef CONFIG_PM_SLEEP 679 680 static int platform_legacy_suspend(struct device *dev, pm_message_t mesg) 681 { 682 struct platform_driver *pdrv = to_platform_driver(dev->driver); 683 struct platform_device *pdev = to_platform_device(dev); 684 int ret = 0; 685 686 if (dev->driver && pdrv->suspend) 687 ret = pdrv->suspend(pdev, mesg); 688 689 return ret; 690 } 691 692 static int platform_legacy_resume(struct device *dev) 693 { 694 struct platform_driver *pdrv = to_platform_driver(dev->driver); 695 struct platform_device *pdev = to_platform_device(dev); 696 int ret = 0; 697 698 if (dev->driver && pdrv->resume) 699 ret = pdrv->resume(pdev); 700 701 return ret; 702 } 703 704 static int platform_pm_prepare(struct device *dev) 705 { 706 struct device_driver *drv = dev->driver; 707 int ret = 0; 708 709 if (drv && drv->pm && drv->pm->prepare) 710 ret = drv->pm->prepare(dev); 711 712 return ret; 713 } 714 715 static void platform_pm_complete(struct device *dev) 716 { 717 struct device_driver *drv = dev->driver; 718 719 if (drv && drv->pm && drv->pm->complete) 720 drv->pm->complete(dev); 721 } 722 723 #else /* !CONFIG_PM_SLEEP */ 724 725 #define platform_pm_prepare NULL 726 #define platform_pm_complete NULL 727 728 #endif /* !CONFIG_PM_SLEEP */ 729 730 #ifdef CONFIG_SUSPEND 731 732 static int platform_pm_suspend(struct device *dev) 733 { 734 struct device_driver *drv = dev->driver; 735 int ret = 0; 736 737 if (!drv) 738 return 0; 739 740 if (drv->pm) { 741 if (drv->pm->suspend) 742 ret = drv->pm->suspend(dev); 743 } else { 744 ret = platform_legacy_suspend(dev, PMSG_SUSPEND); 745 } 746 747 return ret; 748 } 749 750 static int platform_pm_suspend_noirq(struct device *dev) 751 { 752 struct device_driver *drv = dev->driver; 753 int ret = 0; 754 755 if (!drv) 756 return 0; 757 758 if (drv->pm) { 759 if (drv->pm->suspend_noirq) 760 ret = drv->pm->suspend_noirq(dev); 761 } 762 763 return ret; 764 } 765 766 static int platform_pm_resume(struct device *dev) 767 { 768 struct device_driver *drv = dev->driver; 769 int ret = 0; 770 771 if (!drv) 772 return 0; 773 774 if (drv->pm) { 775 if (drv->pm->resume) 776 ret = drv->pm->resume(dev); 777 } else { 778 ret = platform_legacy_resume(dev); 779 } 780 781 return ret; 782 } 783 784 static int platform_pm_resume_noirq(struct device *dev) 785 { 786 struct device_driver *drv = dev->driver; 787 int ret = 0; 788 789 if (!drv) 790 return 0; 791 792 if (drv->pm) { 793 if (drv->pm->resume_noirq) 794 ret = drv->pm->resume_noirq(dev); 795 } 796 797 return ret; 798 } 799 800 #else /* !CONFIG_SUSPEND */ 801 802 #define platform_pm_suspend NULL 803 #define platform_pm_resume NULL 804 #define platform_pm_suspend_noirq NULL 805 #define platform_pm_resume_noirq NULL 806 807 #endif /* !CONFIG_SUSPEND */ 808 809 #ifdef CONFIG_HIBERNATION 810 811 static int platform_pm_freeze(struct device *dev) 812 { 813 struct device_driver *drv = dev->driver; 814 int ret = 0; 815 816 if (!drv) 817 return 0; 818 819 if (drv->pm) { 820 if (drv->pm->freeze) 821 ret = drv->pm->freeze(dev); 822 } else { 823 ret = platform_legacy_suspend(dev, PMSG_FREEZE); 824 } 825 826 return ret; 827 } 828 829 static int platform_pm_freeze_noirq(struct device *dev) 830 { 831 struct device_driver *drv = dev->driver; 832 int ret = 0; 833 834 if (!drv) 835 return 0; 836 837 if (drv->pm) { 838 if (drv->pm->freeze_noirq) 839 ret = drv->pm->freeze_noirq(dev); 840 } 841 842 return ret; 843 } 844 845 static int platform_pm_thaw(struct device *dev) 846 { 847 struct device_driver *drv = dev->driver; 848 int ret = 0; 849 850 if (!drv) 851 return 0; 852 853 if (drv->pm) { 854 if (drv->pm->thaw) 855 ret = drv->pm->thaw(dev); 856 } else { 857 ret = platform_legacy_resume(dev); 858 } 859 860 return ret; 861 } 862 863 static int platform_pm_thaw_noirq(struct device *dev) 864 { 865 struct device_driver *drv = dev->driver; 866 int ret = 0; 867 868 if (!drv) 869 return 0; 870 871 if (drv->pm) { 872 if (drv->pm->thaw_noirq) 873 ret = drv->pm->thaw_noirq(dev); 874 } 875 876 return ret; 877 } 878 879 static int platform_pm_poweroff(struct device *dev) 880 { 881 struct device_driver *drv = dev->driver; 882 int ret = 0; 883 884 if (!drv) 885 return 0; 886 887 if (drv->pm) { 888 if (drv->pm->poweroff) 889 ret = drv->pm->poweroff(dev); 890 } else { 891 ret = platform_legacy_suspend(dev, PMSG_HIBERNATE); 892 } 893 894 return ret; 895 } 896 897 static int platform_pm_poweroff_noirq(struct device *dev) 898 { 899 struct device_driver *drv = dev->driver; 900 int ret = 0; 901 902 if (!drv) 903 return 0; 904 905 if (drv->pm) { 906 if (drv->pm->poweroff_noirq) 907 ret = drv->pm->poweroff_noirq(dev); 908 } 909 910 return ret; 911 } 912 913 static int platform_pm_restore(struct device *dev) 914 { 915 struct device_driver *drv = dev->driver; 916 int ret = 0; 917 918 if (!drv) 919 return 0; 920 921 if (drv->pm) { 922 if (drv->pm->restore) 923 ret = drv->pm->restore(dev); 924 } else { 925 ret = platform_legacy_resume(dev); 926 } 927 928 return ret; 929 } 930 931 static int platform_pm_restore_noirq(struct device *dev) 932 { 933 struct device_driver *drv = dev->driver; 934 int ret = 0; 935 936 if (!drv) 937 return 0; 938 939 if (drv->pm) { 940 if (drv->pm->restore_noirq) 941 ret = drv->pm->restore_noirq(dev); 942 } 943 944 return ret; 945 } 946 947 #else /* !CONFIG_HIBERNATION */ 948 949 #define platform_pm_freeze NULL 950 #define platform_pm_thaw NULL 951 #define platform_pm_poweroff NULL 952 #define platform_pm_restore NULL 953 #define platform_pm_freeze_noirq NULL 954 #define platform_pm_thaw_noirq NULL 955 #define platform_pm_poweroff_noirq NULL 956 #define platform_pm_restore_noirq NULL 957 958 #endif /* !CONFIG_HIBERNATION */ 959 960 #ifdef CONFIG_PM_RUNTIME 961 962 int __weak platform_pm_runtime_suspend(struct device *dev) 963 { 964 return -ENOSYS; 965 }; 966 967 int __weak platform_pm_runtime_resume(struct device *dev) 968 { 969 return -ENOSYS; 970 }; 971 972 int __weak platform_pm_runtime_idle(struct device *dev) 973 { 974 return -ENOSYS; 975 }; 976 977 #else /* !CONFIG_PM_RUNTIME */ 978 979 #define platform_pm_runtime_suspend NULL 980 #define platform_pm_runtime_resume NULL 981 #define platform_pm_runtime_idle NULL 982 983 #endif /* !CONFIG_PM_RUNTIME */ 984 985 static const struct dev_pm_ops platform_dev_pm_ops = { 986 .prepare = platform_pm_prepare, 987 .complete = platform_pm_complete, 988 .suspend = platform_pm_suspend, 989 .resume = platform_pm_resume, 990 .freeze = platform_pm_freeze, 991 .thaw = platform_pm_thaw, 992 .poweroff = platform_pm_poweroff, 993 .restore = platform_pm_restore, 994 .suspend_noirq = platform_pm_suspend_noirq, 995 .resume_noirq = platform_pm_resume_noirq, 996 .freeze_noirq = platform_pm_freeze_noirq, 997 .thaw_noirq = platform_pm_thaw_noirq, 998 .poweroff_noirq = platform_pm_poweroff_noirq, 999 .restore_noirq = platform_pm_restore_noirq, 1000 .runtime_suspend = platform_pm_runtime_suspend, 1001 .runtime_resume = platform_pm_runtime_resume, 1002 .runtime_idle = platform_pm_runtime_idle, 1003 }; 1004 1005 struct bus_type platform_bus_type = { 1006 .name = "platform", 1007 .dev_attrs = platform_dev_attrs, 1008 .match = platform_match, 1009 .uevent = platform_uevent, 1010 .pm = &platform_dev_pm_ops, 1011 }; 1012 EXPORT_SYMBOL_GPL(platform_bus_type); 1013 1014 int __init platform_bus_init(void) 1015 { 1016 int error; 1017 1018 early_platform_cleanup(); 1019 1020 error = device_register(&platform_bus); 1021 if (error) 1022 return error; 1023 error = bus_register(&platform_bus_type); 1024 if (error) 1025 device_unregister(&platform_bus); 1026 return error; 1027 } 1028 1029 #ifndef ARCH_HAS_DMA_GET_REQUIRED_MASK 1030 u64 dma_get_required_mask(struct device *dev) 1031 { 1032 u32 low_totalram = ((max_pfn - 1) << PAGE_SHIFT); 1033 u32 high_totalram = ((max_pfn - 1) >> (32 - PAGE_SHIFT)); 1034 u64 mask; 1035 1036 if (!high_totalram) { 1037 /* convert to mask just covering totalram */ 1038 low_totalram = (1 << (fls(low_totalram) - 1)); 1039 low_totalram += low_totalram - 1; 1040 mask = low_totalram; 1041 } else { 1042 high_totalram = (1 << (fls(high_totalram) - 1)); 1043 high_totalram += high_totalram - 1; 1044 mask = (((u64)high_totalram) << 32) + 0xffffffff; 1045 } 1046 return mask; 1047 } 1048 EXPORT_SYMBOL_GPL(dma_get_required_mask); 1049 #endif 1050 1051 static __initdata LIST_HEAD(early_platform_driver_list); 1052 static __initdata LIST_HEAD(early_platform_device_list); 1053 1054 /** 1055 * early_platform_driver_register 1056 * @epdrv: early_platform driver structure 1057 * @buf: string passed from early_param() 1058 */ 1059 int __init early_platform_driver_register(struct early_platform_driver *epdrv, 1060 char *buf) 1061 { 1062 char *tmp; 1063 int n; 1064 1065 /* Simply add the driver to the end of the global list. 1066 * Drivers will by default be put on the list in compiled-in order. 1067 */ 1068 if (!epdrv->list.next) { 1069 INIT_LIST_HEAD(&epdrv->list); 1070 list_add_tail(&epdrv->list, &early_platform_driver_list); 1071 } 1072 1073 /* If the user has specified device then make sure the driver 1074 * gets prioritized. The driver of the last device specified on 1075 * command line will be put first on the list. 1076 */ 1077 n = strlen(epdrv->pdrv->driver.name); 1078 if (buf && !strncmp(buf, epdrv->pdrv->driver.name, n)) { 1079 list_move(&epdrv->list, &early_platform_driver_list); 1080 1081 /* Allow passing parameters after device name */ 1082 if (buf[n] == '\0' || buf[n] == ',') 1083 epdrv->requested_id = -1; 1084 else { 1085 epdrv->requested_id = simple_strtoul(&buf[n + 1], 1086 &tmp, 10); 1087 1088 if (buf[n] != '.' || (tmp == &buf[n + 1])) { 1089 epdrv->requested_id = EARLY_PLATFORM_ID_ERROR; 1090 n = 0; 1091 } else 1092 n += strcspn(&buf[n + 1], ",") + 1; 1093 } 1094 1095 if (buf[n] == ',') 1096 n++; 1097 1098 if (epdrv->bufsize) { 1099 memcpy(epdrv->buffer, &buf[n], 1100 min_t(int, epdrv->bufsize, strlen(&buf[n]) + 1)); 1101 epdrv->buffer[epdrv->bufsize - 1] = '\0'; 1102 } 1103 } 1104 1105 return 0; 1106 } 1107 1108 /** 1109 * early_platform_add_devices - add a numbers of early platform devices 1110 * @devs: array of early platform devices to add 1111 * @num: number of early platform devices in array 1112 */ 1113 void __init early_platform_add_devices(struct platform_device **devs, int num) 1114 { 1115 struct device *dev; 1116 int i; 1117 1118 /* simply add the devices to list */ 1119 for (i = 0; i < num; i++) { 1120 dev = &devs[i]->dev; 1121 1122 if (!dev->devres_head.next) { 1123 INIT_LIST_HEAD(&dev->devres_head); 1124 list_add_tail(&dev->devres_head, 1125 &early_platform_device_list); 1126 } 1127 } 1128 } 1129 1130 /** 1131 * early_platform_driver_register_all 1132 * @class_str: string to identify early platform driver class 1133 */ 1134 void __init early_platform_driver_register_all(char *class_str) 1135 { 1136 /* The "class_str" parameter may or may not be present on the kernel 1137 * command line. If it is present then there may be more than one 1138 * matching parameter. 1139 * 1140 * Since we register our early platform drivers using early_param() 1141 * we need to make sure that they also get registered in the case 1142 * when the parameter is missing from the kernel command line. 1143 * 1144 * We use parse_early_options() to make sure the early_param() gets 1145 * called at least once. The early_param() may be called more than 1146 * once since the name of the preferred device may be specified on 1147 * the kernel command line. early_platform_driver_register() handles 1148 * this case for us. 1149 */ 1150 parse_early_options(class_str); 1151 } 1152 1153 /** 1154 * early_platform_match 1155 * @epdrv: early platform driver structure 1156 * @id: id to match against 1157 */ 1158 static __init struct platform_device * 1159 early_platform_match(struct early_platform_driver *epdrv, int id) 1160 { 1161 struct platform_device *pd; 1162 1163 list_for_each_entry(pd, &early_platform_device_list, dev.devres_head) 1164 if (platform_match(&pd->dev, &epdrv->pdrv->driver)) 1165 if (pd->id == id) 1166 return pd; 1167 1168 return NULL; 1169 } 1170 1171 /** 1172 * early_platform_left 1173 * @epdrv: early platform driver structure 1174 * @id: return true if id or above exists 1175 */ 1176 static __init int early_platform_left(struct early_platform_driver *epdrv, 1177 int id) 1178 { 1179 struct platform_device *pd; 1180 1181 list_for_each_entry(pd, &early_platform_device_list, dev.devres_head) 1182 if (platform_match(&pd->dev, &epdrv->pdrv->driver)) 1183 if (pd->id >= id) 1184 return 1; 1185 1186 return 0; 1187 } 1188 1189 /** 1190 * early_platform_driver_probe_id 1191 * @class_str: string to identify early platform driver class 1192 * @id: id to match against 1193 * @nr_probe: number of platform devices to successfully probe before exiting 1194 */ 1195 static int __init early_platform_driver_probe_id(char *class_str, 1196 int id, 1197 int nr_probe) 1198 { 1199 struct early_platform_driver *epdrv; 1200 struct platform_device *match; 1201 int match_id; 1202 int n = 0; 1203 int left = 0; 1204 1205 list_for_each_entry(epdrv, &early_platform_driver_list, list) { 1206 /* only use drivers matching our class_str */ 1207 if (strcmp(class_str, epdrv->class_str)) 1208 continue; 1209 1210 if (id == -2) { 1211 match_id = epdrv->requested_id; 1212 left = 1; 1213 1214 } else { 1215 match_id = id; 1216 left += early_platform_left(epdrv, id); 1217 1218 /* skip requested id */ 1219 switch (epdrv->requested_id) { 1220 case EARLY_PLATFORM_ID_ERROR: 1221 case EARLY_PLATFORM_ID_UNSET: 1222 break; 1223 default: 1224 if (epdrv->requested_id == id) 1225 match_id = EARLY_PLATFORM_ID_UNSET; 1226 } 1227 } 1228 1229 switch (match_id) { 1230 case EARLY_PLATFORM_ID_ERROR: 1231 pr_warning("%s: unable to parse %s parameter\n", 1232 class_str, epdrv->pdrv->driver.name); 1233 /* fall-through */ 1234 case EARLY_PLATFORM_ID_UNSET: 1235 match = NULL; 1236 break; 1237 default: 1238 match = early_platform_match(epdrv, match_id); 1239 } 1240 1241 if (match) { 1242 if (epdrv->pdrv->probe(match)) 1243 pr_warning("%s: unable to probe %s early.\n", 1244 class_str, match->name); 1245 else 1246 n++; 1247 } 1248 1249 if (n >= nr_probe) 1250 break; 1251 } 1252 1253 if (left) 1254 return n; 1255 else 1256 return -ENODEV; 1257 } 1258 1259 /** 1260 * early_platform_driver_probe 1261 * @class_str: string to identify early platform driver class 1262 * @nr_probe: number of platform devices to successfully probe before exiting 1263 * @user_only: only probe user specified early platform devices 1264 */ 1265 int __init early_platform_driver_probe(char *class_str, 1266 int nr_probe, 1267 int user_only) 1268 { 1269 int k, n, i; 1270 1271 n = 0; 1272 for (i = -2; n < nr_probe; i++) { 1273 k = early_platform_driver_probe_id(class_str, i, nr_probe - n); 1274 1275 if (k < 0) 1276 break; 1277 1278 n += k; 1279 1280 if (user_only) 1281 break; 1282 } 1283 1284 return n; 1285 } 1286 1287 /** 1288 * early_platform_cleanup - clean up early platform code 1289 */ 1290 void __init early_platform_cleanup(void) 1291 { 1292 struct platform_device *pd, *pd2; 1293 1294 /* clean up the devres list used to chain devices */ 1295 list_for_each_entry_safe(pd, pd2, &early_platform_device_list, 1296 dev.devres_head) { 1297 list_del(&pd->dev.devres_head); 1298 memset(&pd->dev.devres_head, 0, sizeof(pd->dev.devres_head)); 1299 } 1300 } 1301 1302