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