With CONFIG_PM disabled, turn the devices clocks on during driver binding to the device, and turn them off when the driver is unbound from the device.
Signed-off-by: Rajendra Nayak <[email protected]> --- drivers/clk/qcom/gdsc.c | 71 +++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 71 insertions(+) diff --git a/drivers/clk/qcom/gdsc.c b/drivers/clk/qcom/gdsc.c index 68b810a..c7f109b 100644 --- a/drivers/clk/qcom/gdsc.c +++ b/drivers/clk/qcom/gdsc.c @@ -12,10 +12,12 @@ */ #include <linux/bitops.h> +#include <linux/clk.h> #include <linux/delay.h> #include <linux/err.h> #include <linux/jiffies.h> #include <linux/kernel.h> +#include <linux/platform_device.h> #include <linux/pm_clock.h> #include <linux/pm_domain.h> #include <linux/regmap.h> @@ -211,3 +213,72 @@ void gdsc_unregister(struct device *dev) { of_genpd_del_provider(dev->of_node); } + +#ifndef CONFIG_PM +struct gdsc_notifier_block { + struct notifier_block nb; + const char *con_ids[]; +}; + +static void enable_clock(struct device *dev, const char *con_id) +{ + struct clk *clk; + + clk = clk_get(dev, con_id); + if (!IS_ERR(clk)) { + clk_prepare_enable(clk); + clk_put(clk); + } +} + +static void disable_clock(struct device *dev, const char *con_id) +{ + struct clk *clk; + + clk = clk_get(dev, con_id); + if (!IS_ERR(clk)) { + clk_disable_unprepare(clk); + clk_put(clk); + } +} + +static int clk_notify(struct notifier_block *nb, unsigned long action, + void *data) +{ + int sz; + struct device *dev = data; + const char **con_id; + struct gdsc_notifier_block *gdsc_nb; + + if (!of_find_property(dev->of_node, "power-domains", &sz)) + return 0; + + gdsc_nb = container_of(nb, struct gdsc_notifier_block, nb); + + if (!gdsc_nb->con_ids[0]) + return 0; + + switch (action) { + case BUS_NOTIFY_BIND_DRIVER: + for (con_id = gdsc_nb->con_ids; *con_id; con_id++) + enable_clock(dev, *con_id); + break; + case BUS_NOTIFY_UNBOUND_DRIVER: + for (con_id = gdsc_nb->con_ids; *con_id; con_id++) + disable_clock(dev, *con_id); + break; + } + return 0; +} + +static struct gdsc_notifier_block gdsc_nb = { + .nb.notifier_call = clk_notify, + .con_ids = { NULL }, +}; + +static __init int qcom_pm_runtime_init(void) +{ + return bus_register_notifier(&platform_bus_type, &gdsc_nb.nb); +} +core_initcall(qcom_pm_runtime_init); +#endif -- QUALCOMM INDIA, on behalf of Qualcomm Innovation Center, Inc. is a member of Code Aurora Forum, hosted by The Linux Foundation -- To unsubscribe from this list: send the line "unsubscribe linux-arm-msm" in the body of a message to [email protected] More majordomo info at http://vger.kernel.org/majordomo-info.html
