diff options
| author | Rafael J. Wysocki <rjw@sisk.pl> | 2011-07-15 17:59:09 -0400 |
|---|---|---|
| committer | Rafael J. Wysocki <rjw@sisk.pl> | 2011-07-15 17:59:09 -0400 |
| commit | ba1389d74f34c0c6e95cc135a332cd29c29d9c20 (patch) | |
| tree | 53813843d22cfcfe6d466a5daa44c646f8157980 | |
| parent | f0c077a8b7f9dce590c760a7b2f3c417dffa52d1 (diff) | |
| parent | 5ca80817e231723f1399bff495854ba2171103ca (diff) | |
Merge branch 'pm-domains' into for-linus
* pm-domains: (33 commits)
ARM / shmobile: Return -EBUSY from A4LC power off if A3RV is active
PM / Domains: Take .power_off() error code into account
ARM / shmobile: Use genpd_queue_power_off_work()
ARM / shmobile: Use pm_genpd_poweroff_unused()
PM / Domains: Introduce function to power off all unused PM domains
PM / Domains: Queue up power off work only if it is not pending
PM / Domains: Improve handling of wakeup devices during system suspend
PM / Domains: Do not restore all devices on power off error
PM / Domains: Allow callbacks to execute all runtime PM helpers
PM / Domains: Do not execute device callbacks under locks
PM / Domains: Make failing pm_genpd_prepare() clean up properly
PM / Domains: Set device state to "active" during system resume
ARM: mach-shmobile: sh7372 A3RV requires A4LC
PM / Domains: Export pm_genpd_poweron() in header
ARM: mach-shmobile: sh7372 late pm domain off
ARM: mach-shmobile: Runtime PM late init callback
ARM: mach-shmobile: sh7372 D4 support
ARM: mach-shmobile: sh7372 A4MP support
ARM: mach-shmobile: sh7372: make sure that fsi is peripheral of spu2
ARM: mach-shmobile: sh7372 A3SG support
...
24 files changed, 1937 insertions, 171 deletions
diff --git a/Documentation/power/devices.txt b/Documentation/power/devices.txt index 64565aac6e40..85c6f980b642 100644 --- a/Documentation/power/devices.txt +++ b/Documentation/power/devices.txt | |||
| @@ -506,8 +506,8 @@ routines. Nevertheless, different callback pointers are used in case there is a | |||
| 506 | situation where it actually matters. | 506 | situation where it actually matters. |
| 507 | 507 | ||
| 508 | 508 | ||
| 509 | Device Power Domains | 509 | Device Power Management Domains |
| 510 | -------------------- | 510 | ------------------------------- |
| 511 | Sometimes devices share reference clocks or other power resources. In those | 511 | Sometimes devices share reference clocks or other power resources. In those |
| 512 | cases it generally is not possible to put devices into low-power states | 512 | cases it generally is not possible to put devices into low-power states |
| 513 | individually. Instead, a set of devices sharing a power resource can be put | 513 | individually. Instead, a set of devices sharing a power resource can be put |
| @@ -516,8 +516,8 @@ power resource. Of course, they also need to be put into the full-power state | |||
| 516 | together, by turning the shared power resource on. A set of devices with this | 516 | together, by turning the shared power resource on. A set of devices with this |
| 517 | property is often referred to as a power domain. | 517 | property is often referred to as a power domain. |
| 518 | 518 | ||
| 519 | Support for power domains is provided through the pwr_domain field of struct | 519 | Support for power domains is provided through the pm_domain field of struct |
| 520 | device. This field is a pointer to an object of type struct dev_power_domain, | 520 | device. This field is a pointer to an object of type struct dev_pm_domain, |
| 521 | defined in include/linux/pm.h, providing a set of power management callbacks | 521 | defined in include/linux/pm.h, providing a set of power management callbacks |
| 522 | analogous to the subsystem-level and device driver callbacks that are executed | 522 | analogous to the subsystem-level and device driver callbacks that are executed |
| 523 | for the given device during all power transitions, instead of the respective | 523 | for the given device during all power transitions, instead of the respective |
diff --git a/Documentation/power/runtime_pm.txt b/Documentation/power/runtime_pm.txt index b24875b1ced5..4b011b171be4 100644 --- a/Documentation/power/runtime_pm.txt +++ b/Documentation/power/runtime_pm.txt | |||
| @@ -606,32 +606,60 @@ driver/base/power/generic_ops.c: | |||
| 606 | callback provided by its driver and return its result, or return 0 if not | 606 | callback provided by its driver and return its result, or return 0 if not |
| 607 | defined | 607 | defined |
| 608 | 608 | ||
| 609 | int pm_generic_suspend_noirq(struct device *dev); | ||
| 610 | - if pm_runtime_suspended(dev) returns "false", invoke the ->suspend_noirq() | ||
| 611 | callback provided by the device's driver and return its result, or return | ||
| 612 | 0 if not defined | ||
| 613 | |||
| 609 | int pm_generic_resume(struct device *dev); | 614 | int pm_generic_resume(struct device *dev); |
| 610 | - invoke the ->resume() callback provided by the driver of this device and, | 615 | - invoke the ->resume() callback provided by the driver of this device and, |
| 611 | if successful, change the device's runtime PM status to 'active' | 616 | if successful, change the device's runtime PM status to 'active' |
| 612 | 617 | ||
| 618 | int pm_generic_resume_noirq(struct device *dev); | ||
| 619 | - invoke the ->resume_noirq() callback provided by the driver of this device | ||
| 620 | |||
| 613 | int pm_generic_freeze(struct device *dev); | 621 | int pm_generic_freeze(struct device *dev); |
| 614 | - if the device has not been suspended at run time, invoke the ->freeze() | 622 | - if the device has not been suspended at run time, invoke the ->freeze() |
| 615 | callback provided by its driver and return its result, or return 0 if not | 623 | callback provided by its driver and return its result, or return 0 if not |
| 616 | defined | 624 | defined |
| 617 | 625 | ||
| 626 | int pm_generic_freeze_noirq(struct device *dev); | ||
| 627 | - if pm_runtime_suspended(dev) returns "false", invoke the ->freeze_noirq() | ||
| 628 | callback provided by the device's driver and return its result, or return | ||
| 629 | 0 if not defined | ||
| 630 | |||
| 618 | int pm_generic_thaw(struct device *dev); | 631 | int pm_generic_thaw(struct device *dev); |
| 619 | - if the device has not been suspended at run time, invoke the ->thaw() | 632 | - if the device has not been suspended at run time, invoke the ->thaw() |
| 620 | callback provided by its driver and return its result, or return 0 if not | 633 | callback provided by its driver and return its result, or return 0 if not |
| 621 | defined | 634 | defined |
| 622 | 635 | ||
| 636 | int pm_generic_thaw_noirq(struct device *dev); | ||
| 637 | - if pm_runtime_suspended(dev) returns "false", invoke the ->thaw_noirq() | ||
| 638 | callback provided by the device's driver and return its result, or return | ||
| 639 | 0 if not defined | ||
| 640 | |||
| 623 | int pm_generic_poweroff(struct device *dev); | 641 | int pm_generic_poweroff(struct device *dev); |
| 624 | - if the device has not been suspended at run time, invoke the ->poweroff() | 642 | - if the device has not been suspended at run time, invoke the ->poweroff() |
| 625 | callback provided by its driver and return its result, or return 0 if not | 643 | callback provided by its driver and return its result, or return 0 if not |
| 626 | defined | 644 | defined |
| 627 | 645 | ||
| 646 | int pm_generic_poweroff_noirq(struct device *dev); | ||
| 647 | - if pm_runtime_suspended(dev) returns "false", run the ->poweroff_noirq() | ||
| 648 | callback provided by the device's driver and return its result, or return | ||
| 649 | 0 if not defined | ||
| 650 | |||
| 628 | int pm_generic_restore(struct device *dev); | 651 | int pm_generic_restore(struct device *dev); |
| 629 | - invoke the ->restore() callback provided by the driver of this device and, | 652 | - invoke the ->restore() callback provided by the driver of this device and, |
| 630 | if successful, change the device's runtime PM status to 'active' | 653 | if successful, change the device's runtime PM status to 'active' |
| 631 | 654 | ||
| 655 | int pm_generic_restore_noirq(struct device *dev); | ||
| 656 | - invoke the ->restore_noirq() callback provided by the device's driver | ||
| 657 | |||
| 632 | These functions can be assigned to the ->runtime_idle(), ->runtime_suspend(), | 658 | These functions can be assigned to the ->runtime_idle(), ->runtime_suspend(), |
| 633 | ->runtime_resume(), ->suspend(), ->resume(), ->freeze(), ->thaw(), ->poweroff(), | 659 | ->runtime_resume(), ->suspend(), ->suspend_noirq(), ->resume(), |
| 634 | or ->restore() callback pointers in the subsystem-level dev_pm_ops structures. | 660 | ->resume_noirq(), ->freeze(), ->freeze_noirq(), ->thaw(), ->thaw_noirq(), |
| 661 | ->poweroff(), ->poweroff_noirq(), ->restore(), ->restore_noirq() callback | ||
| 662 | pointers in the subsystem-level dev_pm_ops structures. | ||
| 635 | 663 | ||
| 636 | If a subsystem wishes to use all of them at the same time, it can simply assign | 664 | If a subsystem wishes to use all of them at the same time, it can simply assign |
| 637 | the GENERIC_SUBSYS_PM_OPS macro, defined in include/linux/pm.h, to its | 665 | the GENERIC_SUBSYS_PM_OPS macro, defined in include/linux/pm.h, to its |
diff --git a/arch/arm/Kconfig b/arch/arm/Kconfig index 9adc278a22ab..e04fa9d7637c 100644 --- a/arch/arm/Kconfig +++ b/arch/arm/Kconfig | |||
| @@ -642,6 +642,7 @@ config ARCH_SHMOBILE | |||
| 642 | select NO_IOPORT | 642 | select NO_IOPORT |
| 643 | select SPARSE_IRQ | 643 | select SPARSE_IRQ |
| 644 | select MULTI_IRQ_HANDLER | 644 | select MULTI_IRQ_HANDLER |
| 645 | select PM_GENERIC_DOMAINS if PM | ||
| 645 | help | 646 | help |
| 646 | Support for Renesas's SH-Mobile and R-Mobile ARM platforms. | 647 | Support for Renesas's SH-Mobile and R-Mobile ARM platforms. |
| 647 | 648 | ||
diff --git a/arch/arm/mach-omap1/pm_bus.c b/arch/arm/mach-omap1/pm_bus.c index 334fb8871bc3..943072d5a1d5 100644 --- a/arch/arm/mach-omap1/pm_bus.c +++ b/arch/arm/mach-omap1/pm_bus.c | |||
| @@ -32,7 +32,7 @@ static int omap1_pm_runtime_suspend(struct device *dev) | |||
| 32 | if (ret) | 32 | if (ret) |
| 33 | return ret; | 33 | return ret; |
| 34 | 34 | ||
| 35 | ret = pm_runtime_clk_suspend(dev); | 35 | ret = pm_clk_suspend(dev); |
| 36 | if (ret) { | 36 | if (ret) { |
| 37 | pm_generic_runtime_resume(dev); | 37 | pm_generic_runtime_resume(dev); |
| 38 | return ret; | 38 | return ret; |
| @@ -45,24 +45,24 @@ static int omap1_pm_runtime_resume(struct device *dev) | |||
| 45 | { | 45 | { |
| 46 | dev_dbg(dev, "%s\n", __func__); | 46 | dev_dbg(dev, "%s\n", __func__); |
| 47 | 47 | ||
| 48 | pm_runtime_clk_resume(dev); | 48 | pm_clk_resume(dev); |
| 49 | return pm_generic_runtime_resume(dev); | 49 | return pm_generic_runtime_resume(dev); |
| 50 | } | 50 | } |
| 51 | 51 | ||
| 52 | static struct dev_power_domain default_power_domain = { | 52 | static struct dev_pm_domain default_pm_domain = { |
| 53 | .ops = { | 53 | .ops = { |
| 54 | .runtime_suspend = omap1_pm_runtime_suspend, | 54 | .runtime_suspend = omap1_pm_runtime_suspend, |
| 55 | .runtime_resume = omap1_pm_runtime_resume, | 55 | .runtime_resume = omap1_pm_runtime_resume, |
| 56 | USE_PLATFORM_PM_SLEEP_OPS | 56 | USE_PLATFORM_PM_SLEEP_OPS |
| 57 | }, | 57 | }, |
| 58 | }; | 58 | }; |
| 59 | #define OMAP1_PWR_DOMAIN (&default_power_domain) | 59 | #define OMAP1_PM_DOMAIN (&default_pm_domain) |
| 60 | #else | 60 | #else |
| 61 | #define OMAP1_PWR_DOMAIN NULL | 61 | #define OMAP1_PM_DOMAIN NULL |
| 62 | #endif /* CONFIG_PM_RUNTIME */ | 62 | #endif /* CONFIG_PM_RUNTIME */ |
| 63 | 63 | ||
| 64 | static struct pm_clk_notifier_block platform_bus_notifier = { | 64 | static struct pm_clk_notifier_block platform_bus_notifier = { |
| 65 | .pwr_domain = OMAP1_PWR_DOMAIN, | 65 | .pm_domain = OMAP1_PM_DOMAIN, |
| 66 | .con_ids = { "ick", "fck", NULL, }, | 66 | .con_ids = { "ick", "fck", NULL, }, |
| 67 | }; | 67 | }; |
| 68 | 68 | ||
| @@ -71,7 +71,7 @@ static int __init omap1_pm_runtime_init(void) | |||
| 71 | if (!cpu_class_is_omap1()) | 71 | if (!cpu_class_is_omap1()) |
| 72 | return -ENODEV; | 72 | return -ENODEV; |
| 73 | 73 | ||
| 74 | pm_runtime_clk_add_notifier(&platform_bus_type, &platform_bus_notifier); | 74 | pm_clk_add_notifier(&platform_bus_type, &platform_bus_notifier); |
| 75 | 75 | ||
| 76 | return 0; | 76 | return 0; |
| 77 | } | 77 | } |
diff --git a/arch/arm/mach-shmobile/board-ap4evb.c b/arch/arm/mach-shmobile/board-ap4evb.c index 803bc6edfca4..b473b8efac68 100644 --- a/arch/arm/mach-shmobile/board-ap4evb.c +++ b/arch/arm/mach-shmobile/board-ap4evb.c | |||
| @@ -1408,9 +1408,14 @@ static void __init ap4evb_init(void) | |||
| 1408 | 1408 | ||
| 1409 | platform_add_devices(ap4evb_devices, ARRAY_SIZE(ap4evb_devices)); | 1409 | platform_add_devices(ap4evb_devices, ARRAY_SIZE(ap4evb_devices)); |
| 1410 | 1410 | ||
| 1411 | sh7372_add_device_to_domain(&sh7372_a4lc, &lcdc1_device); | ||
| 1412 | sh7372_add_device_to_domain(&sh7372_a4lc, &lcdc_device); | ||
| 1413 | sh7372_add_device_to_domain(&sh7372_a4mp, &fsi_device); | ||
| 1414 | |||
| 1411 | hdmi_init_pm_clock(); | 1415 | hdmi_init_pm_clock(); |
| 1412 | fsi_init_pm_clock(); | 1416 | fsi_init_pm_clock(); |
| 1413 | sh7372_pm_init(); | 1417 | sh7372_pm_init(); |
| 1418 | pm_clk_add(&fsi_device.dev, "spu2"); | ||
| 1414 | } | 1419 | } |
| 1415 | 1420 | ||
| 1416 | static void __init ap4evb_timer_init(void) | 1421 | static void __init ap4evb_timer_init(void) |
diff --git a/arch/arm/mach-shmobile/board-mackerel.c b/arch/arm/mach-shmobile/board-mackerel.c index 3802f2afabef..5b36b6c5b448 100644 --- a/arch/arm/mach-shmobile/board-mackerel.c +++ b/arch/arm/mach-shmobile/board-mackerel.c | |||
| @@ -1582,8 +1582,13 @@ static void __init mackerel_init(void) | |||
| 1582 | 1582 | ||
| 1583 | platform_add_devices(mackerel_devices, ARRAY_SIZE(mackerel_devices)); | 1583 | platform_add_devices(mackerel_devices, ARRAY_SIZE(mackerel_devices)); |
| 1584 | 1584 | ||
| 1585 | sh7372_add_device_to_domain(&sh7372_a4lc, &lcdc_device); | ||
| 1586 | sh7372_add_device_to_domain(&sh7372_a4lc, &hdmi_lcdc_device); | ||
| 1587 | sh7372_add_device_to_domain(&sh7372_a4mp, &fsi_device); | ||
| 1588 | |||
| 1585 | hdmi_init_pm_clock(); | 1589 | hdmi_init_pm_clock(); |
| 1586 | sh7372_pm_init(); | 1590 | sh7372_pm_init(); |
| 1591 | pm_clk_add(&fsi_device.dev, "spu2"); | ||
| 1587 | } | 1592 | } |
| 1588 | 1593 | ||
| 1589 | static void __init mackerel_timer_init(void) | 1594 | static void __init mackerel_timer_init(void) |
diff --git a/arch/arm/mach-shmobile/clock-sh7372.c b/arch/arm/mach-shmobile/clock-sh7372.c index c0800d83971e..91f5779abdd3 100644 --- a/arch/arm/mach-shmobile/clock-sh7372.c +++ b/arch/arm/mach-shmobile/clock-sh7372.c | |||
| @@ -662,6 +662,7 @@ static struct clk_lookup lookups[] = { | |||
| 662 | CLKDEV_ICK_ID("ick", "sh-mobile-hdmi", &div6_reparent_clks[DIV6_HDMI]), | 662 | CLKDEV_ICK_ID("ick", "sh-mobile-hdmi", &div6_reparent_clks[DIV6_HDMI]), |
| 663 | CLKDEV_ICK_ID("icka", "sh_fsi2", &div6_reparent_clks[DIV6_FSIA]), | 663 | CLKDEV_ICK_ID("icka", "sh_fsi2", &div6_reparent_clks[DIV6_FSIA]), |
| 664 | CLKDEV_ICK_ID("ickb", "sh_fsi2", &div6_reparent_clks[DIV6_FSIB]), | 664 | CLKDEV_ICK_ID("ickb", "sh_fsi2", &div6_reparent_clks[DIV6_FSIB]), |
| 665 | CLKDEV_ICK_ID("spu2", "sh_fsi2", &mstp_clks[MSTP223]), | ||
| 665 | }; | 666 | }; |
| 666 | 667 | ||
| 667 | void __init sh7372_clock_init(void) | 668 | void __init sh7372_clock_init(void) |
diff --git a/arch/arm/mach-shmobile/include/mach/sh7372.h b/arch/arm/mach-shmobile/include/mach/sh7372.h index df20d7670172..ce595cee86cd 100644 --- a/arch/arm/mach-shmobile/include/mach/sh7372.h +++ b/arch/arm/mach-shmobile/include/mach/sh7372.h | |||
| @@ -12,6 +12,7 @@ | |||
| 12 | #define __ASM_SH7372_H__ | 12 | #define __ASM_SH7372_H__ |
| 13 | 13 | ||
| 14 | #include <linux/sh_clk.h> | 14 | #include <linux/sh_clk.h> |
| 15 | #include <linux/pm_domain.h> | ||
| 15 | 16 | ||
| 16 | /* | 17 | /* |
| 17 | * Pin Function Controller: | 18 | * Pin Function Controller: |
| @@ -470,4 +471,32 @@ extern struct clk sh7372_fsibck_clk; | |||
| 470 | extern struct clk sh7372_fsidiva_clk; | 471 | extern struct clk sh7372_fsidiva_clk; |
| 471 | extern struct clk sh7372_fsidivb_clk; | 472 | extern struct clk sh7372_fsidivb_clk; |
| 472 | 473 | ||
| 474 | struct platform_device; | ||
| 475 | |||
| 476 | struct sh7372_pm_domain { | ||
| 477 | struct generic_pm_domain genpd; | ||
| 478 | unsigned int bit_shift; | ||
| 479 | }; | ||
| 480 | |||
| 481 | static inline struct sh7372_pm_domain *to_sh7372_pd(struct generic_pm_domain *d) | ||
| 482 | { | ||
| 483 | return container_of(d, struct sh7372_pm_domain, genpd); | ||
| 484 | } | ||
| 485 | |||
| 486 | #ifdef CONFIG_PM | ||
| 487 | extern struct sh7372_pm_domain sh7372_a4lc; | ||
| 488 | extern struct sh7372_pm_domain sh7372_a4mp; | ||
| 489 | extern struct sh7372_pm_domain sh7372_d4; | ||
| 490 | extern struct sh7372_pm_domain sh7372_a3rv; | ||
| 491 | extern struct sh7372_pm_domain sh7372_a3ri; | ||
| 492 | extern struct sh7372_pm_domain sh7372_a3sg; | ||
| 493 | |||
| 494 | extern void sh7372_init_pm_domain(struct sh7372_pm_domain *sh7372_pd); | ||
| 495 | extern void sh7372_add_device_to_domain(struct sh7372_pm_domain *sh7372_pd, | ||
| 496 | struct platform_device *pdev); | ||
| 497 | #else | ||
| 498 | #define sh7372_init_pm_domain(pd) do { } while(0) | ||
| 499 | #define sh7372_add_device_to_domain(pd, pdev) do { } while(0) | ||
| 500 | #endif /* CONFIG_PM */ | ||
| 501 | |||
| 473 | #endif /* __ASM_SH7372_H__ */ | 502 | #endif /* __ASM_SH7372_H__ */ |
diff --git a/arch/arm/mach-shmobile/pm-sh7372.c b/arch/arm/mach-shmobile/pm-sh7372.c index 8e4aadf14c9f..933fb411be0f 100644 --- a/arch/arm/mach-shmobile/pm-sh7372.c +++ b/arch/arm/mach-shmobile/pm-sh7372.c | |||
| @@ -15,16 +15,176 @@ | |||
| 15 | #include <linux/list.h> | 15 | #include <linux/list.h> |
| 16 | #include <linux/err.h> | 16 | #include <linux/err.h> |
| 17 | #include <linux/slab.h> | 17 | #include <linux/slab.h> |
| 18 | #include <linux/pm_runtime.h> | ||
| 19 | #include <linux/platform_device.h> | ||
| 20 | #include <linux/delay.h> | ||
| 18 | #include <asm/system.h> | 21 | #include <asm/system.h> |
| 19 | #include <asm/io.h> | 22 | #include <asm/io.h> |
| 20 | #include <asm/tlbflush.h> | 23 | #include <asm/tlbflush.h> |
| 21 | #include <mach/common.h> | 24 | #include <mach/common.h> |
| 25 | #include <mach/sh7372.h> | ||
| 22 | 26 | ||
| 23 | #define SMFRAM 0xe6a70000 | 27 | #define SMFRAM 0xe6a70000 |
| 24 | #define SYSTBCR 0xe6150024 | 28 | #define SYSTBCR 0xe6150024 |
| 25 | #define SBAR 0xe6180020 | 29 | #define SBAR 0xe6180020 |
| 26 | #define APARMBAREA 0xe6f10020 | 30 | #define APARMBAREA 0xe6f10020 |
| 27 | 31 | ||
| 32 | #define SPDCR 0xe6180008 | ||
| 33 | #define SWUCR 0xe6180014 | ||
| 34 | #define PSTR 0xe6180080 | ||
| 35 | |||
| 36 | #define PSTR_RETRIES 100 | ||
| 37 | #define PSTR_DELAY_US 10 | ||
| 38 | |||
| 39 | #ifdef CONFIG_PM | ||
| 40 | |||
| 41 | static int pd_power_down(struct generic_pm_domain *genpd) | ||
| 42 | { | ||
| 43 | struct sh7372_pm_domain *sh7372_pd = to_sh7372_pd(genpd); | ||
| 44 | unsigned int mask = 1 << sh7372_pd->bit_shift; | ||
| 45 | |||
| 46 | if (__raw_readl(PSTR) & mask) { | ||
| 47 | unsigned int retry_count; | ||
| 48 | |||
| 49 | __raw_writel(mask, SPDCR); | ||
| 50 | |||
| 51 | for (retry_count = PSTR_RETRIES; retry_count; retry_count--) { | ||
| 52 | if (!(__raw_readl(SPDCR) & mask)) | ||
| 53 | break; | ||
| 54 | cpu_relax(); | ||
| 55 | } | ||
| 56 | } | ||
| 57 | |||
| 58 | pr_debug("sh7372 power domain down 0x%08x -> PSTR = 0x%08x\n", | ||
| 59 | mask, __raw_readl(PSTR)); | ||
| 60 | |||
| 61 | return 0; | ||
| 62 | } | ||
| 63 | |||
| 64 | static int pd_power_up(struct generic_pm_domain *genpd) | ||
| 65 | { | ||
| 66 | struct sh7372_pm_domain *sh7372_pd = to_sh7372_pd(genpd); | ||
| 67 | unsigned int mask = 1 << sh7372_pd->bit_shift; | ||
| 68 | unsigned int retry_count; | ||
| 69 | int ret = 0; | ||
| 70 | |||
| 71 | if (__raw_readl(PSTR) & mask) | ||
| 72 | goto out; | ||
| 73 | |||
| 74 | __raw_writel(mask, SWUCR); | ||
| 75 | |||
| 76 | for (retry_count = 2 * PSTR_RETRIES; retry_count; retry_count--) { | ||
| 77 | if (!(__raw_readl(SWUCR) & mask)) | ||
| 78 | goto out; | ||
| 79 | if (retry_count > PSTR_RETRIES) | ||
| 80 | udelay(PSTR_DELAY_US); | ||
| 81 | else | ||
| 82 | cpu_relax(); | ||
| 83 | } | ||
| 84 | if (__raw_readl(SWUCR) & mask) | ||
| 85 | ret = -EIO; | ||
| 86 | |||
| 87 | out: | ||
| 88 | pr_debug("sh7372 power domain up 0x%08x -> PSTR = 0x%08x\n", | ||
| 89 | mask, __raw_readl(PSTR)); | ||
| 90 | |||
| 91 | return ret; | ||
| 92 | } | ||
| 93 | |||
| 94 | static int pd_power_up_a3rv(struct generic_pm_domain *genpd) | ||
| 95 | { | ||
| 96 | int ret = pd_power_up(genpd); | ||
| 97 | |||
| 98 | /* force A4LC on after A3RV has been requested on */ | ||
| 99 | pm_genpd_poweron(&sh7372_a4lc.genpd); | ||
| 100 | |||
| 101 | return ret; | ||
| 102 | } | ||
| 103 | |||
| 104 | static int pd_power_down_a3rv(struct generic_pm_domain *genpd) | ||
| 105 | { | ||
| 106 | int ret = pd_power_down(genpd); | ||
| 107 | |||
| 108 | /* try to power down A4LC after A3RV is requested off */ | ||
| 109 | genpd_queue_power_off_work(&sh7372_a4lc.genpd); | ||
| 110 | |||
| 111 | return ret; | ||
| 112 | } | ||
| 113 | |||
| 114 | static int pd_power_down_a4lc(struct generic_pm_domain *genpd) | ||
| 115 | { | ||
| 116 | /* only power down A4LC if A3RV is off */ | ||
| 117 | if (!(__raw_readl(PSTR) & (1 << sh7372_a3rv.bit_shift))) | ||
| 118 | return pd_power_down(genpd); | ||
| 119 | |||
| 120 | return -EBUSY; | ||
| 121 | } | ||
| 122 | |||
| 123 | static bool pd_active_wakeup(struct device *dev) | ||
| 124 | { | ||
| 125 | return true; | ||
| 126 | } | ||
| 127 | |||
| 128 | void sh7372_init_pm_domain(struct sh7372_pm_domain *sh7372_pd) | ||
| 129 | { | ||
| 130 | struct generic_pm_domain *genpd = &sh7372_pd->genpd; | ||
| 131 | |||
| 132 | pm_genpd_init(genpd, NULL, false); | ||
| 133 | genpd->stop_device = pm_clk_suspend; | ||
| 134 | genpd->start_device = pm_clk_resume; | ||
| 135 | genpd->active_wakeup = pd_active_wakeup; | ||
| 136 | |||
| 137 | if (sh7372_pd == &sh7372_a4lc) { | ||
| 138 | genpd->power_off = pd_power_down_a4lc; | ||
| 139 | genpd->power_on = pd_power_up; | ||
| 140 | } else if (sh7372_pd == &sh7372_a3rv) { | ||
| 141 | genpd->power_off = pd_power_down_a3rv; | ||
| 142 | genpd->power_on = pd_power_up_a3rv; | ||
| 143 | } else { | ||
| 144 | genpd->power_off = pd_power_down; | ||
| 145 | genpd->power_on = pd_power_up; | ||
| 146 | } | ||
| 147 | genpd->power_on(&sh7372_pd->genpd); | ||
| 148 | } | ||
| 149 | |||
| 150 | void sh7372_add_device_to_domain(struct sh7372_pm_domain *sh7372_pd, | ||
| 151 | struct platform_device *pdev) | ||
| 152 | { | ||
| 153 | struct device *dev = &pdev->dev; | ||
| 154 | |||
| 155 | if (!dev->power.subsys_data) { | ||
| 156 | pm_clk_init(dev); | ||
| 157 | pm_clk_add(dev, NULL); | ||
| 158 | } | ||
| 159 | pm_genpd_add_device(&sh7372_pd->genpd, dev); | ||
| 160 | } | ||
| 161 | |||
| 162 | struct sh7372_pm_domain sh7372_a4lc = { | ||
| 163 | .bit_shift = 1, | ||
| 164 | }; | ||
| 165 | |||
| 166 | struct sh7372_pm_domain sh7372_a4mp = { | ||
| 167 | .bit_shift = 2, | ||
| 168 | }; | ||
| 169 | |||
| 170 | struct sh7372_pm_domain sh7372_d4 = { | ||
| 171 | .bit_shift = 3, | ||
| 172 | }; | ||
| 173 | |||
| 174 | struct sh7372_pm_domain sh7372_a3rv = { | ||
| 175 | .bit_shift = 6, | ||
| 176 | }; | ||
| 177 | |||
| 178 | struct sh7372_pm_domain sh7372_a3ri = { | ||
| 179 | .bit_shift = 8, | ||
| 180 | }; | ||
| 181 | |||
| 182 | struct sh7372_pm_domain sh7372_a3sg = { | ||
| 183 | .bit_shift = 13, | ||
| 184 | }; | ||
| 185 | |||
| 186 | #endif /* CONFIG_PM */ | ||
| 187 | |||
| 28 | static void sh7372_enter_core_standby(void) | 188 | static void sh7372_enter_core_standby(void) |
| 29 | { | 189 | { |
| 30 | void __iomem *smfram = (void __iomem *)SMFRAM; | 190 | void __iomem *smfram = (void __iomem *)SMFRAM; |
diff --git a/arch/arm/mach-shmobile/pm_runtime.c b/arch/arm/mach-shmobile/pm_runtime.c index 2d1b67a59e4a..6ec454e1e063 100644 --- a/arch/arm/mach-shmobile/pm_runtime.c +++ b/arch/arm/mach-shmobile/pm_runtime.c | |||
| @@ -14,6 +14,7 @@ | |||
| 14 | #include <linux/kernel.h> | 14 | #include <linux/kernel.h> |
| 15 | #include <linux/io.h> | 15 | #include <linux/io.h> |
| 16 | #include <linux/pm_runtime.h> | 16 | #include <linux/pm_runtime.h> |
| 17 | #include <linux/pm_domain.h> | ||
| 17 | #include <linux/platform_device.h> | 18 | #include <linux/platform_device.h> |
| 18 | #include <linux/clk.h> | 19 | #include <linux/clk.h> |
| 19 | #include <linux/sh_clk.h> | 20 | #include <linux/sh_clk.h> |
| @@ -28,31 +29,38 @@ static int default_platform_runtime_idle(struct device *dev) | |||
| 28 | return pm_runtime_suspend(dev); | 29 | return pm_runtime_suspend(dev); |
| 29 | } | 30 | } |
| 30 | 31 | ||
| 31 | static struct dev_power_domain default_power_domain = { | 32 | static struct dev_pm_domain default_pm_domain = { |
| 32 | .ops = { | 33 | .ops = { |
| 33 | .runtime_suspend = pm_runtime_clk_suspend, | 34 | .runtime_suspend = pm_clk_suspend, |
| 34 | .runtime_resume = pm_runtime_clk_resume, | 35 | .runtime_resume = pm_clk_resume, |
| 35 | .runtime_idle = default_platform_runtime_idle, | 36 | .runtime_idle = default_platform_runtime_idle, |
| 36 | USE_PLATFORM_PM_SLEEP_OPS | 37 | USE_PLATFORM_PM_SLEEP_OPS |
| 37 | }, | 38 | }, |
| 38 | }; | 39 | }; |
| 39 | 40 | ||
| 40 | #define DEFAULT_PWR_DOMAIN_PTR (&default_power_domain) | 41 | #define DEFAULT_PM_DOMAIN_PTR (&default_pm_domain) |
| 41 | 42 | ||
| 42 | #else | 43 | #else |
| 43 | 44 | ||
| 44 | #define DEFAULT_PWR_DOMAIN_PTR NULL | 45 | #define DEFAULT_PM_DOMAIN_PTR NULL |
| 45 | 46 | ||
| 46 | #endif /* CONFIG_PM_RUNTIME */ | 47 | #endif /* CONFIG_PM_RUNTIME */ |
| 47 | 48 | ||
| 48 | static struct pm_clk_notifier_block platform_bus_notifier = { | 49 | static struct pm_clk_notifier_block platform_bus_notifier = { |
| 49 | .pwr_domain = DEFAULT_PWR_DOMAIN_PTR, | 50 | .pm_domain = DEFAULT_PM_DOMAIN_PTR, |
| 50 | .con_ids = { NULL, }, | 51 | .con_ids = { NULL, }, |
| 51 | }; | 52 | }; |
| 52 | 53 | ||
| 53 | static int __init sh_pm_runtime_init(void) | 54 | static int __init sh_pm_runtime_init(void) |
| 54 | { | 55 | { |
| 55 | pm_runtime_clk_add_notifier(&platform_bus_type, &platform_bus_notifier); | 56 | pm_clk_add_notifier(&platform_bus_type, &platform_bus_notifier); |
| 56 | return 0; | 57 | return 0; |
| 57 | } | 58 | } |
| 58 | core_initcall(sh_pm_runtime_init); | 59 | core_initcall(sh_pm_runtime_init); |
| 60 | |||
| 61 | static int __init sh_pm_runtime_late_init(void) | ||
| 62 | { | ||
| 63 | pm_genpd_poweroff_unused(); | ||
| 64 | return 0; | ||
| 65 | } | ||
| 66 | late_initcall(sh_pm_runtime_late_init); | ||
diff --git a/arch/arm/mach-shmobile/setup-sh7372.c b/arch/arm/mach-shmobile/setup-sh7372.c index cd807eea69e2..79f0413d8725 100644 --- a/arch/arm/mach-shmobile/setup-sh7372.c +++ b/arch/arm/mach-shmobile/setup-sh7372.c | |||
| @@ -841,11 +841,22 @@ static struct platform_device *sh7372_late_devices[] __initdata = { | |||
| 841 | 841 | ||
| 842 | void __init sh7372_add_standard_devices(void) | 842 | void __init sh7372_add_standard_devices(void) |
| 843 | { | 843 | { |
| 844 | sh7372_init_pm_domain(&sh7372_a4lc); | ||
| 845 | sh7372_init_pm_domain(&sh7372_a4mp); | ||
| 846 | sh7372_init_pm_domain(&sh7372_d4); | ||
| 847 | sh7372_init_pm_domain(&sh7372_a3rv); | ||
| 848 | sh7372_init_pm_domain(&sh7372_a3ri); | ||
| 849 | sh7372_init_pm_domain(&sh7372_a3sg); | ||
| 850 | |||
| 844 | platform_add_devices(sh7372_early_devices, | 851 | platform_add_devices(sh7372_early_devices, |
| 845 | ARRAY_SIZE(sh7372_early_devices)); | 852 | ARRAY_SIZE(sh7372_early_devices)); |
| 846 | 853 | ||
| 847 | platform_add_devices(sh7372_late_devices, | 854 | platform_add_devices(sh7372_late_devices, |
| 848 | ARRAY_SIZE(sh7372_late_devices)); | 855 | ARRAY_SIZE(sh7372_late_devices)); |
| 856 | |||
| 857 | sh7372_add_device_to_domain(&sh7372_a3rv, &vpu_device); | ||
| 858 | sh7372_add_device_to_domain(&sh7372_a4mp, &spu0_device); | ||
| 859 | sh7372_add_device_to_domain(&sh7372_a4mp, &spu1_device); | ||
| 849 | } | 860 | } |
| 850 | 861 | ||
| 851 | void __init sh7372_add_early_devices(void) | 862 | void __init sh7372_add_early_devices(void) |
diff --git a/arch/arm/plat-omap/omap_device.c b/arch/arm/plat-omap/omap_device.c index 49fc0df0c21f..d21579b2c11e 100644 --- a/arch/arm/plat-omap/omap_device.c +++ b/arch/arm/plat-omap/omap_device.c | |||
| @@ -564,7 +564,7 @@ static int _od_runtime_resume(struct device *dev) | |||
| 564 | return pm_generic_runtime_resume(dev); | 564 | return pm_generic_runtime_resume(dev); |
| 565 | } | 565 | } |
| 566 | 566 | ||
| 567 | static struct dev_power_domain omap_device_power_domain = { | 567 | static struct dev_pm_domain omap_device_pm_domain = { |
| 568 | .ops = { | 568 | .ops = { |
| 569 | .runtime_suspend = _od_runtime_suspend, | 569 | .runtime_suspend = _od_runtime_suspend, |
| 570 | .runtime_idle = _od_runtime_idle, | 570 | .runtime_idle = _od_runtime_idle, |
| @@ -586,7 +586,7 @@ int omap_device_register(struct omap_device *od) | |||
| 586 | pr_debug("omap_device: %s: registering\n", od->pdev.name); | 586 | pr_debug("omap_device: %s: registering\n", od->pdev.name); |
| 587 | 587 | ||
| 588 | od->pdev.dev.parent = &omap_device_parent; | 588 | od->pdev.dev.parent = &omap_device_parent; |
| 589 | od->pdev.dev.pwr_domain = &omap_device_power_domain; | 589 | od->pdev.dev.pm_domain = &omap_device_pm_domain; |
| 590 | return platform_device_register(&od->pdev); | 590 | return platform_device_register(&od->pdev); |
| 591 | } | 591 | } |
| 592 | 592 | ||
diff --git a/arch/sh/kernel/cpu/shmobile/pm_runtime.c b/arch/sh/kernel/cpu/shmobile/pm_runtime.c index 64c807c39208..bf280c812d2f 100644 --- a/arch/sh/kernel/cpu/shmobile/pm_runtime.c +++ b/arch/sh/kernel/cpu/shmobile/pm_runtime.c | |||
| @@ -256,7 +256,7 @@ out: | |||
| 256 | return ret; | 256 | return ret; |
| 257 | } | 257 | } |
| 258 | 258 | ||
| 259 | static struct dev_power_domain default_power_domain = { | 259 | static struct dev_pm_domain default_pm_domain = { |
| 260 | .ops = { | 260 | .ops = { |
| 261 | .runtime_suspend = default_platform_runtime_suspend, | 261 | .runtime_suspend = default_platform_runtime_suspend, |
| 262 | .runtime_resume = default_platform_runtime_resume, | 262 | .runtime_resume = default_platform_runtime_resume, |
| @@ -285,7 +285,7 @@ static int platform_bus_notify(struct notifier_block *nb, | |||
| 285 | hwblk_disable(hwblk_info, hwblk); | 285 | hwblk_disable(hwblk_info, hwblk); |
| 286 | /* make sure driver re-inits itself once */ | 286 | /* make sure driver re-inits itself once */ |
| 287 | __set_bit(PDEV_ARCHDATA_FLAG_INIT, &pdev->archdata.flags); | 287 | __set_bit(PDEV_ARCHDATA_FLAG_INIT, &pdev->archdata.flags); |
| 288 | dev->pwr_domain = &default_power_domain; | 288 | dev->pm_domain = &default_pm_domain; |
| 289 | break; | 289 | break; |
| 290 | /* TODO: add BUS_NOTIFY_BIND_DRIVER and increase idle count */ | 290 | /* TODO: add BUS_NOTIFY_BIND_DRIVER and increase idle count */ |
| 291 | case BUS_NOTIFY_BOUND_DRIVER: | 291 | case BUS_NOTIFY_BOUND_DRIVER: |
| @@ -299,7 +299,7 @@ static int platform_bus_notify(struct notifier_block *nb, | |||
| 299 | __set_bit(PDEV_ARCHDATA_FLAG_INIT, &pdev->archdata.flags); | 299 | __set_bit(PDEV_ARCHDATA_FLAG_INIT, &pdev->archdata.flags); |
| 300 | break; | 300 | break; |
| 301 | case BUS_NOTIFY_DEL_DEVICE: | 301 | case BUS_NOTIFY_DEL_DEVICE: |
| 302 | dev->pwr_domain = NULL; | 302 | dev->pm_domain = NULL; |
| 303 | break; | 303 | break; |
| 304 | } | 304 | } |
| 305 | return 0; | 305 | return 0; |
diff --git a/drivers/base/power/Makefile b/drivers/base/power/Makefile index 3647e114d0e7..2639ae79a372 100644 --- a/drivers/base/power/Makefile +++ b/drivers/base/power/Makefile | |||
| @@ -3,6 +3,7 @@ obj-$(CONFIG_PM_SLEEP) += main.o wakeup.o | |||
| 3 | obj-$(CONFIG_PM_RUNTIME) += runtime.o | 3 | obj-$(CONFIG_PM_RUNTIME) += runtime.o |
| 4 | obj-$(CONFIG_PM_TRACE_RTC) += trace.o | 4 | obj-$(CONFIG_PM_TRACE_RTC) += trace.o |
| 5 | obj-$(CONFIG_PM_OPP) += opp.o | 5 | obj-$(CONFIG_PM_OPP) += opp.o |
| 6 | obj-$(CONFIG_PM_GENERIC_DOMAINS) += domain.o | ||
| 6 | obj-$(CONFIG_HAVE_CLK) += clock_ops.o | 7 | obj-$(CONFIG_HAVE_CLK) += clock_ops.o |
| 7 | 8 | ||
| 8 | ccflags-$(CONFIG_DEBUG_DRIVER) := -DDEBUG \ No newline at end of file | 9 | ccflags-$(CONFIG_DEBUG_DRIVER) := -DDEBUG \ No newline at end of file |
diff --git a/drivers/base/power/clock_ops.c b/drivers/base/power/clock_ops.c index ad367c4139b1..a846b2f95cfb 100644 --- a/drivers/base/power/clock_ops.c +++ b/drivers/base/power/clock_ops.c | |||
| @@ -15,9 +15,9 @@ | |||
| 15 | #include <linux/slab.h> | 15 | #include <linux/slab.h> |
| 16 | #include <linux/err.h> | 16 | #include <linux/err.h> |
| 17 | 17 | ||
| 18 | #ifdef CONFIG_PM_RUNTIME | 18 | #ifdef CONFIG_PM |
| 19 | 19 | ||
| 20 | struct pm_runtime_clk_data { | 20 | struct pm_clk_data { |
| 21 | struct list_head clock_list; | 21 | struct list_head clock_list; |
| 22 | struct mutex lock; | 22 | struct mutex lock; |
| 23 | }; | 23 | }; |
| @@ -36,25 +36,25 @@ struct pm_clock_entry { | |||
| 36 | enum pce_status status; | 36 | enum pce_status status; |
| 37 | }; | 37 | }; |
| 38 | 38 | ||
| 39 | static struct pm_runtime_clk_data *__to_prd(struct device *dev) | 39 | static struct pm_clk_data *__to_pcd(struct device *dev) |
| 40 | { | 40 | { |
| 41 | return dev ? dev->power.subsys_data : NULL; | 41 | return dev ? dev->power.subsys_data : NULL; |
| 42 | } | 42 | } |
| 43 | 43 | ||
| 44 | /** | 44 | /** |
| 45 | * pm_runtime_clk_add - Start using a device clock for runtime PM. | 45 | * pm_clk_add - Start using a device clock for power management. |
| 46 | * @dev: Device whose clock is going to be used for runtime PM. | 46 | * @dev: Device whose clock is going to be used for power management. |
| 47 | * @con_id: Connection ID of the clock. | 47 | * @con_id: Connection ID of the clock. |
| 48 | * | 48 | * |
| 49 | * Add the clock represented by @con_id to the list of clocks used for | 49 | * Add the clock represented by @con_id to the list of clocks used for |
| 50 | * the runtime PM of @dev. | 50 | * the power management of @dev. |
| 51 | */ | 51 | */ |
| 52 | int pm_runtime_clk_add(struct device *dev, const char *con_id) | 52 | int pm_clk_add(struct device *dev, const char *con_id) |
| 53 | { | 53 | { |
| 54 | struct pm_runtime_clk_data *prd = __to_prd(dev); | 54 | struct pm_clk_data *pcd = __to_pcd(dev); |
| 55 | struct pm_clock_entry *ce; | 55 | struct pm_clock_entry *ce; |
| 56 | 56 | ||
| 57 | if (!prd) | 57 | if (!pcd) |
| 58 | return -EINVAL; | 58 | return -EINVAL; |
| 59 | 59 | ||
| 60 | ce = kzalloc(sizeof(*ce), GFP_KERNEL); | 60 | ce = kzalloc(sizeof(*ce), GFP_KERNEL); |
| @@ -73,20 +73,20 @@ int pm_runtime_clk_add(struct device *dev, const char *con_id) | |||
| 73 | } | 73 | } |
| 74 | } | 74 | } |
| 75 | 75 | ||
| 76 | mutex_lock(&prd->lock); | 76 | mutex_lock(&pcd->lock); |
| 77 | list_add_tail(&ce->node, &prd->clock_list); | 77 | list_add_tail(&ce->node, &pcd->clock_list); |
| 78 | mutex_unlock(&prd->lock); | 78 | mutex_unlock(&pcd->lock); |
| 79 | return 0; | 79 | return 0; |
| 80 | } | 80 | } |
| 81 | 81 | ||
| 82 | /** | 82 | /** |
| 83 | * __pm_runtime_clk_remove - Destroy runtime PM clock entry. | 83 | * __pm_clk_remove - Destroy PM clock entry. |
| 84 | * @ce: Runtime PM clock entry to destroy. | 84 | * @ce: PM clock entry to destroy. |
| 85 | * | 85 | * |
| 86 | * This routine must be called under the mutex protecting the runtime PM list | 86 | * This routine must be called under the mutex protecting the PM list of clocks |
| 87 | * of clocks corresponding the the @ce's device. | 87 | * corresponding the the @ce's device. |
| 88 | */ | 88 | */ |
| 89 | static void __pm_runtime_clk_remove(struct pm_clock_entry *ce) | 89 | static void __pm_clk_remove(struct pm_clock_entry *ce) |
| 90 | { | 90 | { |
| 91 | if (!ce) | 91 | if (!ce) |
| 92 | return; | 92 | return; |
| @@ -108,95 +108,99 @@ static void __pm_runtime_clk_remove(struct pm_clock_entry *ce) | |||
| 108 | } | 108 | } |
| 109 | 109 | ||
| 110 | /** | 110 | /** |
| 111 | * pm_runtime_clk_remove - Stop using a device clock for runtime PM. | 111 | * pm_clk_remove - Stop using a device clock for power management. |
| 112 | * @dev: Device whose clock should not be used for runtime PM any more. | 112 | * @dev: Device whose clock should not be used for PM any more. |
| 113 | * @con_id: Connection ID of the clock. | 113 | * @con_id: Connection ID of the clock. |
| 114 | * | 114 | * |
| 115 | * Remove the clock represented by @con_id from the list of clocks used for | 115 | * Remove the clock represented by @con_id from the list of clocks used for |
| 116 | * the runtime PM of @dev. | 116 | * the power management of @dev. |
| 117 | */ | 117 | */ |
| 118 | void pm_runtime_clk_remove(struct device *dev, const char *con_id) | 118 | void pm_clk_remove(struct device *dev, const char *con_id) |
| 119 | { | 119 | { |
| 120 | struct pm_runtime_clk_data *prd = __to_prd(dev); | 120 | struct pm_clk_data *pcd = __to_pcd(dev); |
| 121 | struct pm_clock_entry *ce; | 121 | struct pm_clock_entry *ce; |
| 122 | 122 | ||
| 123 | if (!prd) | 123 | if (!pcd) |
| 124 | return; | 124 | return; |
| 125 | 125 | ||
| 126 | mutex_lock(&prd->lock); | 126 | mutex_lock(&pcd->lock); |
| 127 | 127 | ||
| 128 | list_for_each_entry(ce, &prd->clock_list, node) { | 128 | list_for_each_entry(ce, &pcd->clock_list, node) { |
| 129 | if (!con_id && !ce->con_id) { | 129 | if (!con_id && !ce->con_id) { |
| 130 | __pm_runtime_clk_remove(ce); | 130 | __pm_clk_remove(ce); |
| 131 | break; | 131 | break; |
| 132 | } else if (!con_id || !ce->con_id) { | 132 | } else if (!con_id || !ce->con_id) { |
| 133 | continue; | 133 | continue; |
| 134 | } else if (!strcmp(con_id, ce->con_id)) { | 134 | } else if (!strcmp(con_id, ce->con_id)) { |
| 135 | __pm_runtime_clk_remove(ce); | 135 | __pm_clk_remove(ce); |
| 136 | break; | 136 | break; |
| 137 | } | 137 | } |
| 138 | } | 138 | } |
| 139 | 139 | ||
| 140 | mutex_unlock(&prd->lock); | 140 | mutex_unlock(&pcd->lock); |
| 141 | } | 141 | } |
| 142 | 142 | ||
| 143 | /** | 143 | /** |
| 144 | * pm_runtime_clk_init - Initialize a device's list of runtime PM clocks. | 144 | * pm_clk_init - Initialize a device's list of power management clocks. |
| 145 | * @dev: Device to initialize the list of runtime PM clocks for. | 145 | * @dev: Device to initialize the list of PM clocks for. |
| 146 | * | 146 | * |
| 147 | * Allocate a struct pm_runtime_clk_data object, initialize its lock member and | 147 | * Allocate a struct pm_clk_data object, initialize its lock member and |
| 148 | * make the @dev's power.subsys_data field point to it. | 148 | * make the @dev's power.subsys_data field point to it. |
| 149 | */ | 149 | */ |
| 150 | int pm_runtime_clk_init(struct device *dev) | 150 | int pm_clk_init(struct device *dev) |
| 151 | { | 151 | { |
| 152 | struct pm_runtime_clk_data *prd; | 152 | struct pm_clk_data *pcd; |
| 153 | 153 | ||
| 154 | prd = kzalloc(sizeof(*prd), GFP_KERNEL); | 154 | pcd = kzalloc(sizeof(*pcd), GFP_KERNEL); |
| 155 | if (!prd) { | 155 | if (!pcd) { |
| 156 | dev_err(dev, "Not enough memory fo runtime PM data.\n"); | 156 | dev_err(dev, "Not enough memory for PM clock data.\n"); |
| 157 | return -ENOMEM; | 157 | return -ENOMEM; |
| 158 | } | 158 | } |
| 159 | 159 | ||
| 160 | INIT_LIST_HEAD(&prd->clock_list); | 160 | INIT_LIST_HEAD(&pcd->clock_list); |
| 161 | mutex_init(&prd->lock); | 161 | mutex_init(&pcd->lock); |
| 162 | dev->power.subsys_data = prd; | 162 | dev->power.subsys_data = pcd; |
| 163 | return 0; | 163 | return 0; |
| 164 | } | 164 | } |
| 165 | 165 | ||
| 166 | /** | 166 | /** |
| 167 | * pm_runtime_clk_destroy - Destroy a device's list of runtime PM clocks. | 167 | * pm_clk_destroy - Destroy a device's list of power management clocks. |
| 168 | * @dev: Device to destroy the list of runtime PM clocks for. | 168 | * @dev: Device to destroy the list of PM clocks for. |
| 169 | * | 169 | * |
| 170 | * Clear the @dev's power.subsys_data field, remove the list of clock entries | 170 | * Clear the @dev's power.subsys_data field, remove the list of clock entries |
| 171 | * from the struct pm_runtime_clk_data object pointed to by it before and free | 171 | * from the struct pm_clk_data object pointed to by it before and free |
| 172 | * that object. | 172 | * that object. |
| 173 | */ | 173 | */ |
| 174 | void pm_runtime_clk_destroy(struct device *dev) | 174 | void pm_clk_destroy(struct device *dev) |
| 175 | { | 175 | { |
| 176 | struct pm_runtime_clk_data *prd = __to_prd(dev); | 176 | struct pm_clk_data *pcd = __to_pcd(dev); |
| 177 | struct pm_clock_entry *ce, *c; | 177 | struct pm_clock_entry *ce, *c; |
| 178 | 178 | ||
| 179 | if (!prd) | 179 | if (!pcd) |
| 180 | return; | 180 | return; |
| 181 | 181 | ||
| 182 | dev->power.subsys_data = NULL; | 182 | dev->power.subsys_data = NULL; |
| 183 | 183 | ||
| 184 | mutex_lock(&prd->lock); | 184 | mutex_lock(&pcd->lock); |
| 185 | 185 | ||
| 186 | list_for_each_entry_safe_reverse(ce, c, &prd->clock_list, node) | 186 | list_for_each_entry_safe_reverse(ce, c, &pcd->clock_list, node) |
| 187 | __pm_runtime_clk_remove(ce); | 187 | __pm_clk_remove(ce); |
| 188 | 188 | ||
| 189 | mutex_unlock(&prd->lock); | 189 | mutex_unlock(&pcd->lock); |
| 190 | 190 | ||
| 191 | kfree(prd); | 191 | kfree(pcd); |
| 192 | } | 192 | } |
| 193 | 193 | ||
| 194 | #endif /* CONFIG_PM */ | ||
| 195 | |||
| 196 | #ifdef CONFIG_PM_RUNTIME | ||
| 197 | |||
| 194 | /** | 198 | /** |
| 195 | * pm_runtime_clk_acquire - Acquire a device clock. | 199 | * pm_clk_acquire - Acquire a device clock. |
| 196 | * @dev: Device whose clock is to be acquired. | 200 | * @dev: Device whose clock is to be acquired. |
| 197 | * @con_id: Connection ID of the clock. | 201 | * @con_id: Connection ID of the clock. |
| 198 | */ | 202 | */ |
| 199 | static void pm_runtime_clk_acquire(struct device *dev, | 203 | static void pm_clk_acquire(struct device *dev, |
| 200 | struct pm_clock_entry *ce) | 204 | struct pm_clock_entry *ce) |
| 201 | { | 205 | { |
| 202 | ce->clk = clk_get(dev, ce->con_id); | 206 | ce->clk = clk_get(dev, ce->con_id); |
| @@ -209,24 +213,24 @@ static void pm_runtime_clk_acquire(struct device *dev, | |||
| 209 | } | 213 | } |
| 210 | 214 | ||
| 211 | /** | 215 | /** |
| 212 | * pm_runtime_clk_suspend - Disable clocks in a device's runtime PM clock list. | 216 | * pm_clk_suspend - Disable clocks in a device's PM clock list. |
| 213 | * @dev: Device to disable the clocks for. | 217 | * @dev: Device to disable the clocks for. |
| 214 | */ | 218 | */ |
| 215 | int pm_runtime_clk_suspend(struct device *dev) | 219 | int pm_clk_suspend(struct device *dev) |
| 216 | { | 220 | { |
| 217 | struct pm_runtime_clk_data *prd = __to_prd(dev); | 221 | struct pm_clk_data *pcd = __to_pcd(dev); |
| 218 | struct pm_clock_entry *ce; | 222 | struct pm_clock_entry *ce; |
| 219 | 223 | ||
| 220 | dev_dbg(dev, "%s()\n", __func__); | 224 | dev_dbg(dev, "%s()\n", __func__); |
| 221 | 225 | ||
| 222 | if (!prd) | 226 | if (!pcd) |
| 223 | return 0; | 227 | return 0; |
| 224 | 228 | ||
| 225 | mutex_lock(&prd->lock); | 229 | mutex_lock(&pcd->lock); |
| 226 | 230 | ||
| 227 | list_for_each_entry_reverse(ce, &prd->clock_list, node) { | 231 | list_for_each_entry_reverse(ce, &pcd->clock_list, node) { |
| 228 | if (ce->status == PCE_STATUS_NONE) | 232 | if (ce->status == PCE_STATUS_NONE) |
| 229 | pm_runtime_clk_acquire(dev, ce); | 233 | pm_clk_acquire(dev, ce); |
| 230 | 234 | ||
| 231 | if (ce->status < PCE_STATUS_ERROR) { | 235 | if (ce->status < PCE_STATUS_ERROR) { |
| 232 | clk_disable(ce->clk); | 236 | clk_disable(ce->clk); |
| @@ -234,30 +238,30 @@ int pm_runtime_clk_suspend(struct device *dev) | |||
| 234 | } | 238 | } |
| 235 | } | 239 | } |
| 236 | 240 | ||
| 237 | mutex_unlock(&prd->lock); | 241 | mutex_unlock(&pcd->lock); |
| 238 | 242 | ||
| 239 | return 0; | 243 | return 0; |
| 240 | } | 244 | } |
| 241 | 245 | ||
| 242 | /** | 246 | /** |
| 243 | * pm_runtime_clk_resume - Enable clocks in a device's runtime PM clock list. | 247 | * pm_clk_resume - Enable clocks in a device's PM clock list. |
| 244 | * @dev: Device to enable the clocks for. | 248 | * @dev: Device to enable the clocks for. |
| 245 | */ | 249 | */ |
| 246 | int pm_runtime_clk_resume(struct device *dev) | 250 | int pm_clk_resume(struct device *dev) |
| 247 | { | 251 | { |
| 248 | struct pm_runtime_clk_data *prd = __to_prd(dev); | 252 | struct pm_clk_data *pcd = __to_pcd(dev); |
| 249 | struct pm_clock_entry *ce; | 253 | struct pm_clock_entry *ce; |
| 250 | 254 | ||
| 251 | dev_dbg(dev, "%s()\n", __func__); | 255 | dev_dbg(dev, "%s()\n", __func__); |
| 252 | 256 | ||
| 253 | if (!prd) | 257 | if (!pcd) |
| 254 | return 0; | 258 | return 0; |
| 255 | 259 | ||
| 256 | mutex_lock(&prd->lock); | 260 | mutex_lock(&pcd->lock); |
| 257 | 261 | ||
| 258 | list_for_each_entry(ce, &prd->clock_list, node) { | 262 | list_for_each_entry(ce, &pcd->clock_list, node) { |
| 259 | if (ce->status == PCE_STATUS_NONE) | 263 | if (ce->status == PCE_STATUS_NONE) |
| 260 | pm_runtime_clk_acquire(dev, ce); | 264 | pm_clk_acquire(dev, ce); |
| 261 | 265 | ||
| 262 | if (ce->status < PCE_STATUS_ERROR) { | 266 | if (ce->status < PCE_STATUS_ERROR) { |
| 263 | clk_enable(ce->clk); | 267 | clk_enable(ce->clk); |
| @@ -265,28 +269,28 @@ int pm_runtime_clk_resume(struct device *dev) | |||
| 265 | } | 269 | } |
| 266 | } | 270 | } |
| 267 | 271 | ||
| 268 | mutex_unlock(&prd->lock); | 272 | mutex_unlock(&pcd->lock); |
| 269 | 273 | ||
| 270 | return 0; | 274 | return 0; |
| 271 | } | 275 | } |
| 272 | 276 | ||
| 273 | /** | 277 | /** |
| 274 | * pm_runtime_clk_notify - Notify routine for device addition and removal. | 278 | * pm_clk_notify - Notify routine for device addition and removal. |
| 275 | * @nb: Notifier block object this function is a member of. | 279 | * @nb: Notifier block object this function is a member of. |
| 276 | * @action: Operation being carried out by the caller. | 280 | * @action: Operation being carried out by the caller. |
| 277 | * @data: Device the routine is being run for. | 281 | * @data: Device the routine is being run for. |
| 278 | * | 282 | * |
| 279 | * For this function to work, @nb must be a member of an object of type | 283 | * For this function to work, @nb must be a member of an object of type |
| 280 | * struct pm_clk_notifier_block containing all of the requisite data. | 284 | * struct pm_clk_notifier_block containing all of the requisite data. |
| 281 | * Specifically, the pwr_domain member of that object is copied to the device's | 285 | * Specifically, the pm_domain member of that object is copied to the device's |
| 282 | * pwr_domain field and its con_ids member is used to populate the device's list | 286 | * pm_domain field and its con_ids member is used to populate the device's list |
| 283 | * of runtime PM clocks, depending on @action. | 287 | * of PM clocks, depending on @action. |
| 284 | * | 288 | * |
| 285 | * If the device's pwr_domain field is already populated with a value different | 289 | * If the device's pm_domain field is already populated with a value different |
| 286 | * from the one stored in the struct pm_clk_notifier_block object, the function | 290 | * from the one stored in the struct pm_clk_notifier_block object, the function |
| 287 | * does nothing. | 291 | * does nothing. |
| 288 | */ | 292 | */ |
| 289 | static int pm_runtime_clk_notify(struct notifier_block *nb, | 293 | static int pm_clk_notify(struct notifier_block *nb, |
| 290 | unsigned long action, void *data) | 294 | unsigned long action, void *data) |
| 291 | { | 295 | { |
| 292 | struct pm_clk_notifier_block *clknb; | 296 | struct pm_clk_notifier_block *clknb; |
| @@ -300,28 +304,28 @@ static int pm_runtime_clk_notify(struct notifier_block *nb, | |||
| 300 | 304 | ||
| 301 | switch (action) { | 305 | switch (action) { |
| 302 | case BUS_NOTIFY_ADD_DEVICE: | 306 | case BUS_NOTIFY_ADD_DEVICE: |
| 303 | if (dev->pwr_domain) | 307 | if (dev->pm_domain) |
| 304 | break; | 308 | break; |
| 305 | 309 | ||
| 306 | error = pm_runtime_clk_init(dev); | 310 | error = pm_clk_init(dev); |
| 307 | if (error) | 311 | if (error) |
| 308 | break; | 312 | break; |
| 309 | 313 | ||
| 310 | dev->pwr_domain = clknb->pwr_domain; | 314 | dev->pm_domain = clknb->pm_domain; |
| 311 | if (clknb->con_ids[0]) { | 315 | if (clknb->con_ids[0]) { |
| 312 | for (con_id = clknb->con_ids; *con_id; con_id++) | 316 | for (con_id = clknb->con_ids; *con_id; con_id++) |
| 313 | pm_runtime_clk_add(dev, *con_id); | 317 | pm_clk_add(dev, *con_id); |
| 314 | } else { | 318 | } else { |
| 315 | pm_runtime_clk_add(dev, NULL); | 319 | pm_clk_add(dev, NULL); |
| 316 | } | 320 | } |
| 317 | 321 | ||
| 318 | break; | 322 | break; |
| 319 | case BUS_NOTIFY_DEL_DEVICE: | 323 | case BUS_NOTIFY_DEL_DEVICE: |
| 320 | if (dev->pwr_domain != clknb->pwr_domain) | 324 | if (dev->pm_domain != clknb->pm_domain) |
| 321 | break; | 325 | break; |
| 322 | 326 | ||
| 323 | dev->pwr_domain = NULL; | 327 | dev->pm_domain = NULL; |
| 324 | pm_runtime_clk_destroy(dev); | 328 | pm_clk_destroy(dev); |
| 325 | break; | 329 | break; |
| 326 | } | 330 | } |
| 327 | 331 | ||
| @@ -330,6 +334,60 @@ static int pm_runtime_clk_notify(struct notifier_block *nb, | |||
| 330 | 334 | ||
| 331 | #else /* !CONFIG_PM_RUNTIME */ | 335 | #else /* !CONFIG_PM_RUNTIME */ |
| 332 | 336 | ||
| 337 | #ifdef CONFIG_PM | ||
| 338 | |||
| 339 | /** | ||
| 340 | * pm_clk_suspend - Disable clocks in a device's PM clock list. | ||
| 341 | * @dev: Device to disable the clocks for. | ||
| 342 | */ | ||
| 343 | int pm_clk_suspend(struct device *dev) | ||
| 344 | { | ||
| 345 | struct pm_clk_data *pcd = __to_pcd(dev); | ||
| 346 | struct pm_clock_entry *ce; | ||
| 347 | |||
| 348 | dev_dbg(dev, "%s()\n", __func__); | ||
| 349 | |||
| 350 | /* If there is no driver, the clocks are already disabled. */ | ||
| 351 | if (!pcd || !dev->driver) | ||
| 352 | return 0; | ||
| 353 | |||
| 354 | mutex_lock(&pcd->lock); | ||
| 355 | |||
| 356 | list_for_each_entry_reverse(ce, &pcd->clock_list, node) | ||
| 357 | clk_disable(ce->clk); | ||
| 358 | |||
| 359 | mutex_unlock(&pcd->lock); | ||
| 360 | |||
| 361 | return 0; | ||
| 362 | } | ||
| 363 | |||
| 364 | /** | ||
| 365 | * pm_clk_resume - Enable clocks in a device's PM clock list. | ||
| 366 | * @dev: Device to enable the clocks for. | ||
| 367 | */ | ||
| 368 | int pm_clk_resume(struct device *dev) | ||
| 369 | { | ||
| 370 | struct pm_clk_data *pcd = __to_pcd(dev); | ||
| 371 | struct pm_clock_entry *ce; | ||
| 372 | |||
| 373 | dev_dbg(dev, "%s()\n", __func__); | ||
| 374 | |||
| 375 | /* If there is no driver, the clocks should remain disabled. */ | ||
| 376 | if (!pcd || !dev->driver) | ||
| 377 | return 0; | ||
| 378 | |||
| 379 | mutex_lock(&pcd->lock); | ||
| 380 | |||
| 381 | list_for_each_entry(ce, &pcd->clock_list, node) | ||
| 382 | clk_enable(ce->clk); | ||
| 383 | |||
| 384 | mutex_unlock(&pcd->lock); | ||
| 385 | |||
| 386 | return 0; | ||
| 387 | } | ||
| 388 | |||
| 389 | #endif /* CONFIG_PM */ | ||
| 390 | |||
| 333 | /** | 391 | /** |
| 334 | * enable_clock - Enable a device clock. | 392 | * enable_clock - Enable a device clock. |
| 335 | * @dev: Device whose clock is to be enabled. | 393 | * @dev: Device whose clock is to be enabled. |
| @@ -365,7 +423,7 @@ static void disable_clock(struct device *dev, const char *con_id) | |||
| 365 | } | 423 | } |
| 366 | 424 | ||
| 367 | /** | 425 | /** |
| 368 | * pm_runtime_clk_notify - Notify routine for device addition and removal. | 426 | * pm_clk_notify - Notify routine for device addition and removal. |
| 369 | * @nb: Notifier block object this function is a member of. | 427 | * @nb: Notifier block object this function is a member of. |
| 370 | * @action: Operation being carried out by the caller. | 428 | * @action: Operation being carried out by the caller. |
| 371 | * @data: Device the routine is being run for. | 429 | * @data: Device the routine is being run for. |
| @@ -375,7 +433,7 @@ static void disable_clock(struct device *dev, const char *con_id) | |||
| 375 | * Specifically, the con_ids member of that object is used to enable or disable | 433 | * Specifically, the con_ids member of that object is used to enable or disable |
| 376 | * the device's clocks, depending on @action. | 434 | * the device's clocks, depending on @action. |
| 377 | */ | 435 | */ |
| 378 | static int pm_runtime_clk_notify(struct notifier_block *nb, | 436 | static int pm_clk_notify(struct notifier_block *nb, |
| 379 | unsigned long action, void *data) | 437 | unsigned long action, void *data) |
| 380 | { | 438 | { |
| 381 | struct pm_clk_notifier_block *clknb; | 439 | struct pm_clk_notifier_block *clknb; |
| @@ -411,21 +469,21 @@ static int pm_runtime_clk_notify(struct notifier_block *nb, | |||
| 411 | #endif /* !CONFIG_PM_RUNTIME */ | 469 | #endif /* !CONFIG_PM_RUNTIME */ |
| 412 | 470 | ||
| 413 | /** | 471 | /** |
| 414 | * pm_runtime_clk_add_notifier - Add bus type notifier for runtime PM clocks. | 472 | * pm_clk_add_notifier - Add bus type notifier for power management clocks. |
| 415 | * @bus: Bus type to add the notifier to. | 473 | * @bus: Bus type to add the notifier to. |
| 416 | * @clknb: Notifier to be added to the given bus type. | 474 | * @clknb: Notifier to be added to the given bus type. |
| 417 | * | 475 | * |
| 418 | * The nb member of @clknb is not expected to be initialized and its | 476 | * The nb member of @clknb is not expected to be initialized and its |
| 419 | * notifier_call member will be replaced with pm_runtime_clk_notify(). However, | 477 | * notifier_call member will be replaced with pm_clk_notify(). However, |
| 420 | * the remaining members of @clknb should be populated prior to calling this | 478 | * the remaining members of @clknb should be populated prior to calling this |
| 421 | * routine. | 479 | * routine. |
| 422 | */ | 480 | */ |
| 423 | void pm_runtime_clk_add_notifier(struct bus_type *bus, | 481 | void pm_clk_add_notifier(struct bus_type *bus, |
| 424 | struct pm_clk_notifier_block *clknb) | 482 | struct pm_clk_notifier_block *clknb) |
| 425 | { | 483 | { |
| 426 | if (!bus || !clknb) | 484 | if (!bus || !clknb) |
| 427 | return; | 485 | return; |
| 428 | 486 | ||
| 429 | clknb->nb.notifier_call = pm_runtime_clk_notify; | 487 | clknb->nb.notifier_call = pm_clk_notify; |
| 430 | bus_register_notifier(bus, &clknb->nb); | 488 | bus_register_notifier(bus, &clknb->nb); |
| 431 | } | 489 | } |
diff --git a/drivers/base/power/domain.c b/drivers/base/power/domain.c new file mode 100644 index 000000000000..be8714aa9dd6 --- /dev/null +++ b/drivers/base/power/domain.c | |||
| @@ -0,0 +1,1273 @@ | |||
| 1 | /* | ||
| 2 | * drivers/base/power/domain.c - Common code related to device power domains. | ||
| 3 | * | ||
| 4 | * Copyright (C) 2011 Rafael J. Wysocki <rjw@sisk.pl>, Renesas Electronics Corp. | ||
| 5 | * | ||
| 6 | * This file is released under the GPLv2. | ||
| 7 | */ | ||
| 8 | |||
| 9 | #include <linux/init.h> | ||
| 10 | #include <linux/kernel.h> | ||
| 11 | #include <linux/io.h> | ||
| 12 | #include <linux/pm_runtime.h> | ||
| 13 | #include <linux/pm_domain.h> | ||
| 14 | #include <linux/slab.h> | ||
| 15 | #include <linux/err.h> | ||
| 16 | #include <linux/sched.h> | ||
| 17 | #include <linux/suspend.h> | ||
| 18 | |||
| 19 | static LIST_HEAD(gpd_list); | ||
| 20 | static DEFINE_MUTEX(gpd_list_lock); | ||
| 21 | |||
| 22 | #ifdef CONFIG_PM | ||
| 23 | |||
| 24 | static struct generic_pm_domain *dev_to_genpd(struct device *dev) | ||
| 25 | { | ||
| 26 | if (IS_ERR_OR_NULL(dev->pm_domain)) | ||
| 27 | return ERR_PTR(-EINVAL); | ||
| 28 | |||
| 29 | return pd_to_genpd(dev->pm_domain); | ||
| 30 | } | ||
| 31 | |||
| 32 | static void genpd_sd_counter_dec(struct generic_pm_domain *genpd) | ||
| 33 | { | ||
| 34 | if (!WARN_ON(genpd->sd_count == 0)) | ||
| 35 | genpd->sd_count--; | ||
| 36 | } | ||
| 37 | |||
| 38 | static void genpd_acquire_lock(struct generic_pm_domain *genpd) | ||
| 39 | { | ||
| 40 | DEFINE_WAIT(wait); | ||
| 41 | |||
| 42 | mutex_lock(&genpd->lock); | ||
| 43 | /* | ||
| 44 | * Wait for the domain to transition into either the active, | ||
| 45 | * or the power off state. | ||
| 46 | */ | ||
| 47 | for (;;) { | ||
| 48 | prepare_to_wait(&genpd->status_wait_queue, &wait, | ||
| 49 | TASK_UNINTERRUPTIBLE); | ||
| 50 | if (genpd->status == GPD_STATE_ACTIVE | ||
| 51 | || genpd->status == GPD_STATE_POWER_OFF) | ||
| 52 | break; | ||
| 53 | mutex_unlock(&genpd->lock); | ||
| 54 | |||
| 55 | schedule(); | ||
| 56 | |||
| 57 | mutex_lock(&genpd->lock); | ||
| 58 | } | ||
| 59 | finish_wait(&genpd->status_wait_queue, &wait); | ||
| 60 | } | ||
| 61 | |||
| 62 | static void genpd_release_lock(struct generic_pm_domain *genpd) | ||
| 63 | { | ||
| 64 | mutex_unlock(&genpd->lock); | ||
| 65 | } | ||
| 66 | |||
| 67 | static void genpd_set_active(struct generic_pm_domain *genpd) | ||
| 68 | { | ||
| 69 | if (genpd->resume_count == 0) | ||
| 70 | genpd->status = GPD_STATE_ACTIVE; | ||
| 71 | } | ||
| 72 | |||
| 73 | /** | ||
| 74 | * pm_genpd_poweron - Restore power to a given PM domain and its parents. | ||
| 75 | * @genpd: PM domain to power up. | ||
| 76 | * | ||
| 77 | * Restore power to @genpd and all of its parents so that it is possible to | ||
| 78 | * resume a device belonging to it. | ||
| 79 | */ | ||
| 80 | int pm_genpd_poweron(struct generic_pm_domain *genpd) | ||
| 81 | { | ||
| 82 | struct generic_pm_domain *parent = genpd->parent; | ||
| 83 | DEFINE_WAIT(wait); | ||
| 84 | int ret = 0; | ||
| 85 | |||
| 86 | start: | ||
| 87 | if (parent) { | ||
| 88 | genpd_acquire_lock(parent); | ||
| 89 | mutex_lock_nested(&genpd->lock, SINGLE_DEPTH_NESTING); | ||
| 90 | } else { | ||
| 91 | mutex_lock(&genpd->lock); | ||
| 92 | } | ||
| 93 | |||
| 94 | if (genpd->status == GPD_STATE_ACTIVE | ||
| 95 | || (genpd->prepared_count > 0 && genpd->suspend_power_off)) | ||
| 96 | goto out; | ||
| 97 | |||
| 98 | if (genpd->status != GPD_STATE_POWER_OFF) { | ||
| 99 | genpd_set_active(genpd); | ||
| 100 | goto out; | ||
| 101 | } | ||
| 102 | |||
| 103 | if (parent && parent->status != GPD_STATE_ACTIVE) { | ||
| 104 | mutex_unlock(&genpd->lock); | ||
| 105 | genpd_release_lock(parent); | ||
| 106 | |||
| 107 | ret = pm_genpd_poweron(parent); | ||
| 108 | if (ret) | ||
| 109 | return ret; | ||
| 110 | |||
| 111 | goto start; | ||
| 112 | } | ||
| 113 | |||
| 114 | if (genpd->power_on) { | ||
| 115 | int ret = genpd->power_on(genpd); | ||
| 116 | if (ret) | ||
| 117 | goto out; | ||
| 118 | } | ||
| 119 | |||
| 120 | genpd_set_active(genpd); | ||
| 121 | if (parent) | ||
| 122 | parent->sd_count++; | ||
| 123 | |||
| 124 | out: | ||
| 125 | mutex_unlock(&genpd->lock); | ||
| 126 | if (parent) | ||
| 127 | genpd_release_lock(parent); | ||
| 128 | |||
| 129 | return ret; | ||
| 130 | } | ||
| 131 | |||
| 132 | #endif /* CONFIG_PM */ | ||
| 133 | |||
| 134 | #ifdef CONFIG_PM_RUNTIME | ||
| 135 | |||
| 136 | /** | ||
| 137 | * __pm_genpd_save_device - Save the pre-suspend state of a device. | ||
| 138 | * @dle: Device list entry of the device to save the state of. | ||
| 139 | * @genpd: PM domain the device belongs to. | ||
| 140 | */ | ||
| 141 | static int __pm_genpd_save_device(struct dev_list_entry *dle, | ||
| 142 | struct generic_pm_domain *genpd) | ||
| 143 | __releases(&genpd->lock) __acquires(&genpd->lock) | ||
| 144 | { | ||
| 145 | struct device *dev = dle->dev; | ||
| 146 | struct device_driver *drv = dev->driver; | ||
| 147 | int ret = 0; | ||
| 148 | |||
| 149 | if (dle->need_restore) | ||
| 150 | return 0; | ||
| 151 | |||
| 152 | mutex_unlock(&genpd->lock); | ||
| 153 | |||
| 154 | if (drv && drv->pm && drv->pm->runtime_suspend) { | ||
| 155 | if (genpd->start_device) | ||
| 156 | genpd->start_device(dev); | ||
| 157 | |||
| 158 | ret = drv->pm->runtime_suspend(dev); | ||
| 159 | |||
| 160 | if (genpd->stop_device) | ||
| 161 | genpd->stop_device(dev); | ||
| 162 | } | ||
| 163 | |||
| 164 | mutex_lock(&genpd->lock); | ||
| 165 | |||
| 166 | if (!ret) | ||
| 167 | dle->need_restore = true; | ||
| 168 | |||
| 169 | return ret; | ||
| 170 | } | ||
| 171 | |||
| 172 | /** | ||
| 173 | * __pm_genpd_restore_device - Restore the pre-suspend state of a device. | ||
| 174 | * @dle: Device list entry of the device to restore the state of. | ||
| 175 | * @genpd: PM domain the device belongs to. | ||
| 176 | */ | ||
| 177 | static void __pm_genpd_restore_device(struct dev_list_entry *dle, | ||
| 178 | struct generic_pm_domain *genpd) | ||
| 179 | __releases(&genpd->lock) __acquires(&genpd->lock) | ||
| 180 | { | ||
| 181 | struct device *dev = dle->dev; | ||
| 182 | struct device_driver *drv = dev->driver; | ||
| 183 | |||
| 184 | if (!dle->need_restore) | ||
| 185 | return; | ||
| 186 | |||
| 187 | mutex_unlock(&genpd->lock); | ||
| 188 | |||
| 189 | if (drv && drv->pm && drv->pm->runtime_resume) { | ||
| 190 | if (genpd->start_device) | ||
| 191 | genpd->start_device(dev); | ||
| 192 | |||
| 193 | drv->pm->runtime_resume(dev); | ||
| 194 | |||
| 195 | if (genpd->stop_device) | ||
| 196 | genpd->stop_device(dev); | ||
| 197 | } | ||
| 198 | |||
| 199 | mutex_lock(&genpd->lock); | ||
| 200 | |||
| 201 | dle->need_restore = false; | ||
| 202 | } | ||
| 203 | |||
| 204 | /** | ||
| 205 | * genpd_abort_poweroff - Check if a PM domain power off should be aborted. | ||
| 206 | * @genpd: PM domain to check. | ||
| 207 | * | ||
| 208 | * Return true if a PM domain's status changed to GPD_STATE_ACTIVE during | ||
| 209 | * a "power off" operation, which means that a "power on" has occured in the | ||
| 210 | * meantime, or if its resume_count field is different from zero, which means | ||
| 211 | * that one of its devices has been resumed in the meantime. | ||
| 212 | */ | ||
| 213 | static bool genpd_abort_poweroff(struct generic_pm_domain *genpd) | ||
| 214 | { | ||
| 215 | return genpd->status == GPD_STATE_ACTIVE || genpd->resume_count > 0; | ||
| 216 | } | ||
| 217 | |||
| 218 | /** | ||
| 219 | * genpd_queue_power_off_work - Queue up the execution of pm_genpd_poweroff(). | ||
| 220 | * @genpd: PM domait to power off. | ||
| 221 | * | ||
| 222 | * Queue up the execution of pm_genpd_poweroff() unless it's already been done | ||
| 223 | * before. | ||
| 224 | */ | ||
| 225 | void genpd_queue_power_off_work(struct generic_pm_domain *genpd) | ||
| 226 | { | ||
| 227 | if (!work_pending(&genpd->power_off_work)) | ||
| 228 | queue_work(pm_wq, &genpd->power_off_work); | ||
| 229 | } | ||
| 230 | |||
| 231 | /** | ||
| 232 | * pm_genpd_poweroff - Remove power from a given PM domain. | ||
| 233 | * @genpd: PM domain to power down. | ||
| 234 | * | ||
| 235 | * If all of the @genpd's devices have been suspended and all of its subdomains | ||
| 236 | * have been powered down, run the runtime suspend callbacks provided by all of | ||
| 237 | * the @genpd's devices' drivers and remove power from @genpd. | ||
| 238 | */ | ||
| 239 | static int pm_genpd_poweroff(struct generic_pm_domain *genpd) | ||
| 240 | __releases(&genpd->lock) __acquires(&genpd->lock) | ||
| 241 | { | ||
| 242 | struct generic_pm_domain *parent; | ||
| 243 | struct dev_list_entry *dle; | ||
| 244 | unsigned int not_suspended; | ||
| 245 | int ret = 0; | ||
| 246 | |||
| 247 | start: | ||
| 248 | /* | ||
| 249 | * Do not try to power off the domain in the following situations: | ||
| 250 | * (1) The domain is already in the "power off" state. | ||
| 251 | * (2) System suspend is in progress. | ||
| 252 | * (3) One of the domain's devices is being resumed right now. | ||
| 253 | */ | ||
| 254 | if (genpd->status == GPD_STATE_POWER_OFF || genpd->prepared_count > 0 | ||
| 255 | || genpd->resume_count > 0) | ||
| 256 | return 0; | ||
| 257 | |||
| 258 | if (genpd->sd_count > 0) | ||
| 259 | return -EBUSY; | ||
| 260 | |||
| 261 | not_suspended = 0; | ||
| 262 | list_for_each_entry(dle, &genpd->dev_list, node) | ||
| 263 | if (dle->dev->driver && !pm_runtime_suspended(dle->dev)) | ||
| 264 | not_suspended++; | ||
| 265 | |||
| 266 | if (not_suspended > genpd->in_progress) | ||
| 267 | return -EBUSY; | ||
| 268 | |||
| 269 | if (genpd->poweroff_task) { | ||
| 270 | /* | ||
| 271 | * Another instance of pm_genpd_poweroff() is executing | ||
| 272 | * callbacks, so tell it to start over and return. | ||
| 273 | */ | ||
| 274 | genpd->status = GPD_STATE_REPEAT; | ||
| 275 | return 0; | ||
| 276 | } | ||
| 277 | |||
| 278 | if (genpd->gov && genpd->gov->power_down_ok) { | ||
| 279 | if (!genpd->gov->power_down_ok(&genpd->domain)) | ||
| 280 | return -EAGAIN; | ||
| 281 | } | ||
| 282 | |||
| 283 | genpd->status = GPD_STATE_BUSY; | ||
| 284 | genpd->poweroff_task = current; | ||
| 285 | |||
| 286 | list_for_each_entry_reverse(dle, &genpd->dev_list, node) { | ||
| 287 | ret = __pm_genpd_save_device(dle, genpd); | ||
| 288 | if (ret) { | ||
| 289 | genpd_set_active(genpd); | ||
| 290 | goto out; | ||
| 291 | } | ||
| 292 | |||
| 293 | if (genpd_abort_poweroff(genpd)) | ||
| 294 | goto out; | ||
| 295 | |||
| 296 | if (genpd->status == GPD_STATE_REPEAT) { | ||
| 297 | genpd->poweroff_task = NULL; | ||
| 298 | goto start; | ||
| 299 | } | ||
| 300 | } | ||
| 301 | |||
| 302 | parent = genpd->parent; | ||
| 303 | if (parent) { | ||
| 304 | mutex_unlock(&genpd->lock); | ||
| 305 | |||
| 306 | genpd_acquire_lock(parent); | ||
| 307 | mutex_lock_nested(&genpd->lock, SINGLE_DEPTH_NESTING); | ||
| 308 | |||
| 309 | if (genpd_abort_poweroff(genpd)) { | ||
| 310 | genpd_release_lock(parent); | ||
| 311 | goto out; | ||
| 312 | } | ||
| 313 | } | ||
| 314 | |||
| 315 | if (genpd->power_off) { | ||
| 316 | ret = genpd->power_off(genpd); | ||
| 317 | if (ret == -EBUSY) { | ||
| 318 | genpd_set_active(genpd); | ||
| 319 | if (parent) | ||
| 320 | genpd_release_lock(parent); | ||
| 321 | |||
| 322 | goto out; | ||
| 323 | } | ||
| 324 | } | ||
| 325 | |||
| 326 | genpd->status = GPD_STATE_POWER_OFF; | ||
| 327 | |||
| 328 | if (parent) { | ||
| 329 | genpd_sd_counter_dec(parent); | ||
| 330 | if (parent->sd_count == 0) | ||
| 331 | genpd_queue_power_off_work(parent); | ||
| 332 | |||
| 333 | genpd_release_lock(parent); | ||
| 334 | } | ||
| 335 | |||
| 336 | out: | ||
| 337 | genpd->poweroff_task = NULL; | ||
| 338 | wake_up_all(&genpd->status_wait_queue); | ||
| 339 | return ret; | ||
| 340 | } | ||
| 341 | |||
| 342 | /** | ||
| 343 | * genpd_power_off_work_fn - Power off PM domain whose subdomain count is 0. | ||
| 344 | * @work: Work structure used for scheduling the execution of this function. | ||
| 345 | */ | ||
| 346 | static void genpd_power_off_work_fn(struct work_struct *work) | ||
| 347 | { | ||
| 348 | struct generic_pm_domain *genpd; | ||
| 349 | |||
| 350 | genpd = container_of(work, struct generic_pm_domain, power_off_work); | ||
| 351 | |||
| 352 | genpd_acquire_lock(genpd); | ||
| 353 | pm_genpd_poweroff(genpd); | ||
| 354 | genpd_release_lock(genpd); | ||
| 355 | } | ||
| 356 | |||
| 357 | /** | ||
| 358 | * pm_genpd_runtime_suspend - Suspend a device belonging to I/O PM domain. | ||
| 359 | * @dev: Device to suspend. | ||
| 360 | * | ||
| 361 | * Carry out a runtime suspend of a device under the assumption that its | ||
| 362 | * pm_domain field points to the domain member of an object of type | ||
| 363 | * struct generic_pm_domain representing a PM domain consisting of I/O devices. | ||
| 364 | */ | ||
| 365 | static int pm_genpd_runtime_suspend(struct device *dev) | ||
| 366 | { | ||
| 367 | struct generic_pm_domain *genpd; | ||
| 368 | |||
| 369 | dev_dbg(dev, "%s()\n", __func__); | ||
| 370 | |||
| 371 | genpd = dev_to_genpd(dev); | ||
| 372 | if (IS_ERR(genpd)) | ||
| 373 | return -EINVAL; | ||
| 374 | |||
| 375 | if (genpd->stop_device) { | ||
| 376 | int ret = genpd->stop_device(dev); | ||
| 377 | if (ret) | ||
| 378 | return ret; | ||
| 379 | } | ||
| 380 | |||
| 381 | mutex_lock(&genpd->lock); | ||
| 382 | genpd->in_progress++; | ||
| 383 | pm_genpd_poweroff(genpd); | ||
| 384 | genpd->in_progress--; | ||
| 385 | mutex_unlock(&genpd->lock); | ||
| 386 | |||
| 387 | return 0; | ||
| 388 | } | ||
| 389 | |||
| 390 | /** | ||
| 391 | * __pm_genpd_runtime_resume - Resume a device belonging to I/O PM domain. | ||
| 392 | * @dev: Device to resume. | ||
| 393 | * @genpd: PM domain the device belongs to. | ||
| 394 | */ | ||
| 395 | static void __pm_genpd_runtime_resume(struct device *dev, | ||
| 396 | struct generic_pm_domain *genpd) | ||
| 397 | { | ||
| 398 | struct dev_list_entry *dle; | ||
| 399 | |||
| 400 | list_for_each_entry(dle, &genpd->dev_list, node) { | ||
| 401 | if (dle->dev == dev) { | ||
| 402 | __pm_genpd_restore_device(dle, genpd); | ||
| 403 | break; | ||
| 404 | } | ||
| 405 | } | ||
| 406 | } | ||
| 407 | |||
| 408 | /** | ||
| 409 | * pm_genpd_runtime_resume - Resume a device belonging to I/O PM domain. | ||
| 410 | * @dev: Device to resume. | ||
| 411 | * | ||
| 412 | * Carry out a runtime resume of a device under the assumption that its | ||
| 413 | * pm_domain field points to the domain member of an object of type | ||
| 414 | * struct generic_pm_domain representing a PM domain consisting of I/O devices. | ||
| 415 | */ | ||
| 416 | static int pm_genpd_runtime_resume(struct device *dev) | ||
| 417 | { | ||
| 418 | struct generic_pm_domain *genpd; | ||
| 419 | DEFINE_WAIT(wait); | ||
| 420 | int ret; | ||
| 421 | |||
| 422 | dev_dbg(dev, "%s()\n", __func__); | ||
| 423 | |||
| 424 | genpd = dev_to_genpd(dev); | ||
| 425 | if (IS_ERR(genpd)) | ||
| 426 | return -EINVAL; | ||
| 427 | |||
| 428 | ret = pm_genpd_poweron(genpd); | ||
| 429 | if (ret) | ||
| 430 | return ret; | ||
| 431 | |||
| 432 | mutex_lock(&genpd->lock); | ||
| 433 | genpd->status = GPD_STATE_BUSY; | ||
| 434 | genpd->resume_count++; | ||
| 435 | for (;;) { | ||
| 436 | prepare_to_wait(&genpd->status_wait_queue, &wait, | ||
| 437 | TASK_UNINTERRUPTIBLE); | ||
| 438 | /* | ||
| 439 | * If current is the powering off task, we have been called | ||
| 440 | * reentrantly from one of the device callbacks, so we should | ||
| 441 | * not wait. | ||
| 442 | */ | ||
| 443 | if (!genpd->poweroff_task || genpd->poweroff_task == current) | ||
| 444 | break; | ||
| 445 | mutex_unlock(&genpd->lock); | ||
| 446 | |||
| 447 | schedule(); | ||
| 448 | |||
| 449 | mutex_lock(&genpd->lock); | ||
| 450 | } | ||
| 451 | finish_wait(&genpd->status_wait_queue, &wait); | ||
| 452 | __pm_genpd_runtime_resume(dev, genpd); | ||
| 453 | genpd->resume_count--; | ||
| 454 | genpd_set_active(genpd); | ||
| 455 | wake_up_all(&genpd->status_wait_queue); | ||
| 456 | mutex_unlock(&genpd->lock); | ||
| 457 | |||
| 458 | if (genpd->start_device) | ||
| 459 | genpd->start_device(dev); | ||
| 460 | |||
| 461 | return 0; | ||
| 462 | } | ||
| 463 | |||
| 464 | #else | ||
| 465 | |||
| 466 | static inline void genpd_power_off_work_fn(struct work_struct *work) {} | ||
| 467 | static inline void __pm_genpd_runtime_resume(struct device *dev, | ||
| 468 | struct generic_pm_domain *genpd) {} | ||
| 469 | |||
| 470 | #define pm_genpd_runtime_suspend NULL | ||
| 471 | #define pm_genpd_runtime_resume NULL | ||
| 472 | |||
| 473 | #endif /* CONFIG_PM_RUNTIME */ | ||
| 474 | |||
| 475 | #ifdef CONFIG_PM_SLEEP | ||
| 476 | |||
| 477 | /** | ||
| 478 | * pm_genpd_sync_poweroff - Synchronously power off a PM domain and its parents. | ||
| 479 | * @genpd: PM domain to power off, if possible. | ||
| 480 | * | ||
| 481 | * Check if the given PM domain can be powered off (during system suspend or | ||
| 482 | * hibernation) and do that if so. Also, in that case propagate to its parent. | ||
| 483 | * | ||
| 484 | * This function is only called in "noirq" stages of system power transitions, | ||
| 485 | * so it need not acquire locks (all of the "noirq" callbacks are executed | ||
| 486 | * sequentially, so it is guaranteed that it will never run twice in parallel). | ||
| 487 | */ | ||
| 488 | static void pm_genpd_sync_poweroff(struct generic_pm_domain *genpd) | ||
| 489 | { | ||
| 490 | struct generic_pm_domain *parent = genpd->parent; | ||
| 491 | |||
| 492 | if (genpd->status == GPD_STATE_POWER_OFF) | ||
| 493 | return; | ||
| 494 | |||
| 495 | if (genpd->suspended_count != genpd->device_count || genpd->sd_count > 0) | ||
| 496 | return; | ||
| 497 | |||
| 498 | if (genpd->power_off) | ||
| 499 | genpd->power_off(genpd); | ||
| 500 | |||
| 501 | genpd->status = GPD_STATE_POWER_OFF; | ||
| 502 | if (parent) { | ||
| 503 | genpd_sd_counter_dec(parent); | ||
| 504 | pm_genpd_sync_poweroff(parent); | ||
| 505 | } | ||
| 506 | } | ||
| 507 | |||
| 508 | /** | ||
| 509 | * resume_needed - Check whether to resume a device before system suspend. | ||
| 510 | * @dev: Device to check. | ||
| 511 | * @genpd: PM domain the device belongs to. | ||
| 512 | * | ||
| 513 | * There are two cases in which a device that can wake up the system from sleep | ||
| 514 | * states should be resumed by pm_genpd_prepare(): (1) if the device is enabled | ||
| 515 | * to wake up the system and it has to remain active for this purpose while the | ||
| 516 | * system is in the sleep state and (2) if the device is not enabled to wake up | ||
| 517 | * the system from sleep states and it generally doesn't generate wakeup signals | ||
| 518 | * by itself (those signals are generated on its behalf by other parts of the | ||
| 519 | * system). In the latter case it may be necessary to reconfigure the device's | ||
| 520 | * wakeup settings during system suspend, because it may have been set up to | ||
| 521 | * signal remote wakeup from the system's working state as needed by runtime PM. | ||
| 522 | * Return 'true' in either of the above cases. | ||
| 523 | */ | ||
| 524 | static bool resume_needed(struct device *dev, struct generic_pm_domain *genpd) | ||
| 525 | { | ||
| 526 | bool active_wakeup; | ||
| 527 | |||
| 528 | if (!device_can_wakeup(dev)) | ||
| 529 | return false; | ||
| 530 | |||
| 531 | active_wakeup = genpd->active_wakeup && genpd->active_wakeup(dev); | ||
| 532 | return device_may_wakeup(dev) ? active_wakeup : !active_wakeup; | ||
| 533 | } | ||
| 534 | |||
| 535 | /** | ||
| 536 | * pm_genpd_prepare - Start power transition of a device in a PM domain. | ||
| 537 | * @dev: Device to start the transition of. | ||
| 538 | * | ||
| 539 | * Start a power transition of a device (during a system-wide power transition) | ||
| 540 | * under the assumption that its pm_domain field points to the domain member of | ||
| 541 | * an object of type struct generic_pm_domain representing a PM domain | ||
| 542 | * consisting of I/O devices. | ||
| 543 | */ | ||
| 544 | static int pm_genpd_prepare(struct device *dev) | ||
| 545 | { | ||
| 546 | struct generic_pm_domain *genpd; | ||
| 547 | int ret; | ||
| 548 | |||
| 549 | dev_dbg(dev, "%s()\n", __func__); | ||
| 550 | |||
| 551 | genpd = dev_to_genpd(dev); | ||
| 552 | if (IS_ERR(genpd)) | ||
| 553 | return -EINVAL; | ||
| 554 | |||
| 555 | /* | ||
| 556 | * If a wakeup request is pending for the device, it should be woken up | ||
| 557 | * at this point and a system wakeup event should be reported if it's | ||
| 558 | * set up to wake up the system from sleep states. | ||
| 559 | */ | ||
| 560 | pm_runtime_get_noresume(dev); | ||
| 561 | if (pm_runtime_barrier(dev) && device_may_wakeup(dev)) | ||
| 562 | pm_wakeup_event(dev, 0); | ||
| 563 | |||
| 564 | if (pm_wakeup_pending()) { | ||
| 565 | pm_runtime_put_sync(dev); | ||
| 566 | return -EBUSY; | ||
| 567 | } | ||
| 568 | |||
| 569 | if (resume_needed(dev, genpd)) | ||
| 570 | pm_runtime_resume(dev); | ||
| 571 | |||
| 572 | genpd_acquire_lock(genpd); | ||
| 573 | |||
| 574 | if (genpd->prepared_count++ == 0) | ||
| 575 | genpd->suspend_power_off = genpd->status == GPD_STATE_POWER_OFF; | ||
| 576 | |||
| 577 | genpd_release_lock(genpd); | ||
| 578 | |||
| 579 | if (genpd->suspend_power_off) { | ||
| 580 | pm_runtime_put_noidle(dev); | ||
| 581 | return 0; | ||
| 582 | } | ||
| 583 | |||
| 584 | /* | ||
| 585 | * The PM domain must be in the GPD_STATE_ACTIVE state at this point, | ||
| 586 | * so pm_genpd_poweron() will return immediately, but if the device | ||
| 587 | * is suspended (e.g. it's been stopped by .stop_device()), we need | ||
| 588 | * to make it operational. | ||
| 589 | */ | ||
| 590 | pm_runtime_resume(dev); | ||
| 591 | __pm_runtime_disable(dev, false); | ||
| 592 | |||
| 593 | ret = pm_generic_prepare(dev); | ||
| 594 | if (ret) { | ||
| 595 | mutex_lock(&genpd->lock); | ||
| 596 | |||
| 597 | if (--genpd->prepared_count == 0) | ||
| 598 | genpd->suspend_power_off = false; | ||
| 599 | |||
| 600 | mutex_unlock(&genpd->lock); | ||
| 601 | pm_runtime_enable(dev); | ||
| 602 | } | ||
| 603 | |||
| 604 | pm_runtime_put_sync(dev); | ||
| 605 | return ret; | ||
| 606 | } | ||
| 607 | |||
| 608 | /** | ||
| 609 | * pm_genpd_suspend - Suspend a device belonging to an I/O PM domain. | ||
| 610 | * @dev: Device to suspend. | ||
| 611 | * | ||
| 612 | * Suspend a device under the assumption that its pm_domain field points to the | ||
| 613 | * domain member of an object of type struct generic_pm_domain representing | ||
| 614 | * a PM domain consisting of I/O devices. | ||
| 615 | */ | ||
| 616 | static int pm_genpd_suspend(struct device *dev) | ||
| 617 | { | ||
| 618 | struct generic_pm_domain *genpd; | ||
| 619 | |||
| 620 | dev_dbg(dev, "%s()\n", __func__); | ||
| 621 | |||
| 622 | genpd = dev_to_genpd(dev); | ||
| 623 | if (IS_ERR(genpd)) | ||
| 624 | return -EINVAL; | ||
| 625 | |||
| 626 | return genpd->suspend_power_off ? 0 : pm_generic_suspend(dev); | ||
| 627 | } | ||
| 628 | |||
| 629 | /** | ||
| 630 | * pm_genpd_suspend_noirq - Late suspend of a device from an I/O PM domain. | ||
| 631 | * @dev: Device to suspend. | ||
| 632 | * | ||
| 633 | * Carry out a late suspend of a device under the assumption that its | ||
| 634 | * pm_domain field points to the domain member of an object of type | ||
| 635 | * struct generic_pm_domain representing a PM domain consisting of I/O devices. | ||
| 636 | */ | ||
| 637 | static int pm_genpd_suspend_noirq(struct device *dev) | ||
| 638 | { | ||
| 639 | struct generic_pm_domain *genpd; | ||
| 640 | int ret; | ||
| 641 | |||
| 642 | dev_dbg(dev, "%s()\n", __func__); | ||
| 643 | |||
| 644 | genpd = dev_to_genpd(dev); | ||
| 645 | if (IS_ERR(genpd)) | ||
| 646 | return -EINVAL; | ||
| 647 | |||
| 648 | if (genpd->suspend_power_off) | ||
| 649 | return 0; | ||
| 650 | |||
| 651 | ret = pm_generic_suspend_noirq(dev); | ||
| 652 | if (ret) | ||
| 653 | return ret; | ||
| 654 | |||
| 655 | if (device_may_wakeup(dev) | ||
| 656 | && genpd->active_wakeup && genpd->active_wakeup(dev)) | ||
| 657 | return 0; | ||
| 658 | |||
| 659 | if (genpd->stop_device) | ||
| 660 | genpd->stop_device(dev); | ||
| 661 | |||
| 662 | /* | ||
| 663 | * Since all of the "noirq" callbacks are executed sequentially, it is | ||
| 664 | * guaranteed that this function will never run twice in parallel for | ||
| 665 | * the same PM domain, so it is not necessary to use locking here. | ||
| 666 | */ | ||
| 667 | genpd->suspended_count++; | ||
| 668 | pm_genpd_sync_poweroff(genpd); | ||
| 669 | |||
| 670 | return 0; | ||
| 671 | } | ||
| 672 | |||
| 673 | /** | ||
| 674 | * pm_genpd_resume_noirq - Early resume of a device from an I/O power domain. | ||
| 675 | * @dev: Device to resume. | ||
| 676 | * | ||
| 677 | * Carry out an early resume of a device under the assumption that its | ||
| 678 | * pm_domain field points to the domain member of an object of type | ||
| 679 | * struct generic_pm_domain representing a power domain consisting of I/O | ||
| 680 | * devices. | ||
| 681 | */ | ||
| 682 | static int pm_genpd_resume_noirq(struct device *dev) | ||
| 683 | { | ||
| 684 | struct generic_pm_domain *genpd; | ||
| 685 | |||
| 686 | dev_dbg(dev, "%s()\n", __func__); | ||
| 687 | |||
| 688 | genpd = dev_to_genpd(dev); | ||
| 689 | if (IS_ERR(genpd)) | ||
| 690 | return -EINVAL; | ||
| 691 | |||
| 692 | if (genpd->suspend_power_off) | ||
| 693 | return 0; | ||
| 694 | |||
| 695 | /* | ||
| 696 | * Since all of the "noirq" callbacks are executed sequentially, it is | ||
| 697 | * guaranteed that this function will never run twice in parallel for | ||
| 698 | * the same PM domain, so it is not necessary to use locking here. | ||
| 699 | */ | ||
| 700 | pm_genpd_poweron(genpd); | ||
| 701 | genpd->suspended_count--; | ||
| 702 | if (genpd->start_device) | ||
| 703 | genpd->start_device(dev); | ||
| 704 | |||
| 705 | return pm_generic_resume_noirq(dev); | ||
| 706 | } | ||
| 707 | |||
| 708 | /** | ||
| 709 | * pm_genpd_resume - Resume a device belonging to an I/O power domain. | ||
| 710 | * @dev: Device to resume. | ||
| 711 | * | ||
| 712 | * Resume a device under the assumption that its pm_domain field points to the | ||
| 713 | * domain member of an object of type struct generic_pm_domain representing | ||
| 714 | * a power domain consisting of I/O devices. | ||
| 715 | */ | ||
| 716 | static int pm_genpd_resume(struct device *dev) | ||
| 717 | { | ||
| 718 | struct generic_pm_domain *genpd; | ||
| 719 | |||
| 720 | dev_dbg(dev, "%s()\n", __func__); | ||
| 721 | |||
| 722 | genpd = dev_to_genpd(dev); | ||
| 723 | if (IS_ERR(genpd)) | ||
| 724 | return -EINVAL; | ||
| 725 | |||
| 726 | return genpd->suspend_power_off ? 0 : pm_generic_resume(dev); | ||
| 727 | } | ||
| 728 | |||
| 729 | /** | ||
| 730 | * pm_genpd_freeze - Freeze a device belonging to an I/O power domain. | ||
| 731 | * @dev: Device to freeze. | ||
| 732 | * | ||
| 733 | * Freeze a device under the assumption that its pm_domain field points to the | ||
| 734 | * domain member of an object of type struct generic_pm_domain representing | ||
| 735 | * a power domain consisting of I/O devices. | ||
| 736 | */ | ||
| 737 | static int pm_genpd_freeze(struct device *dev) | ||
| 738 | { | ||
| 739 | struct generic_pm_domain *genpd; | ||
| 740 | |||
| 741 | dev_dbg(dev, "%s()\n", __func__); | ||
| 742 | |||
| 743 | genpd = dev_to_genpd(dev); | ||
| 744 | if (IS_ERR(genpd)) | ||
| 745 | return -EINVAL; | ||
| 746 | |||
| 747 | return genpd->suspend_power_off ? 0 : pm_generic_freeze(dev); | ||
| 748 | } | ||
| 749 | |||
| 750 | /** | ||
| 751 | * pm_genpd_freeze_noirq - Late freeze of a device from an I/O power domain. | ||
| 752 | * @dev: Device to freeze. | ||
| 753 | * | ||
| 754 | * Carry out a late freeze of a device under the assumption that its | ||
| 755 | * pm_domain field points to the domain member of an object of type | ||
| 756 | * struct generic_pm_domain representing a power domain consisting of I/O | ||
| 757 | * devices. | ||
| 758 | */ | ||
| 759 | static int pm_genpd_freeze_noirq(struct device *dev) | ||
| 760 | { | ||
| 761 | struct generic_pm_domain *genpd; | ||
| 762 | int ret; | ||
| 763 | |||
| 764 | dev_dbg(dev, "%s()\n", __func__); | ||
| 765 | |||
| 766 | genpd = dev_to_genpd(dev); | ||
| 767 | if (IS_ERR(genpd)) | ||
| 768 | return -EINVAL; | ||
| 769 | |||
| 770 | if (genpd->suspend_power_off) | ||
| 771 | return 0; | ||
| 772 | |||
| 773 | ret = pm_generic_freeze_noirq(dev); | ||
| 774 | if (ret) | ||
| 775 | return ret; | ||
| 776 | |||
| 777 | if (genpd->stop_device) | ||
| 778 | genpd->stop_device(dev); | ||
| 779 | |||
| 780 | return 0; | ||
| 781 | } | ||
| 782 | |||
| 783 | /** | ||
| 784 | * pm_genpd_thaw_noirq - Early thaw of a device from an I/O power domain. | ||
| 785 | * @dev: Device to thaw. | ||
| 786 | * | ||
| 787 | * Carry out an early thaw of a device under the assumption that its | ||
| 788 | * pm_domain field points to the domain member of an object of type | ||
| 789 | * struct generic_pm_domain representing a power domain consisting of I/O | ||
| 790 | * devices. | ||
| 791 | */ | ||
| 792 | static int pm_genpd_thaw_noirq(struct device *dev) | ||
| 793 | { | ||
| 794 | struct generic_pm_domain *genpd; | ||
| 795 | |||
| 796 | dev_dbg(dev, "%s()\n", __func__); | ||
| 797 | |||
| 798 | genpd = dev_to_genpd(dev); | ||
| 799 | if (IS_ERR(genpd)) | ||
| 800 | return -EINVAL; | ||
| 801 | |||
| 802 | if (genpd->suspend_power_off) | ||
| 803 | return 0; | ||
| 804 | |||
| 805 | if (genpd->start_device) | ||
| 806 | genpd->start_device(dev); | ||
| 807 | |||
| 808 | return pm_generic_thaw_noirq(dev); | ||
| 809 | } | ||
| 810 | |||
| 811 | /** | ||
| 812 | * pm_genpd_thaw - Thaw a device belonging to an I/O power domain. | ||
| 813 | * @dev: Device to thaw. | ||
| 814 | * | ||
| 815 | * Thaw a device under the assumption that its pm_domain field points to the | ||
| 816 | * domain member of an object of type struct generic_pm_domain representing | ||
| 817 | * a power domain consisting of I/O devices. | ||
| 818 | */ | ||
| 819 | static int pm_genpd_thaw(struct device *dev) | ||
| 820 | { | ||
| 821 | struct generic_pm_domain *genpd; | ||
| 822 | |||
| 823 | dev_dbg(dev, "%s()\n", __func__); | ||
| 824 | |||
| 825 | genpd = dev_to_genpd(dev); | ||
| 826 | if (IS_ERR(genpd)) | ||
| 827 | return -EINVAL; | ||
| 828 | |||
| 829 | return genpd->suspend_power_off ? 0 : pm_generic_thaw(dev); | ||
| 830 | } | ||
| 831 | |||
| 832 | /** | ||
| 833 | * pm_genpd_dev_poweroff - Power off a device belonging to an I/O PM domain. | ||
| 834 | * @dev: Device to suspend. | ||
| 835 | * | ||
| 836 | * Power off a device under the assumption that its pm_domain field points to | ||
| 837 | * the domain member of an object of type struct generic_pm_domain representing | ||
| 838 | * a PM domain consisting of I/O devices. | ||
| 839 | */ | ||
| 840 | static int pm_genpd_dev_poweroff(struct device *dev) | ||
| 841 | { | ||
| 842 | struct generic_pm_domain *genpd; | ||
| 843 | |||
| 844 | dev_dbg(dev, "%s()\n", __func__); | ||
| 845 | |||
| 846 | genpd = dev_to_genpd(dev); | ||
| 847 | if (IS_ERR(genpd)) | ||
| 848 | return -EINVAL; | ||
| 849 | |||
| 850 | return genpd->suspend_power_off ? 0 : pm_generic_poweroff(dev); | ||
| 851 | } | ||
| 852 | |||
| 853 | /** | ||
| 854 | * pm_genpd_dev_poweroff_noirq - Late power off of a device from a PM domain. | ||
| 855 | * @dev: Device to suspend. | ||
| 856 | * | ||
| 857 | * Carry out a late powering off of a device under the assumption that its | ||
| 858 | * pm_domain field points to the domain member of an object of type | ||
| 859 | * struct generic_pm_domain representing a PM domain consisting of I/O devices. | ||
| 860 | */ | ||
| 861 | static int pm_genpd_dev_poweroff_noirq(struct device *dev) | ||
| 862 | { | ||
| 863 | struct generic_pm_domain *genpd; | ||
| 864 | int ret; | ||
| 865 | |||
| 866 | dev_dbg(dev, "%s()\n", __func__); | ||
| 867 | |||
| 868 | genpd = dev_to_genpd(dev); | ||
| 869 | if (IS_ERR(genpd)) | ||
| 870 | return -EINVAL; | ||
| 871 | |||
| 872 | if (genpd->suspend_power_off) | ||
| 873 | return 0; | ||
| 874 | |||
| 875 | ret = pm_generic_poweroff_noirq(dev); | ||
| 876 | if (ret) | ||
| 877 | return ret; | ||
| 878 | |||
| 879 | if (device_may_wakeup(dev) | ||
| 880 | && genpd->active_wakeup && genpd->active_wakeup(dev)) | ||
| 881 | return 0; | ||
| 882 | |||
| 883 | if (genpd->stop_device) | ||
| 884 | genpd->stop_device(dev); | ||
| 885 | |||
| 886 | /* | ||
| 887 | * Since all of the "noirq" callbacks are executed sequentially, it is | ||
| 888 | * guaranteed that this function will never run twice in parallel for | ||
| 889 | * the same PM domain, so it is not necessary to use locking here. | ||
| 890 | */ | ||
| 891 | genpd->suspended_count++; | ||
| 892 | pm_genpd_sync_poweroff(genpd); | ||
| 893 | |||
| 894 | return 0; | ||
| 895 | } | ||
| 896 | |||
| 897 | /** | ||
| 898 | * pm_genpd_restore_noirq - Early restore of a device from an I/O power domain. | ||
| 899 | * @dev: Device to resume. | ||
| 900 | * | ||
| 901 | * Carry out an early restore of a device under the assumption that its | ||
| 902 | * pm_domain field points to the domain member of an object of type | ||
| 903 | * struct generic_pm_domain representing a power domain consisting of I/O | ||
| 904 | * devices. | ||
| 905 | */ | ||
| 906 | static int pm_genpd_restore_noirq(struct device *dev) | ||
| 907 | { | ||
| 908 | struct generic_pm_domain *genpd; | ||
| 909 | |||
| 910 | dev_dbg(dev, "%s()\n", __func__); | ||
| 911 | |||
| 912 | genpd = dev_to_genpd(dev); | ||
| 913 | if (IS_ERR(genpd)) | ||
| 914 | return -EINVAL; | ||
| 915 | |||
| 916 | /* | ||
| 917 | * Since all of the "noirq" callbacks are executed sequentially, it is | ||
| 918 | * guaranteed that this function will never run twice in parallel for | ||
| 919 | * the same PM domain, so it is not necessary to use locking here. | ||
| 920 | */ | ||
| 921 | genpd->status = GPD_STATE_POWER_OFF; | ||
| 922 | if (genpd->suspend_power_off) { | ||
| 923 | /* | ||
| 924 | * The boot kernel might put the domain into the power on state, | ||
| 925 | * so make sure it really is powered off. | ||
| 926 | */ | ||
| 927 | if (genpd->power_off) | ||
| 928 | genpd->power_off(genpd); | ||
| 929 | return 0; | ||
| 930 | } | ||
| 931 | |||
| 932 | pm_genpd_poweron(genpd); | ||
| 933 | genpd->suspended_count--; | ||
| 934 | if (genpd->start_device) | ||
| 935 | genpd->start_device(dev); | ||
| 936 | |||
| 937 | return pm_generic_restore_noirq(dev); | ||
| 938 | } | ||
| 939 | |||
| 940 | /** | ||
| 941 | * pm_genpd_restore - Restore a device belonging to an I/O power domain. | ||
| 942 | * @dev: Device to resume. | ||
| 943 | * | ||
| 944 | * Restore a device under the assumption that its pm_domain field points to the | ||
| 945 | * domain member of an object of type struct generic_pm_domain representing | ||
| 946 | * a power domain consisting of I/O devices. | ||
| 947 | */ | ||
| 948 | static int pm_genpd_restore(struct device *dev) | ||
| 949 | { | ||
| 950 | struct generic_pm_domain *genpd; | ||
| 951 | |||
| 952 | dev_dbg(dev, "%s()\n", __func__); | ||
| 953 | |||
| 954 | genpd = dev_to_genpd(dev); | ||
| 955 | if (IS_ERR(genpd)) | ||
| 956 | return -EINVAL; | ||
| 957 | |||
| 958 | return genpd->suspend_power_off ? 0 : pm_generic_restore(dev); | ||
| 959 | } | ||
| 960 | |||
| 961 | /** | ||
| 962 | * pm_genpd_complete - Complete power transition of a device in a power domain. | ||
| 963 | * @dev: Device to complete the transition of. | ||
| 964 | * | ||
| 965 | * Complete a power transition of a device (during a system-wide power | ||
| 966 | * transition) under the assumption that its pm_domain field points to the | ||
| 967 | * domain member of an object of type struct generic_pm_domain representing | ||
| 968 | * a power domain consisting of I/O devices. | ||
| 969 | */ | ||
| 970 | static void pm_genpd_complete(struct device *dev) | ||
| 971 | { | ||
| 972 | struct generic_pm_domain *genpd; | ||
| 973 | bool run_complete; | ||
| 974 | |||
| 975 | dev_dbg(dev, "%s()\n", __func__); | ||
| 976 | |||
| 977 | genpd = dev_to_genpd(dev); | ||
| 978 | if (IS_ERR(genpd)) | ||
| 979 | return; | ||
| 980 | |||
| 981 | mutex_lock(&genpd->lock); | ||
| 982 | |||
| 983 | run_complete = !genpd->suspend_power_off; | ||
| 984 | if (--genpd->prepared_count == 0) | ||
| 985 | genpd->suspend_power_off = false; | ||
| 986 | |||
| 987 | mutex_unlock(&genpd->lock); | ||
| 988 | |||
| 989 | if (run_complete) { | ||
| 990 | pm_generic_complete(dev); | ||
| 991 | pm_runtime_set_active(dev); | ||
| 992 | pm_runtime_enable(dev); | ||
| 993 | pm_runtime_idle(dev); | ||
| 994 | } | ||
| 995 | } | ||
| 996 | |||
| 997 | #else | ||
| 998 | |||
| 999 | #define pm_genpd_prepare NULL | ||
| 1000 | #define pm_genpd_suspend NULL | ||
| 1001 | #define pm_genpd_suspend_noirq NULL | ||
| 1002 | #define pm_genpd_resume_noirq NULL | ||
| 1003 | #define pm_genpd_resume NULL | ||
| 1004 | #define pm_genpd_freeze NULL | ||
| 1005 | #define pm_genpd_freeze_noirq NULL | ||
| 1006 | #define pm_genpd_thaw_noirq NULL | ||
| 1007 | #define pm_genpd_thaw NULL | ||
| 1008 | #define pm_genpd_dev_poweroff_noirq NULL | ||
| 1009 | #define pm_genpd_dev_poweroff NULL | ||
| 1010 | #define pm_genpd_restore_noirq NULL | ||
| 1011 | #define pm_genpd_restore NULL | ||
| 1012 | #define pm_genpd_complete NULL | ||
| 1013 | |||
| 1014 | #endif /* CONFIG_PM_SLEEP */ | ||
| 1015 | |||
| 1016 | /** | ||
| 1017 | * pm_genpd_add_device - Add a device to an I/O PM domain. | ||
| 1018 | * @genpd: PM domain to add the device to. | ||
| 1019 | * @dev: Device to be added. | ||
| 1020 | */ | ||
| 1021 | int pm_genpd_add_device(struct generic_pm_domain *genpd, struct device *dev) | ||
| 1022 | { | ||
| 1023 | struct dev_list_entry *dle; | ||
| 1024 | int ret = 0; | ||
| 1025 | |||
| 1026 | dev_dbg(dev, "%s()\n", __func__); | ||
| 1027 | |||
| 1028 | if (IS_ERR_OR_NULL(genpd) || IS_ERR_OR_NULL(dev)) | ||
| 1029 | return -EINVAL; | ||
| 1030 | |||
| 1031 | genpd_acquire_lock(genpd); | ||
| 1032 | |||
| 1033 | if (genpd->status == GPD_STATE_POWER_OFF) { | ||
| 1034 | ret = -EINVAL; | ||
| 1035 | goto out; | ||
| 1036 | } | ||
| 1037 | |||
| 1038 | if (genpd->prepared_count > 0) { | ||
| 1039 | ret = -EAGAIN; | ||
| 1040 | goto out; | ||
| 1041 | } | ||
| 1042 | |||
| 1043 | list_for_each_entry(dle, &genpd->dev_list, node) | ||
| 1044 | if (dle->dev == dev) { | ||
| 1045 | ret = -EINVAL; | ||
| 1046 | goto out; | ||
| 1047 | } | ||
| 1048 | |||
| 1049 | dle = kzalloc(sizeof(*dle), GFP_KERNEL); | ||
| 1050 | if (!dle) { | ||
| 1051 | ret = -ENOMEM; | ||
| 1052 | goto out; | ||
| 1053 | } | ||
| 1054 | |||
| 1055 | dle->dev = dev; | ||
| 1056 | dle->need_restore = false; | ||
| 1057 | list_add_tail(&dle->node, &genpd->dev_list); | ||
| 1058 | genpd->device_count++; | ||
| 1059 | |||
| 1060 | spin_lock_irq(&dev->power.lock); | ||
| 1061 | dev->pm_domain = &genpd->domain; | ||
| 1062 | spin_unlock_irq(&dev->power.lock); | ||
| 1063 | |||
| 1064 | out: | ||
| 1065 | genpd_release_lock(genpd); | ||
| 1066 | |||
| 1067 | return ret; | ||
| 1068 | } | ||
| 1069 | |||
| 1070 | /** | ||
| 1071 | * pm_genpd_remove_device - Remove a device from an I/O PM domain. | ||
| 1072 | * @genpd: PM domain to remove the device from. | ||
| 1073 | * @dev: Device to be removed. | ||
| 1074 | */ | ||
| 1075 | int pm_genpd_remove_device(struct generic_pm_domain *genpd, | ||
| 1076 | struct device *dev) | ||
| 1077 | { | ||
| 1078 | struct dev_list_entry *dle; | ||
| 1079 | int ret = -EINVAL; | ||
| 1080 | |||
| 1081 | dev_dbg(dev, "%s()\n", __func__); | ||
| 1082 | |||
| 1083 | if (IS_ERR_OR_NULL(genpd) || IS_ERR_OR_NULL(dev)) | ||
| 1084 | return -EINVAL; | ||
| 1085 | |||
| 1086 | genpd_acquire_lock(genpd); | ||
| 1087 | |||
| 1088 | if (genpd->prepared_count > 0) { | ||
| 1089 | ret = -EAGAIN; | ||
| 1090 | goto out; | ||
| 1091 | } | ||
| 1092 | |||
| 1093 | list_for_each_entry(dle, &genpd->dev_list, node) { | ||
| 1094 | if (dle->dev != dev) | ||
| 1095 | continue; | ||
| 1096 | |||
| 1097 | spin_lock_irq(&dev->power.lock); | ||
| 1098 | dev->pm_domain = NULL; | ||
| 1099 | spin_unlock_irq(&dev->power.lock); | ||
| 1100 | |||
| 1101 | genpd->device_count--; | ||
| 1102 | list_del(&dle->node); | ||
| 1103 | kfree(dle); | ||
| 1104 | |||
| 1105 | ret = 0; | ||
| 1106 | break; | ||
| 1107 | } | ||
| 1108 | |||
| 1109 | out: | ||
| 1110 | genpd_release_lock(genpd); | ||
| 1111 | |||
| 1112 | return ret; | ||
| 1113 | } | ||
| 1114 | |||
| 1115 | /** | ||
| 1116 | * pm_genpd_add_subdomain - Add a subdomain to an I/O PM domain. | ||
| 1117 | * @genpd: Master PM domain to add the subdomain to. | ||
| 1118 | * @new_subdomain: Subdomain to be added. | ||
| 1119 | */ | ||
| 1120 | int pm_genpd_add_subdomain(struct generic_pm_domain *genpd, | ||
| 1121 | struct generic_pm_domain *new_subdomain) | ||
| 1122 | { | ||
| 1123 | struct generic_pm_domain *subdomain; | ||
| 1124 | int ret = 0; | ||
| 1125 | |||
| 1126 | if (IS_ERR_OR_NULL(genpd) || IS_ERR_OR_NULL(new_subdomain)) | ||
| 1127 | return -EINVAL; | ||
| 1128 | |||
| 1129 | start: | ||
| 1130 | genpd_acquire_lock(genpd); | ||
| 1131 | mutex_lock_nested(&new_subdomain->lock, SINGLE_DEPTH_NESTING); | ||
| 1132 | |||
| 1133 | if (new_subdomain->status != GPD_STATE_POWER_OFF | ||
| 1134 | && new_subdomain->status != GPD_STATE_ACTIVE) { | ||
| 1135 | mutex_unlock(&new_subdomain->lock); | ||
| 1136 | genpd_release_lock(genpd); | ||
| 1137 | goto start; | ||
| 1138 | } | ||
| 1139 | |||
| 1140 | if (genpd->status == GPD_STATE_POWER_OFF | ||
| 1141 | && new_subdomain->status != GPD_STATE_POWER_OFF) { | ||
| 1142 | ret = -EINVAL; | ||
| 1143 | goto out; | ||
| 1144 | } | ||
| 1145 | |||
| 1146 | list_for_each_entry(subdomain, &genpd->sd_list, sd_node) { | ||
| 1147 | if (subdomain == new_subdomain) { | ||
| 1148 | ret = -EINVAL; | ||
| 1149 | goto out; | ||
| 1150 | } | ||
| 1151 | } | ||
| 1152 | |||
| 1153 | list_add_tail(&new_subdomain->sd_node, &genpd->sd_list); | ||
| 1154 | new_subdomain->parent = genpd; | ||
| 1155 | if (subdomain->status != GPD_STATE_POWER_OFF) | ||
| 1156 | genpd->sd_count++; | ||
| 1157 | |||
| 1158 | out: | ||
| 1159 | mutex_unlock(&new_subdomain->lock); | ||
| 1160 | genpd_release_lock(genpd); | ||
| 1161 | |||
| 1162 | return ret; | ||
| 1163 | } | ||
| 1164 | |||
| 1165 | /** | ||
| 1166 | * pm_genpd_remove_subdomain - Remove a subdomain from an I/O PM domain. | ||
| 1167 | * @genpd: Master PM domain to remove the subdomain from. | ||
| 1168 | * @target: Subdomain to be removed. | ||
| 1169 | */ | ||
| 1170 | int pm_genpd_remove_subdomain(struct generic_pm_domain *genpd, | ||
| 1171 | struct generic_pm_domain *target) | ||
| 1172 | { | ||
| 1173 | struct generic_pm_domain *subdomain; | ||
| 1174 | int ret = -EINVAL; | ||
| 1175 | |||
| 1176 | if (IS_ERR_OR_NULL(genpd) || IS_ERR_OR_NULL(target)) | ||
| 1177 | return -EINVAL; | ||
| 1178 | |||
| 1179 | start: | ||
| 1180 | genpd_acquire_lock(genpd); | ||
| 1181 | |||
| 1182 | list_for_each_entry(subdomain, &genpd->sd_list, sd_node) { | ||
| 1183 | if (subdomain != target) | ||
| 1184 | continue; | ||
| 1185 | |||
| 1186 | mutex_lock_nested(&subdomain->lock, SINGLE_DEPTH_NESTING); | ||
| 1187 | |||
| 1188 | if (subdomain->status != GPD_STATE_POWER_OFF | ||
| 1189 | && subdomain->status != GPD_STATE_ACTIVE) { | ||
| 1190 | mutex_unlock(&subdomain->lock); | ||
| 1191 | genpd_release_lock(genpd); | ||
| 1192 | goto start; | ||
| 1193 | } | ||
| 1194 | |||
| 1195 | list_del(&subdomain->sd_node); | ||
| 1196 | subdomain->parent = NULL; | ||
| 1197 | if (subdomain->status != GPD_STATE_POWER_OFF) | ||
| 1198 | genpd_sd_counter_dec(genpd); | ||
| 1199 | |||
| 1200 | mutex_unlock(&subdomain->lock); | ||
| 1201 | |||
| 1202 | ret = 0; | ||
| 1203 | break; | ||
| 1204 | } | ||
| 1205 | |||
| 1206 | genpd_release_lock(genpd); | ||
| 1207 | |||
| 1208 | return ret; | ||
| 1209 | } | ||
| 1210 | |||
| 1211 | /** | ||
| 1212 | * pm_genpd_init - Initialize a generic I/O PM domain object. | ||
| 1213 | * @genpd: PM domain object to initialize. | ||
| 1214 | * @gov: PM domain governor to associate with the domain (may be NULL). | ||
| 1215 | * @is_off: Initial value of the domain's power_is_off field. | ||
| 1216 | */ | ||
| 1217 | void pm_genpd_init(struct generic_pm_domain *genpd, | ||
| 1218 | struct dev_power_governor *gov, bool is_off) | ||
| 1219 | { | ||
| 1220 | if (IS_ERR_OR_NULL(genpd)) | ||
| 1221 | return; | ||
| 1222 | |||
| 1223 | INIT_LIST_HEAD(&genpd->sd_node); | ||
| 1224 | genpd->parent = NULL; | ||
| 1225 | INIT_LIST_HEAD(&genpd->dev_list); | ||
| 1226 | INIT_LIST_HEAD(&genpd->sd_list); | ||
| 1227 | mutex_init(&genpd->lock); | ||
| 1228 | genpd->gov = gov; | ||
| 1229 | INIT_WORK(&genpd->power_off_work, genpd_power_off_work_fn); | ||
| 1230 | genpd->in_progress = 0; | ||
| 1231 | genpd->sd_count = 0; | ||
| 1232 | genpd->status = is_off ? GPD_STATE_POWER_OFF : GPD_STATE_ACTIVE; | ||
| 1233 | init_waitqueue_head(&genpd->status_wait_queue); | ||
| 1234 | genpd->poweroff_task = NULL; | ||
| 1235 | genpd->resume_count = 0; | ||
| 1236 | genpd->device_count = 0; | ||
| 1237 | genpd->suspended_count = 0; | ||
| 1238 | genpd->domain.ops.runtime_suspend = pm_genpd_runtime_suspend; | ||
| 1239 | genpd->domain.ops.runtime_resume = pm_genpd_runtime_resume; | ||
| 1240 | genpd->domain.ops.runtime_idle = pm_generic_runtime_idle; | ||
| 1241 | genpd->domain.ops.prepare = pm_genpd_prepare; | ||
| 1242 | genpd->domain.ops.suspend = pm_genpd_suspend; | ||
| 1243 | genpd->domain.ops.suspend_noirq = pm_genpd_suspend_noirq; | ||
| 1244 | genpd->domain.ops.resume_noirq = pm_genpd_resume_noirq; | ||
| 1245 | genpd->domain.ops.resume = pm_genpd_resume; | ||
| 1246 | genpd->domain.ops.freeze = pm_genpd_freeze; | ||
| 1247 | genpd->domain.ops.freeze_noirq = pm_genpd_freeze_noirq; | ||
| 1248 | genpd->domain.ops.thaw_noirq = pm_genpd_thaw_noirq; | ||
| 1249 | genpd->domain.ops.thaw = pm_genpd_thaw; | ||
| 1250 | genpd->domain.ops.poweroff = pm_genpd_dev_poweroff; | ||
| 1251 | genpd->domain.ops.poweroff_noirq = pm_genpd_dev_poweroff_noirq; | ||
| 1252 | genpd->domain.ops.restore_noirq = pm_genpd_restore_noirq; | ||
| 1253 | genpd->domain.ops.restore = pm_genpd_restore; | ||
| 1254 | genpd->domain.ops.complete = pm_genpd_complete; | ||
| 1255 | mutex_lock(&gpd_list_lock); | ||
| 1256 | list_add(&genpd->gpd_list_node, &gpd_list); | ||
| 1257 | mutex_unlock(&gpd_list_lock); | ||
| 1258 | } | ||
| 1259 | |||
| 1260 | /** | ||
| 1261 | * pm_genpd_poweroff_unused - Power off all PM domains with no devices in use. | ||
| 1262 | */ | ||
| 1263 | void pm_genpd_poweroff_unused(void) | ||
| 1264 | { | ||
| 1265 | struct generic_pm_domain *genpd; | ||
| 1266 | |||
| 1267 | mutex_lock(&gpd_list_lock); | ||
| 1268 | |||
| 1269 | list_for_each_entry(genpd, &gpd_list, gpd_list_node) | ||
| 1270 | genpd_queue_power_off_work(genpd); | ||
| 1271 | |||
| 1272 | mutex_unlock(&gpd_list_lock); | ||
| 1273 | } | ||
diff --git a/drivers/base/power/generic_ops.c b/drivers/base/power/generic_ops.c index cb3bb368681c..9508df71274b 100644 --- a/drivers/base/power/generic_ops.c +++ b/drivers/base/power/generic_ops.c | |||
| @@ -94,12 +94,13 @@ int pm_generic_prepare(struct device *dev) | |||
| 94 | * __pm_generic_call - Generic suspend/freeze/poweroff/thaw subsystem callback. | 94 | * __pm_generic_call - Generic suspend/freeze/poweroff/thaw subsystem callback. |
| 95 | * @dev: Device to handle. | 95 | * @dev: Device to handle. |
| 96 | * @event: PM transition of the system under way. | 96 | * @event: PM transition of the system under way. |
| 97 | * @bool: Whether or not this is the "noirq" stage. | ||
| 97 | * | 98 | * |
| 98 | * If the device has not been suspended at run time, execute the | 99 | * If the device has not been suspended at run time, execute the |
| 99 | * suspend/freeze/poweroff/thaw callback provided by its driver, if defined, and | 100 | * suspend/freeze/poweroff/thaw callback provided by its driver, if defined, and |
| 100 | * return its error code. Otherwise, return zero. | 101 | * return its error code. Otherwise, return zero. |
| 101 | */ | 102 | */ |
| 102 | static int __pm_generic_call(struct device *dev, int event) | 103 | static int __pm_generic_call(struct device *dev, int event, bool noirq) |
| 103 | { | 104 | { |
| 104 | const struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL; | 105 | const struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL; |
| 105 | int (*callback)(struct device *); | 106 | int (*callback)(struct device *); |
| @@ -109,16 +110,16 @@ static int __pm_generic_call(struct device *dev, int event) | |||
| 109 | 110 | ||
| 110 | switch (event) { | 111 | switch (event) { |
| 111 | case PM_EVENT_SUSPEND: | 112 | case PM_EVENT_SUSPEND: |
| 112 | callback = pm->suspend; | 113 | callback = noirq ? pm->suspend_noirq : pm->suspend; |
| 113 | break; | 114 | break; |
| 114 | case PM_EVENT_FREEZE: | 115 | case PM_EVENT_FREEZE: |
| 115 | callback = pm->freeze; | 116 | callback = noirq ? pm->freeze_noirq : pm->freeze; |
| 116 | break; | 117 | break; |
| 117 | case PM_EVENT_HIBERNATE: | 118 | case PM_EVENT_HIBERNATE: |
| 118 | callback = pm->poweroff; | 119 | callback = noirq ? pm->poweroff_noirq : pm->poweroff; |
| 119 | break; | 120 | break; |
| 120 | case PM_EVENT_THAW: | 121 | case PM_EVENT_THAW: |
| 121 | callback = pm->thaw; | 122 | callback = noirq ? pm->thaw_noirq : pm->thaw; |
| 122 | break; | 123 | break; |
| 123 | default: | 124 | default: |
| 124 | callback = NULL; | 125 | callback = NULL; |
| @@ -129,42 +130,82 @@ static int __pm_generic_call(struct device *dev, int event) | |||
| 129 | } | 130 | } |
| 130 | 131 | ||
| 131 | /** | 132 | /** |
| 133 | * pm_generic_suspend_noirq - Generic suspend_noirq callback for subsystems. | ||
| 134 | * @dev: Device to suspend. | ||
| 135 | */ | ||
| 136 | int pm_generic_suspend_noirq(struct device *dev) | ||
| 137 | { | ||
| 138 | return __pm_generic_call(dev, PM_EVENT_SUSPEND, true); | ||
| 139 | } | ||
| 140 | EXPORT_SYMBOL_GPL(pm_generic_suspend_noirq); | ||
| 141 | |||
| 142 | /** | ||
| 132 | * pm_generic_suspend - Generic suspend callback for subsystems. | 143 | * pm_generic_suspend - Generic suspend callback for subsystems. |
| 133 | * @dev: Device to suspend. | 144 | * @dev: Device to suspend. |
| 134 | */ | 145 | */ |
| 135 | int pm_generic_suspend(struct device *dev) | 146 | int pm_generic_suspend(struct device *dev) |
| 136 | { | 147 | { |
| 137 | return __pm_generic_call(dev, PM_EVENT_SUSPEND); | 148 | return __pm_generic_call(dev, PM_EVENT_SUSPEND, false); |
| 138 | } | 149 | } |
| 139 | EXPORT_SYMBOL_GPL(pm_generic_suspend); | 150 | EXPORT_SYMBOL_GPL(pm_generic_suspend); |
| 140 | 151 | ||
| 141 | /** | 152 | /** |
| 153 | * pm_generic_freeze_noirq - Generic freeze_noirq callback for subsystems. | ||
| 154 | * @dev: Device to freeze. | ||
| 155 | */ | ||
| 156 | int pm_generic_freeze_noirq(struct device *dev) | ||
| 157 | { | ||
| 158 | return __pm_generic_call(dev, PM_EVENT_FREEZE, true); | ||
| 159 | } | ||
| 160 | EXPORT_SYMBOL_GPL(pm_generic_freeze_noirq); | ||
| 161 | |||
| 162 | /** | ||
| 142 | * pm_generic_freeze - Generic freeze callback for subsystems. | 163 | * pm_generic_freeze - Generic freeze callback for subsystems. |
| 143 | * @dev: Device to freeze. | 164 | * @dev: Device to freeze. |
| 144 | */ | 165 | */ |
| 145 | int pm_generic_freeze(struct device *dev) | 166 | int pm_generic_freeze(struct device *dev) |
| 146 | { | 167 | { |
| 147 | return __pm_generic_call(dev, PM_EVENT_FREEZE); | 168 | return __pm_generic_call(dev, PM_EVENT_FREEZE, false); |
| 148 | } | 169 | } |
| 149 | EXPORT_SYMBOL_GPL(pm_generic_freeze); | 170 | EXPORT_SYMBOL_GPL(pm_generic_freeze); |
| 150 | 171 | ||
| 151 | /** | 172 | /** |
| 173 | * pm_generic_poweroff_noirq - Generic poweroff_noirq callback for subsystems. | ||
| 174 | * @dev: Device to handle. | ||
| 175 | */ | ||
| 176 | int pm_generic_poweroff_noirq(struct device *dev) | ||
| 177 | { | ||
| 178 | return __pm_generic_call(dev, PM_EVENT_HIBERNATE, true); | ||
| 179 | } | ||
| 180 | EXPORT_SYMBOL_GPL(pm_generic_poweroff_noirq); | ||
| 181 | |||
| 182 | /** | ||
| 152 | * pm_generic_poweroff - Generic poweroff callback for subsystems. | 183 | * pm_generic_poweroff - Generic poweroff callback for subsystems. |
| 153 | * @dev: Device to handle. | 184 | * @dev: Device to handle. |
| 154 | */ | 185 | */ |
| 155 | int pm_generic_poweroff(struct device *dev) | 186 | int pm_generic_poweroff(struct device *dev) |
| 156 | { | 187 | { |
| 157 | return __pm_generic_call(dev, PM_EVENT_HIBERNATE); | 188 | return __pm_generic_call(dev, PM_EVENT_HIBERNATE, false); |
| 158 | } | 189 | } |
| 159 | EXPORT_SYMBOL_GPL(pm_generic_poweroff); | 190 | EXPORT_SYMBOL_GPL(pm_generic_poweroff); |
| 160 | 191 | ||
| 161 | /** | 192 | /** |
| 193 | * pm_generic_thaw_noirq - Generic thaw_noirq callback for subsystems. | ||
| 194 | * @dev: Device to thaw. | ||
| 195 | */ | ||
| 196 | int pm_generic_thaw_noirq(struct device *dev) | ||
| 197 | { | ||
| 198 | return __pm_generic_call(dev, PM_EVENT_THAW, true); | ||
| 199 | } | ||
| 200 | EXPORT_SYMBOL_GPL(pm_generic_thaw_noirq); | ||
| 201 | |||
| 202 | /** | ||
| 162 | * pm_generic_thaw - Generic thaw callback for subsystems. | 203 | * pm_generic_thaw - Generic thaw callback for subsystems. |
| 163 | * @dev: Device to thaw. | 204 | * @dev: Device to thaw. |
| 164 | */ | 205 | */ |
| 165 | int pm_generic_thaw(struct device *dev) | 206 | int pm_generic_thaw(struct device *dev) |
| 166 | { | 207 | { |
| 167 | return __pm_generic_call(dev, PM_EVENT_THAW); | 208 | return __pm_generic_call(dev, PM_EVENT_THAW, false); |
| 168 | } | 209 | } |
| 169 | EXPORT_SYMBOL_GPL(pm_generic_thaw); | 210 | EXPORT_SYMBOL_GPL(pm_generic_thaw); |
| 170 | 211 | ||
| @@ -172,12 +213,13 @@ EXPORT_SYMBOL_GPL(pm_generic_thaw); | |||
| 172 | * __pm_generic_resume - Generic resume/restore callback for subsystems. | 213 | * __pm_generic_resume - Generic resume/restore callback for subsystems. |
| 173 | * @dev: Device to handle. | 214 | * @dev: Device to handle. |
| 174 | * @event: PM transition of the system under way. | 215 | * @event: PM transition of the system under way. |
| 216 | * @bool: Whether or not this is the "noirq" stage. | ||
| 175 | * | 217 | * |
| 176 | * Execute the resume/resotre callback provided by the @dev's driver, if | 218 | * Execute the resume/resotre callback provided by the @dev's driver, if |
| 177 | * defined. If it returns 0, change the device's runtime PM status to 'active'. | 219 | * defined. If it returns 0, change the device's runtime PM status to 'active'. |
| 178 | * Return the callback's error code. | 220 | * Return the callback's error code. |
| 179 | */ | 221 | */ |
| 180 | static int __pm_generic_resume(struct device *dev, int event) | 222 | static int __pm_generic_resume(struct device *dev, int event, bool noirq) |
| 181 | { | 223 | { |
| 182 | const struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL; | 224 | const struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL; |
| 183 | int (*callback)(struct device *); | 225 | int (*callback)(struct device *); |
| @@ -188,10 +230,10 @@ static int __pm_generic_resume(struct device *dev, int event) | |||
| 188 | 230 | ||
| 189 | switch (event) { | 231 | switch (event) { |
| 190 | case PM_EVENT_RESUME: | 232 | case PM_EVENT_RESUME: |
| 191 | callback = pm->resume; | 233 | callback = noirq ? pm->resume_noirq : pm->resume; |
| 192 | break; | 234 | break; |
| 193 | case PM_EVENT_RESTORE: | 235 | case PM_EVENT_RESTORE: |
| 194 | callback = pm->restore; | 236 | callback = noirq ? pm->restore_noirq : pm->restore; |
| 195 | break; | 237 | break; |
| 196 | default: | 238 | default: |
| 197 | callback = NULL; | 239 | callback = NULL; |
| @@ -202,7 +244,7 @@ static int __pm_generic_resume(struct device *dev, int event) | |||
| 202 | return 0; | 244 | return 0; |
| 203 | 245 | ||
| 204 | ret = callback(dev); | 246 | ret = callback(dev); |
| 205 | if (!ret && pm_runtime_enabled(dev)) { | 247 | if (!ret && !noirq && pm_runtime_enabled(dev)) { |
| 206 | pm_runtime_disable(dev); | 248 | pm_runtime_disable(dev); |
| 207 | pm_runtime_set_active(dev); | 249 | pm_runtime_set_active(dev); |
| 208 | pm_runtime_enable(dev); | 250 | pm_runtime_enable(dev); |
| @@ -212,22 +254,42 @@ static int __pm_generic_resume(struct device *dev, int event) | |||
| 212 | } | 254 | } |
| 213 | 255 | ||
| 214 | /** | 256 | /** |
| 257 | * pm_generic_resume_noirq - Generic resume_noirq callback for subsystems. | ||
| 258 | * @dev: Device to resume. | ||
| 259 | */ | ||
| 260 | int pm_generic_resume_noirq(struct device *dev) | ||
| 261 | { | ||
| 262 | return __pm_generic_resume(dev, PM_EVENT_RESUME, true); | ||
| 263 | } | ||
| 264 | EXPORT_SYMBOL_GPL(pm_generic_resume_noirq); | ||
| 265 | |||
| 266 | /** | ||
| 215 | * pm_generic_resume - Generic resume callback for subsystems. | 267 | * pm_generic_resume - Generic resume callback for subsystems. |
| 216 | * @dev: Device to resume. | 268 | * @dev: Device to resume. |
| 217 | */ | 269 | */ |
| 218 | int pm_generic_resume(struct device *dev) | 270 | int pm_generic_resume(struct device *dev) |
| 219 | { | 271 | { |
| 220 | return __pm_generic_resume(dev, PM_EVENT_RESUME); | 272 | return __pm_generic_resume(dev, PM_EVENT_RESUME, false); |
| 221 | } | 273 | } |
| 222 | EXPORT_SYMBOL_GPL(pm_generic_resume); | 274 | EXPORT_SYMBOL_GPL(pm_generic_resume); |
| 223 | 275 | ||
| 224 | /** | 276 | /** |
| 277 | * pm_generic_restore_noirq - Generic restore_noirq callback for subsystems. | ||
| 278 | * @dev: Device to restore. | ||
| 279 | */ | ||
| 280 | int pm_generic_restore_noirq(struct device *dev) | ||
| 281 | { | ||
| 282 | return __pm_generic_resume(dev, PM_EVENT_RESTORE, true); | ||
| 283 | } | ||
| 284 | EXPORT_SYMBOL_GPL(pm_generic_restore_noirq); | ||
| 285 | |||
| 286 | /** | ||
| 225 | * pm_generic_restore - Generic restore callback for subsystems. | 287 | * pm_generic_restore - Generic restore callback for subsystems. |
| 226 | * @dev: Device to restore. | 288 | * @dev: Device to restore. |
| 227 | */ | 289 | */ |
| 228 | int pm_generic_restore(struct device *dev) | 290 | int pm_generic_restore(struct device *dev) |
| 229 | { | 291 | { |
| 230 | return __pm_generic_resume(dev, PM_EVENT_RESTORE); | 292 | return __pm_generic_resume(dev, PM_EVENT_RESTORE, false); |
| 231 | } | 293 | } |
| 232 | EXPORT_SYMBOL_GPL(pm_generic_restore); | 294 | EXPORT_SYMBOL_GPL(pm_generic_restore); |
| 233 | 295 | ||
| @@ -256,11 +318,17 @@ struct dev_pm_ops generic_subsys_pm_ops = { | |||
| 256 | #ifdef CONFIG_PM_SLEEP | 318 | #ifdef CONFIG_PM_SLEEP |
| 257 | .prepare = pm_generic_prepare, | 319 | .prepare = pm_generic_prepare, |
| 258 | .suspend = pm_generic_suspend, | 320 | .suspend = pm_generic_suspend, |
| 321 | .suspend_noirq = pm_generic_suspend_noirq, | ||
| 259 | .resume = pm_generic_resume, | 322 | .resume = pm_generic_resume, |
| 323 | .resume_noirq = pm_generic_resume_noirq, | ||
| 260 | .freeze = pm_generic_freeze, | 324 | .freeze = pm_generic_freeze, |
| 325 | .freeze_noirq = pm_generic_freeze_noirq, | ||
| 261 | .thaw = pm_generic_thaw, | 326 | .thaw = pm_generic_thaw, |
| 327 | .thaw_noirq = pm_generic_thaw_noirq, | ||
| 262 | .poweroff = pm_generic_poweroff, | 328 | .poweroff = pm_generic_poweroff, |
| 329 | .poweroff_noirq = pm_generic_poweroff_noirq, | ||
| 263 | .restore = pm_generic_restore, | 330 | .restore = pm_generic_restore, |
| 331 | .restore_noirq = pm_generic_restore_noirq, | ||
| 264 | .complete = pm_generic_complete, | 332 | .complete = pm_generic_complete, |
| 265 | #endif | 333 | #endif |
| 266 | #ifdef CONFIG_PM_RUNTIME | 334 | #ifdef CONFIG_PM_RUNTIME |
diff --git a/drivers/base/power/main.c b/drivers/base/power/main.c index 06f09bf89cb2..85b591a5429a 100644 --- a/drivers/base/power/main.c +++ b/drivers/base/power/main.c | |||
| @@ -425,9 +425,9 @@ static int device_resume_noirq(struct device *dev, pm_message_t state) | |||
| 425 | TRACE_DEVICE(dev); | 425 | TRACE_DEVICE(dev); |
| 426 | TRACE_RESUME(0); | 426 | TRACE_RESUME(0); |
| 427 | 427 | ||
| 428 | if (dev->pwr_domain) { | 428 | if (dev->pm_domain) { |
| 429 | pm_dev_dbg(dev, state, "EARLY power domain "); | 429 | pm_dev_dbg(dev, state, "EARLY power domain "); |
| 430 | error = pm_noirq_op(dev, &dev->pwr_domain->ops, state); | 430 | error = pm_noirq_op(dev, &dev->pm_domain->ops, state); |
| 431 | } else if (dev->type && dev->type->pm) { | 431 | } else if (dev->type && dev->type->pm) { |
| 432 | pm_dev_dbg(dev, state, "EARLY type "); | 432 | pm_dev_dbg(dev, state, "EARLY type "); |
| 433 | error = pm_noirq_op(dev, dev->type->pm, state); | 433 | error = pm_noirq_op(dev, dev->type->pm, state); |
| @@ -521,9 +521,9 @@ static int device_resume(struct device *dev, pm_message_t state, bool async) | |||
| 521 | if (!dev->power.is_suspended) | 521 | if (!dev->power.is_suspended) |
| 522 | goto Unlock; | 522 | goto Unlock; |
| 523 | 523 | ||
| 524 | if (dev->pwr_domain) { | 524 | if (dev->pm_domain) { |
| 525 | pm_dev_dbg(dev, state, "power domain "); | 525 | pm_dev_dbg(dev, state, "power domain "); |
| 526 | error = pm_op(dev, &dev->pwr_domain->ops, state); | 526 | error = pm_op(dev, &dev->pm_domain->ops, state); |
| 527 | goto End; | 527 | goto End; |
| 528 | } | 528 | } |
| 529 | 529 | ||
| @@ -641,10 +641,10 @@ static void device_complete(struct device *dev, pm_message_t state) | |||
| 641 | { | 641 | { |
| 642 | device_lock(dev); | 642 | device_lock(dev); |
| 643 | 643 | ||
| 644 | if (dev->pwr_domain) { | 644 | if (dev->pm_domain) { |
| 645 | pm_dev_dbg(dev, state, "completing power domain "); | 645 | pm_dev_dbg(dev, state, "completing power domain "); |
| 646 | if (dev->pwr_domain->ops.complete) | 646 | if (dev->pm_domain->ops.complete) |
| 647 | dev->pwr_domain->ops.complete(dev); | 647 | dev->pm_domain->ops.complete(dev); |
| 648 | } else if (dev->type && dev->type->pm) { | 648 | } else if (dev->type && dev->type->pm) { |
| 649 | pm_dev_dbg(dev, state, "completing type "); | 649 | pm_dev_dbg(dev, state, "completing type "); |
| 650 | if (dev->type->pm->complete) | 650 | if (dev->type->pm->complete) |
| @@ -744,9 +744,9 @@ static int device_suspend_noirq(struct device *dev, pm_message_t state) | |||
| 744 | { | 744 | { |
| 745 | int error; | 745 | int error; |
| 746 | 746 | ||
| 747 | if (dev->pwr_domain) { | 747 | if (dev->pm_domain) { |
| 748 | pm_dev_dbg(dev, state, "LATE power domain "); | 748 | pm_dev_dbg(dev, state, "LATE power domain "); |
| 749 | error = pm_noirq_op(dev, &dev->pwr_domain->ops, state); | 749 | error = pm_noirq_op(dev, &dev->pm_domain->ops, state); |
| 750 | if (error) | 750 | if (error) |
| 751 | return error; | 751 | return error; |
| 752 | } else if (dev->type && dev->type->pm) { | 752 | } else if (dev->type && dev->type->pm) { |
| @@ -853,9 +853,9 @@ static int __device_suspend(struct device *dev, pm_message_t state, bool async) | |||
| 853 | goto Unlock; | 853 | goto Unlock; |
| 854 | } | 854 | } |
| 855 | 855 | ||
| 856 | if (dev->pwr_domain) { | 856 | if (dev->pm_domain) { |
| 857 | pm_dev_dbg(dev, state, "power domain "); | 857 | pm_dev_dbg(dev, state, "power domain "); |
| 858 | error = pm_op(dev, &dev->pwr_domain->ops, state); | 858 | error = pm_op(dev, &dev->pm_domain->ops, state); |
| 859 | goto End; | 859 | goto End; |
| 860 | } | 860 | } |
| 861 | 861 | ||
| @@ -982,11 +982,11 @@ static int device_prepare(struct device *dev, pm_message_t state) | |||
| 982 | 982 | ||
| 983 | device_lock(dev); | 983 | device_lock(dev); |
| 984 | 984 | ||
| 985 | if (dev->pwr_domain) { | 985 | if (dev->pm_domain) { |
| 986 | pm_dev_dbg(dev, state, "preparing power domain "); | 986 | pm_dev_dbg(dev, state, "preparing power domain "); |
| 987 | if (dev->pwr_domain->ops.prepare) | 987 | if (dev->pm_domain->ops.prepare) |
| 988 | error = dev->pwr_domain->ops.prepare(dev); | 988 | error = dev->pm_domain->ops.prepare(dev); |
| 989 | suspend_report_result(dev->pwr_domain->ops.prepare, error); | 989 | suspend_report_result(dev->pm_domain->ops.prepare, error); |
| 990 | if (error) | 990 | if (error) |
| 991 | goto End; | 991 | goto End; |
| 992 | } else if (dev->type && dev->type->pm) { | 992 | } else if (dev->type && dev->type->pm) { |
diff --git a/drivers/base/power/runtime.c b/drivers/base/power/runtime.c index 0d4587b15c55..5f5c4236f006 100644 --- a/drivers/base/power/runtime.c +++ b/drivers/base/power/runtime.c | |||
| @@ -213,8 +213,8 @@ static int rpm_idle(struct device *dev, int rpmflags) | |||
| 213 | 213 | ||
| 214 | dev->power.idle_notification = true; | 214 | dev->power.idle_notification = true; |
| 215 | 215 | ||
| 216 | if (dev->pwr_domain) | 216 | if (dev->pm_domain) |
| 217 | callback = dev->pwr_domain->ops.runtime_idle; | 217 | callback = dev->pm_domain->ops.runtime_idle; |
| 218 | else if (dev->type && dev->type->pm) | 218 | else if (dev->type && dev->type->pm) |
| 219 | callback = dev->type->pm->runtime_idle; | 219 | callback = dev->type->pm->runtime_idle; |
| 220 | else if (dev->class && dev->class->pm) | 220 | else if (dev->class && dev->class->pm) |
| @@ -374,8 +374,8 @@ static int rpm_suspend(struct device *dev, int rpmflags) | |||
| 374 | 374 | ||
| 375 | __update_runtime_status(dev, RPM_SUSPENDING); | 375 | __update_runtime_status(dev, RPM_SUSPENDING); |
| 376 | 376 | ||
| 377 | if (dev->pwr_domain) | 377 | if (dev->pm_domain) |
| 378 | callback = dev->pwr_domain->ops.runtime_suspend; | 378 | callback = dev->pm_domain->ops.runtime_suspend; |
| 379 | else if (dev->type && dev->type->pm) | 379 | else if (dev->type && dev->type->pm) |
| 380 | callback = dev->type->pm->runtime_suspend; | 380 | callback = dev->type->pm->runtime_suspend; |
| 381 | else if (dev->class && dev->class->pm) | 381 | else if (dev->class && dev->class->pm) |
| @@ -573,8 +573,8 @@ static int rpm_resume(struct device *dev, int rpmflags) | |||
| 573 | 573 | ||
| 574 | __update_runtime_status(dev, RPM_RESUMING); | 574 | __update_runtime_status(dev, RPM_RESUMING); |
| 575 | 575 | ||
| 576 | if (dev->pwr_domain) | 576 | if (dev->pm_domain) |
| 577 | callback = dev->pwr_domain->ops.runtime_resume; | 577 | callback = dev->pm_domain->ops.runtime_resume; |
| 578 | else if (dev->type && dev->type->pm) | 578 | else if (dev->type && dev->type->pm) |
| 579 | callback = dev->type->pm->runtime_resume; | 579 | callback = dev->type->pm->runtime_resume; |
| 580 | else if (dev->class && dev->class->pm) | 580 | else if (dev->class && dev->class->pm) |
diff --git a/include/linux/device.h b/include/linux/device.h index e4f62d8896b7..160d4ddb2499 100644 --- a/include/linux/device.h +++ b/include/linux/device.h | |||
| @@ -516,7 +516,7 @@ struct device_dma_parameters { | |||
| 516 | * minimizes board-specific #ifdefs in drivers. | 516 | * minimizes board-specific #ifdefs in drivers. |
| 517 | * @power: For device power management. | 517 | * @power: For device power management. |
| 518 | * See Documentation/power/devices.txt for details. | 518 | * See Documentation/power/devices.txt for details. |
| 519 | * @pwr_domain: Provide callbacks that are executed during system suspend, | 519 | * @pm_domain: Provide callbacks that are executed during system suspend, |
| 520 | * hibernation, system resume and during runtime PM transitions | 520 | * hibernation, system resume and during runtime PM transitions |
| 521 | * along with subsystem-level and driver-level callbacks. | 521 | * along with subsystem-level and driver-level callbacks. |
| 522 | * @numa_node: NUMA node this device is close to. | 522 | * @numa_node: NUMA node this device is close to. |
| @@ -567,7 +567,7 @@ struct device { | |||
| 567 | void *platform_data; /* Platform specific data, device | 567 | void *platform_data; /* Platform specific data, device |
| 568 | core doesn't touch it */ | 568 | core doesn't touch it */ |
| 569 | struct dev_pm_info power; | 569 | struct dev_pm_info power; |
| 570 | struct dev_power_domain *pwr_domain; | 570 | struct dev_pm_domain *pm_domain; |
| 571 | 571 | ||
| 572 | #ifdef CONFIG_NUMA | 572 | #ifdef CONFIG_NUMA |
| 573 | int numa_node; /* NUMA node this device is close to */ | 573 | int numa_node; /* NUMA node this device is close to */ |
diff --git a/include/linux/pm.h b/include/linux/pm.h index 411e4f4be52b..f7c84c9abd30 100644 --- a/include/linux/pm.h +++ b/include/linux/pm.h | |||
| @@ -461,8 +461,8 @@ struct dev_pm_info { | |||
| 461 | unsigned long active_jiffies; | 461 | unsigned long active_jiffies; |
| 462 | unsigned long suspended_jiffies; | 462 | unsigned long suspended_jiffies; |
| 463 | unsigned long accounting_timestamp; | 463 | unsigned long accounting_timestamp; |
| 464 | void *subsys_data; /* Owned by the subsystem. */ | ||
| 465 | #endif | 464 | #endif |
| 465 | void *subsys_data; /* Owned by the subsystem. */ | ||
| 466 | }; | 466 | }; |
| 467 | 467 | ||
| 468 | extern void update_pm_runtime_accounting(struct device *dev); | 468 | extern void update_pm_runtime_accounting(struct device *dev); |
| @@ -472,7 +472,7 @@ extern void update_pm_runtime_accounting(struct device *dev); | |||
| 472 | * hibernation, system resume and during runtime PM transitions along with | 472 | * hibernation, system resume and during runtime PM transitions along with |
| 473 | * subsystem-level and driver-level callbacks. | 473 | * subsystem-level and driver-level callbacks. |
| 474 | */ | 474 | */ |
| 475 | struct dev_power_domain { | 475 | struct dev_pm_domain { |
| 476 | struct dev_pm_ops ops; | 476 | struct dev_pm_ops ops; |
| 477 | }; | 477 | }; |
| 478 | 478 | ||
| @@ -553,11 +553,17 @@ extern void __suspend_report_result(const char *function, void *fn, int ret); | |||
| 553 | extern int device_pm_wait_for_dev(struct device *sub, struct device *dev); | 553 | extern int device_pm_wait_for_dev(struct device *sub, struct device *dev); |
| 554 | 554 | ||
| 555 | extern int pm_generic_prepare(struct device *dev); | 555 | extern int pm_generic_prepare(struct device *dev); |
| 556 | extern int pm_generic_suspend_noirq(struct device *dev); | ||
| 556 | extern int pm_generic_suspend(struct device *dev); | 557 | extern int pm_generic_suspend(struct device *dev); |
| 558 | extern int pm_generic_resume_noirq(struct device *dev); | ||
| 557 | extern int pm_generic_resume(struct device *dev); | 559 | extern int pm_generic_resume(struct device *dev); |
| 560 | extern int pm_generic_freeze_noirq(struct device *dev); | ||
| 558 | extern int pm_generic_freeze(struct device *dev); | 561 | extern int pm_generic_freeze(struct device *dev); |
| 562 | extern int pm_generic_thaw_noirq(struct device *dev); | ||
| 559 | extern int pm_generic_thaw(struct device *dev); | 563 | extern int pm_generic_thaw(struct device *dev); |
| 564 | extern int pm_generic_restore_noirq(struct device *dev); | ||
| 560 | extern int pm_generic_restore(struct device *dev); | 565 | extern int pm_generic_restore(struct device *dev); |
| 566 | extern int pm_generic_poweroff_noirq(struct device *dev); | ||
| 561 | extern int pm_generic_poweroff(struct device *dev); | 567 | extern int pm_generic_poweroff(struct device *dev); |
| 562 | extern void pm_generic_complete(struct device *dev); | 568 | extern void pm_generic_complete(struct device *dev); |
| 563 | 569 | ||
diff --git a/include/linux/pm_domain.h b/include/linux/pm_domain.h new file mode 100644 index 000000000000..21097cb086fe --- /dev/null +++ b/include/linux/pm_domain.h | |||
| @@ -0,0 +1,108 @@ | |||
| 1 | /* | ||
| 2 | * pm_domain.h - Definitions and headers related to device power domains. | ||
| 3 | * | ||
| 4 | * Copyright (C) 2011 Rafael J. Wysocki <rjw@sisk.pl>, Renesas Electronics Corp. | ||
| 5 | * | ||
| 6 | * This file is released under the GPLv2. | ||
| 7 | */ | ||
| 8 | |||
| 9 | #ifndef _LINUX_PM_DOMAIN_H | ||
| 10 | #define _LINUX_PM_DOMAIN_H | ||
| 11 | |||
| 12 | #include <linux/device.h> | ||
| 13 | |||
| 14 | enum gpd_status { | ||
| 15 | GPD_STATE_ACTIVE = 0, /* PM domain is active */ | ||
| 16 | GPD_STATE_BUSY, /* Something is happening to the PM domain */ | ||
| 17 | GPD_STATE_REPEAT, /* Power off in progress, to be repeated */ | ||
| 18 | GPD_STATE_POWER_OFF, /* PM domain is off */ | ||
| 19 | }; | ||
| 20 | |||
| 21 | struct dev_power_governor { | ||
| 22 | bool (*power_down_ok)(struct dev_pm_domain *domain); | ||
| 23 | }; | ||
| 24 | |||
| 25 | struct generic_pm_domain { | ||
| 26 | struct dev_pm_domain domain; /* PM domain operations */ | ||
| 27 | struct list_head gpd_list_node; /* Node in the global PM domains list */ | ||
| 28 | struct list_head sd_node; /* Node in the parent's subdomain list */ | ||
| 29 | struct generic_pm_domain *parent; /* Parent PM domain */ | ||
| 30 | struct list_head sd_list; /* List of dubdomains */ | ||
| 31 | struct list_head dev_list; /* List of devices */ | ||
| 32 | struct mutex lock; | ||
| 33 | struct dev_power_governor *gov; | ||
| 34 | struct work_struct power_off_work; | ||
| 35 | unsigned int in_progress; /* Number of devices being suspended now */ | ||
| 36 | unsigned int sd_count; /* Number of subdomains with power "on" */ | ||
| 37 | enum gpd_status status; /* Current state of the domain */ | ||
| 38 | wait_queue_head_t status_wait_queue; | ||
| 39 | struct task_struct *poweroff_task; /* Powering off task */ | ||
| 40 | unsigned int resume_count; /* Number of devices being resumed */ | ||
| 41 | unsigned int device_count; /* Number of devices */ | ||
| 42 | unsigned int suspended_count; /* System suspend device counter */ | ||
| 43 | unsigned int prepared_count; /* Suspend counter of prepared devices */ | ||
| 44 | bool suspend_power_off; /* Power status before system suspend */ | ||
| 45 | int (*power_off)(struct generic_pm_domain *domain); | ||
| 46 | int (*power_on)(struct generic_pm_domain *domain); | ||
| 47 | int (*start_device)(struct device *dev); | ||
| 48 | int (*stop_device)(struct device *dev); | ||
| 49 | bool (*active_wakeup)(struct device *dev); | ||
| 50 | }; | ||
| 51 | |||
| 52 | static inline struct generic_pm_domain *pd_to_genpd(struct dev_pm_domain *pd) | ||
| 53 | { | ||
| 54 | return container_of(pd, struct generic_pm_domain, domain); | ||
| 55 | } | ||
| 56 | |||
| 57 | struct dev_list_entry { | ||
| 58 | struct list_head node; | ||
| 59 | struct device *dev; | ||
| 60 | bool need_restore; | ||
| 61 | }; | ||
| 62 | |||
| 63 | #ifdef CONFIG_PM_GENERIC_DOMAINS | ||
| 64 | extern int pm_genpd_add_device(struct generic_pm_domain *genpd, | ||
| 65 | struct device *dev); | ||
| 66 | extern int pm_genpd_remove_device(struct generic_pm_domain *genpd, | ||
| 67 | struct device *dev); | ||
| 68 | extern int pm_genpd_add_subdomain(struct generic_pm_domain *genpd, | ||
| 69 | struct generic_pm_domain *new_subdomain); | ||
| 70 | extern int pm_genpd_remove_subdomain(struct generic_pm_domain *genpd, | ||
| 71 | struct generic_pm_domain *target); | ||
| 72 | extern void pm_genpd_init(struct generic_pm_domain *genpd, | ||
| 73 | struct dev_power_governor *gov, bool is_off); | ||
| 74 | extern int pm_genpd_poweron(struct generic_pm_domain *genpd); | ||
| 75 | extern void pm_genpd_poweroff_unused(void); | ||
| 76 | extern void genpd_queue_power_off_work(struct generic_pm_domain *genpd); | ||
| 77 | #else | ||
| 78 | static inline int pm_genpd_add_device(struct generic_pm_domain *genpd, | ||
| 79 | struct device *dev) | ||
| 80 | { | ||
| 81 | return -ENOSYS; | ||
| 82 | } | ||
| 83 | static inline int pm_genpd_remove_device(struct generic_pm_domain *genpd, | ||
| 84 | struct device *dev) | ||
| 85 | { | ||
| 86 | return -ENOSYS; | ||
| 87 | } | ||
| 88 | static inline int pm_genpd_add_subdomain(struct generic_pm_domain *genpd, | ||
| 89 | struct generic_pm_domain *new_sd) | ||
| 90 | { | ||
| 91 | return -ENOSYS; | ||
| 92 | } | ||
| 93 | static inline int pm_genpd_remove_subdomain(struct generic_pm_domain *genpd, | ||
| 94 | struct generic_pm_domain *target) | ||
| 95 | { | ||
| 96 | return -ENOSYS; | ||
| 97 | } | ||
| 98 | static inline void pm_genpd_init(struct generic_pm_domain *genpd, | ||
| 99 | struct dev_power_governor *gov, bool is_off) {} | ||
| 100 | static inline int pm_genpd_poweron(struct generic_pm_domain *genpd) | ||
| 101 | { | ||
| 102 | return -ENOSYS; | ||
| 103 | } | ||
| 104 | static inline void pm_genpd_poweroff_unused(void) {} | ||
| 105 | static inline void genpd_queue_power_off_work(struct generic_pm_domain *gpd) {} | ||
| 106 | #endif | ||
| 107 | |||
| 108 | #endif /* _LINUX_PM_DOMAIN_H */ | ||
diff --git a/include/linux/pm_runtime.h b/include/linux/pm_runtime.h index 878cf84baeb1..dfb8539ed686 100644 --- a/include/linux/pm_runtime.h +++ b/include/linux/pm_runtime.h | |||
| @@ -247,41 +247,41 @@ static inline void pm_runtime_dont_use_autosuspend(struct device *dev) | |||
| 247 | 247 | ||
| 248 | struct pm_clk_notifier_block { | 248 | struct pm_clk_notifier_block { |
| 249 | struct notifier_block nb; | 249 | struct notifier_block nb; |
| 250 | struct dev_power_domain *pwr_domain; | 250 | struct dev_pm_domain *pm_domain; |
| 251 | char *con_ids[]; | 251 | char *con_ids[]; |
| 252 | }; | 252 | }; |
| 253 | 253 | ||
| 254 | #ifdef CONFIG_PM_RUNTIME_CLK | 254 | #ifdef CONFIG_PM_CLK |
| 255 | extern int pm_runtime_clk_init(struct device *dev); | 255 | extern int pm_clk_init(struct device *dev); |
| 256 | extern void pm_runtime_clk_destroy(struct device *dev); | 256 | extern void pm_clk_destroy(struct device *dev); |
| 257 | extern int pm_runtime_clk_add(struct device *dev, const char *con_id); | 257 | extern int pm_clk_add(struct device *dev, const char *con_id); |
| 258 | extern void pm_runtime_clk_remove(struct device *dev, const char *con_id); | 258 | extern void pm_clk_remove(struct device *dev, const char *con_id); |
| 259 | extern int pm_runtime_clk_suspend(struct device *dev); | 259 | extern int pm_clk_suspend(struct device *dev); |
| 260 | extern int pm_runtime_clk_resume(struct device *dev); | 260 | extern int pm_clk_resume(struct device *dev); |
| 261 | #else | 261 | #else |
| 262 | static inline int pm_runtime_clk_init(struct device *dev) | 262 | static inline int pm_clk_init(struct device *dev) |
| 263 | { | 263 | { |
| 264 | return -EINVAL; | 264 | return -EINVAL; |
| 265 | } | 265 | } |
| 266 | static inline void pm_runtime_clk_destroy(struct device *dev) | 266 | static inline void pm_clk_destroy(struct device *dev) |
| 267 | { | 267 | { |
| 268 | } | 268 | } |
| 269 | static inline int pm_runtime_clk_add(struct device *dev, const char *con_id) | 269 | static inline int pm_clk_add(struct device *dev, const char *con_id) |
| 270 | { | 270 | { |
| 271 | return -EINVAL; | 271 | return -EINVAL; |
| 272 | } | 272 | } |
| 273 | static inline void pm_runtime_clk_remove(struct device *dev, const char *con_id) | 273 | static inline void pm_clk_remove(struct device *dev, const char *con_id) |
| 274 | { | 274 | { |
| 275 | } | 275 | } |
| 276 | #define pm_runtime_clock_suspend NULL | 276 | #define pm_clk_suspend NULL |
| 277 | #define pm_runtime_clock_resume NULL | 277 | #define pm_clk_resume NULL |
| 278 | #endif | 278 | #endif |
| 279 | 279 | ||
| 280 | #ifdef CONFIG_HAVE_CLK | 280 | #ifdef CONFIG_HAVE_CLK |
| 281 | extern void pm_runtime_clk_add_notifier(struct bus_type *bus, | 281 | extern void pm_clk_add_notifier(struct bus_type *bus, |
| 282 | struct pm_clk_notifier_block *clknb); | 282 | struct pm_clk_notifier_block *clknb); |
| 283 | #else | 283 | #else |
| 284 | static inline void pm_runtime_clk_add_notifier(struct bus_type *bus, | 284 | static inline void pm_clk_add_notifier(struct bus_type *bus, |
| 285 | struct pm_clk_notifier_block *clknb) | 285 | struct pm_clk_notifier_block *clknb) |
| 286 | { | 286 | { |
| 287 | } | 287 | } |
diff --git a/kernel/power/Kconfig b/kernel/power/Kconfig index 87f4d24b55b0..7b856b3458d2 100644 --- a/kernel/power/Kconfig +++ b/kernel/power/Kconfig | |||
| @@ -224,6 +224,10 @@ config PM_OPP | |||
| 224 | implementations a ready to use framework to manage OPPs. | 224 | implementations a ready to use framework to manage OPPs. |
| 225 | For more information, read <file:Documentation/power/opp.txt> | 225 | For more information, read <file:Documentation/power/opp.txt> |
| 226 | 226 | ||
| 227 | config PM_RUNTIME_CLK | 227 | config PM_CLK |
| 228 | def_bool y | 228 | def_bool y |
| 229 | depends on PM_RUNTIME && HAVE_CLK | 229 | depends on PM && HAVE_CLK |
| 230 | |||
| 231 | config PM_GENERIC_DOMAINS | ||
| 232 | bool | ||
| 233 | depends on PM | ||
