From patchwork Fri Mar 3 20:41:34 2017 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Lina Iyer X-Patchwork-Id: 9603513 Return-Path: Received: from mail.wl.linuxfoundation.org (pdx-wl-mail.web.codeaurora.org [172.30.200.125]) by pdx-korg-patchwork.web.codeaurora.org (Postfix) with ESMTP id 9BE6760414 for ; Fri, 3 Mar 2017 20:46:40 +0000 (UTC) Received: from mail.wl.linuxfoundation.org (localhost [127.0.0.1]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id 87A9628555 for ; Fri, 3 Mar 2017 20:46:40 +0000 (UTC) Received: by mail.wl.linuxfoundation.org (Postfix, from userid 486) id 7B3B228578; Fri, 3 Mar 2017 20:46:40 +0000 (UTC) X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on pdx-wl-mail.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-1.9 required=2.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID autolearn=unavailable version=3.3.1 Received: from bombadil.infradead.org (bombadil.infradead.org [65.50.211.133]) (using TLSv1.2 with cipher AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by mail.wl.linuxfoundation.org (Postfix) with ESMTPS id 01B0528555 for ; Fri, 3 Mar 2017 20:46:40 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=bombadil.20170209; h=Sender: Content-Transfer-Encoding:Content-Type:MIME-Version:Cc:List-Subscribe: List-Help:List-Post:List-Archive:List-Unsubscribe:List-Id:References: In-Reply-To:Message-Id:Date:Subject:To:From:Reply-To:Content-ID: Content-Description:Resent-Date:Resent-From:Resent-Sender:Resent-To:Resent-Cc :Resent-Message-ID:List-Owner; bh=I1HrYudA8YvOYhT0y5sewrINaKrpiTG3ZPKsyxjbj24=; b=AcpJGrictZbcEERw0oB/E+HnN4 X4+ooCM9Ktae04j01TElYdeoazGrR5aEBHIUTbYLh+g7pzrSUUEcgVSiC+CuY0BEY/02GIbXQizyV S58uQPLpu431Gd/YyY7mrJaXvXtxtU9jiXRPgp4Xrq7n0OA6DUSkMuQKenspEDo+b54kP6YV1pTIX Rd32Tpjw4OpN2W7HUX9rX0kk0BoNRGImFXi3CNrQhezZHhPMOrSQ4H6dbewpPCMwGsmzloJDuYPGX 5MkHIk5N2Tcm4tok7QUDhtZ19hI2DzM9Cv1GJmFH2AA7XtBt7hZkbIxaApR5vJphKAbekKyc6CZaH pf+9OqgQ==; Received: from localhost ([127.0.0.1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.87 #1 (Red Hat Linux)) id 1cju63-0000v6-GJ; Fri, 03 Mar 2017 20:46:39 +0000 Received: from mail-pg0-x22b.google.com ([2607:f8b0:400e:c05::22b]) by bombadil.infradead.org with esmtps (Exim 4.87 #1 (Red Hat Linux)) id 1cju1s-0004rZ-SK for linux-arm-kernel@lists.infradead.org; Fri, 03 Mar 2017 20:42:23 +0000 Received: by mail-pg0-x22b.google.com with SMTP id s67so47457241pgb.3 for ; Fri, 03 Mar 2017 12:42:00 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=linaro.org; s=google; h=from:to:cc:subject:date:message-id:in-reply-to:references; bh=AFy3Sr7gOSKdvfXzs08Y5f4f0cDRwhRTDKbEUGb/nrs=; b=gSmEQFAze5FzQ3te3bocuYE6AGXYSnre9x37TgHCbEuI8wYpFFkgxrSaE0mVScj1q1 Yu/7DnY0Ax7exbz1ecRapLHDTfdTiliHFOWUOF1CPEM3wgOMTYw8SlBRRFY0luBv2nyz LOJjwC4dRj9g0IPM8eMuoShiBv9S5HyLJqfys= X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:from:to:cc:subject:date:message-id:in-reply-to :references; bh=AFy3Sr7gOSKdvfXzs08Y5f4f0cDRwhRTDKbEUGb/nrs=; b=glHolgtbqM8yfaYOjOEmXgfK9BAgFtZw3bgGM7sksx26lty0j5Df9YA08fchqUMcF8 QFFJ+kOK4khutvygzhEENxsCNNzwd/KepueXgy8Uzmi1urjpgG7Vsi7JLsfC+ar7IlhI VsgPrTlw5YwLFI+7r1mcfq6x2n3Al7c2ET7OZBgfw0bXHuCGGwBZZiCYgZjD4FaTFNuG aqgsK41rPZLjQVdWXTu1oqZGGtw52fWo5WmAGHYVRWCQjOmKLegobdskBQEPcbWds1Yz dn8KwvD9DydpDdkPSbq2pIwxJ09CxeKpJ2Mv3qGTvN8yLGZiSntWsoM6GdzS8++i3z/e RQ8w== X-Gm-Message-State: AMke39nSE4jlvMKBtX50i5iFmbnroXsAI3bp4GDumH4NpAQDqpipTXMaCN1dlUpuqhbdH4Jo X-Received: by 10.98.62.82 with SMTP id l79mr5812217pfa.164.1488573719725; Fri, 03 Mar 2017 12:41:59 -0800 (PST) Received: from ubuntu.localdomain (i-global254.qualcomm.com. [199.106.103.254]) by smtp.gmail.com with ESMTPSA id o189sm25207003pga.12.2017.03.03.12.41.57 (version=TLS1_2 cipher=ECDHE-RSA-AES128-SHA bits=128/128); Fri, 03 Mar 2017 12:41:58 -0800 (PST) From: Lina Iyer To: ulf.hansson@linaro.org, khilman@kernel.org, rjw@rjwysocki.net, linux-pm@vger.kernel.org, linux-arm-kernel@lists.infradead.org Subject: [PATCH V5 8/9] PM / cpu_domains: Initialize CPU PM domains from DT Date: Fri, 3 Mar 2017 12:41:34 -0800 Message-Id: <1488573695-106680-9-git-send-email-lina.iyer@linaro.org> X-Mailer: git-send-email 2.7.4 In-Reply-To: <1488573695-106680-1-git-send-email-lina.iyer@linaro.org> References: <1488573695-106680-1-git-send-email-lina.iyer@linaro.org> X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20170303_124220_974650_1E42ED2F X-CRM114-Status: GOOD ( 18.00 ) X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.21 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Cc: lorenzo.pieralisi@arm.com, Juri.Lelli@arm.com, linux-arm-msm@vger.kernel.org, sboyd@codeaurora.org, brendan.jackman@arm.com, sudeep.holla@arm.com, andy.gross@linaro.org, Lina Iyer MIME-Version: 1.0 Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+patchwork-linux-arm=patchwork.kernel.org@lists.infradead.org X-Virus-Scanned: ClamAV using ClamSMTP Add helper functions to parse DT and initialize the CPU PM domains and attach CPU to their respective domains using information provided in the DT. For each CPU in the DT, we identify the domain provider; initialize and register the PM domain if isn't already registered and attach all the CPU devices to the domain. Usually, when there are multiple clusters of CPUs, there is a top level coherency domain that is dependent on these individual domains. All domains thus created are marked IRQ safe automatically and therefore may be powered down when the CPUs in the domain are powered down by cpuidle. Cc: Kevin Hilman Suggested-by: Ulf Hansson Signed-off-by: Lina Iyer --- drivers/base/power/cpu_domains.c | 210 +++++++++++++++++++++++++++++++++++++++ include/linux/cpu_domains.h | 20 ++++ 2 files changed, 230 insertions(+) diff --git a/drivers/base/power/cpu_domains.c b/drivers/base/power/cpu_domains.c index 4f2a40e..a566d84 100644 --- a/drivers/base/power/cpu_domains.c +++ b/drivers/base/power/cpu_domains.c @@ -13,8 +13,10 @@ #include #include #include +#include #include #include +#include #include #include #include @@ -268,3 +270,211 @@ int cpu_pd_init(struct generic_pm_domain *genpd, const struct cpu_pd_ops *ops) return ret; } EXPORT_SYMBOL(cpu_pd_init); + +#ifdef CONFIG_PM_GENERIC_DOMAINS_OF + +static struct generic_pm_domain *of_get_genpd(struct device_node *dn) +{ + struct cpu_pm_domain *pd; + struct generic_pm_domain *genpd = NULL; + + rcu_read_lock(); + list_for_each_entry_rcu(pd, &of_cpu_pd_list, link) + if (pd->genpd->provider == &dn->fwnode) { + genpd = pd->genpd; + break; + } + rcu_read_unlock(); + + return genpd; +} + +static struct generic_pm_domain *alloc_genpd(struct device_node *dn) +{ + struct generic_pm_domain *genpd; + + genpd = kzalloc(sizeof(*genpd), GFP_KERNEL); + if (!genpd) + return ERR_PTR(-ENOMEM); + + genpd->name = kstrndup(dn->full_name, CPU_PD_NAME_MAX, GFP_KERNEL); + if (!genpd->name) { + kfree(genpd); + return ERR_PTR(-ENOMEM); + } + + return genpd; +} + +/** + * of_init_cpu_pm_domain() - Initialize a CPU PM domain from a device node + * + * @dn: The domain provider's device node + * @ops: The power_on/_off callbacks for the domain + * + * Returns the generic_pm_domain (genpd) pointer to the domain on success + */ +static struct generic_pm_domain *of_init_cpu_pm_domain(struct device_node *dn, + const struct cpu_pd_ops *plat_ops) +{ + struct cpu_pm_domain *pd = NULL; + struct generic_pm_domain *genpd = NULL; + int ret = -ENOMEM; + struct genpd_power_state *states = NULL; + const struct cpu_pd_ops *ops = plat_ops; + int count; + int i; + + if (!of_device_is_available(dn)) + return ERR_PTR(-ENODEV); + + /* If we already have the PM domain return that */ + genpd = of_get_genpd(dn); + if (genpd) + return genpd; + + /* Initialize a new PM Domains */ + genpd = alloc_genpd(dn); + if (IS_ERR(genpd)) + return genpd; + + ret = of_genpd_parse_idle_states(dn, &states, &count); + if (ret) + goto fail; + if (!count) { + ops = NULL; + goto skip_states; + } + + /* Populate platform specific states from DT */ + for (i = 0; ops->populate_state_data && i < count; i++) { + ret = ops->populate_state_data(to_of_node(states[i].fwnode), + &states[i].param); + if (ret) + goto fail; + } + + genpd->states = states; + genpd->state_count = count; + +skip_states: + ret = cpu_pd_init(genpd, ops); + if (ret) + goto fail; + + ret = of_genpd_add_provider_simple(dn, genpd); + if (ret) + pr_warn("Unable to add genpd %s as provider\n", + pd->genpd->name); + + return genpd; +fail: + kfree(genpd->name); + kfree(genpd); + if (pd) + kfree(pd->cpus); + kfree(pd); + return ERR_PTR(ret); +} + +static struct generic_pm_domain *of_get_cpu_domain(struct device_node *dn, + const struct cpu_pd_ops *ops, int cpu) +{ + struct of_phandle_args args; + struct generic_pm_domain *genpd, *parent; + int ret; + + genpd = of_init_cpu_pm_domain(dn, ops); + if (IS_ERR(genpd)) + return genpd; + + /* Is there a domain provider for this domain? */ + ret = of_parse_phandle_with_args(dn, "power-domains", + "#power-domain-cells", 0, &args); + if (ret < 0) + goto skip_parent; + + /* Find its parent and attach this domain to it, recursively */ + parent = of_get_cpu_domain(args.np, ops, cpu); + if (IS_ERR(parent)) + goto skip_parent; + + ret = cpu_pd_attach_domain(parent, genpd); + if (ret) + pr_err("Unable to attach domain %s to parent %s\n", + genpd->name, parent->name); + +skip_parent: + of_node_put(dn); + return genpd; +} + +/** + * of_setup_cpu_pd_single() - Setup the PM domains for a CPU + * + * @cpu: The CPU for which the PM domain is to be set up. + * @ops: The PM domain suspend/resume ops for the CPU's domain + * + * If the CPU PM domain exists already, then the CPU is attached to + * that CPU PD. If it doesn't, the domain is created, the @ops are + * set for power_on/power_off callbacks and then the CPU is attached + * to that domain. If the domain was created outside this framework, + * then we do not attach the CPU to the domain. + */ +int of_setup_cpu_pd_single(int cpu, const struct cpu_pd_ops *ops) +{ + + struct device_node *dn, *np; + struct generic_pm_domain *genpd; + struct cpu_pm_domain *cpu_pd; + + np = of_get_cpu_node(cpu, NULL); + if (!np) + return -ENODEV; + + dn = of_parse_phandle(np, "power-domains", 0); + of_node_put(np); + if (!dn) + return -ENODEV; + + /* Find the genpd for this CPU, create if not found */ + genpd = of_get_cpu_domain(dn, ops, cpu); + of_node_put(dn); + if (IS_ERR(genpd)) + return PTR_ERR(genpd); + + cpu_pd = to_cpu_pd(genpd); + if (!cpu_pd) { + pr_err("%s: Genpd was created outside CPU PM domains\n", + __func__); + return -ENOENT; + } + + return cpu_pd_attach_cpu(genpd, cpu); +} +EXPORT_SYMBOL(of_setup_cpu_pd_single); + +/** + * of_setup_cpu_pd() - Setup the PM domains for all CPUs + * + * @ops: The PM domain suspend/resume ops for all the domains + * + * Setup the CPU PM domain and attach all possible CPUs to their respective + * domains. The domains are created if not already and then attached. + */ +int of_setup_cpu_pd(const struct cpu_pd_ops *ops) +{ + int cpu; + int ret; + + for_each_possible_cpu(cpu) { + ret = of_setup_cpu_pd_single(cpu, ops); + if (ret) + break; + } + + return ret; +} +EXPORT_SYMBOL(of_setup_cpu_pd); + +#endif /* CONFIG_PM_GENERIC_DOMAINS_OF */ diff --git a/include/linux/cpu_domains.h b/include/linux/cpu_domains.h index 7e71291..251fbc2 100644 --- a/include/linux/cpu_domains.h +++ b/include/linux/cpu_domains.h @@ -15,8 +15,12 @@ struct generic_pm_domain; struct cpumask; +struct device_node; struct cpu_pd_ops { +#ifdef CONFIG_PM_GENERIC_DOMAINS_OF + int (*populate_state_data)(struct device_node *n, u32 *param); +#endif int (*power_off)(u32 state_idx, u32 param, const struct cpumask *mask); int (*power_on)(void); }; @@ -45,4 +49,20 @@ static inline int cpu_pd_attach_cpu(struct generic_pm_domain *genpd, int cpu) #endif /* CONFIG_PM_GENERIC_DOMAINS */ +#ifdef CONFIG_PM_GENERIC_DOMAINS_OF + +int of_setup_cpu_pd_single(int cpu, const struct cpu_pd_ops *ops); + +int of_setup_cpu_pd(const struct cpu_pd_ops *ops); + +#else + +static inline int of_setup_cpu_pd_single(int cpu, const struct cpu_pd_ops *ops) +{ return -ENODEV; } + +static inline int of_setup_cpu_pd(const struct cpu_pd_ops *ops) +{ return -ENODEV; } + +#endif /* CONFIG_PM_GENERIC_DOMAINS_OF */ + #endif /* __CPU_DOMAINS_H__ */