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