From patchwork Tue Feb 18 15:34:43 2014 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Philipp Zabel X-Patchwork-Id: 321594 Return-Path: X-Original-To: incoming-imx@patchwork.ozlabs.org Delivered-To: patchwork-incoming-imx@bilbo.ozlabs.org Received: from casper.infradead.org (casper.infradead.org [IPv6:2001:770:15f::2]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by ozlabs.org (Postfix) with ESMTPS id 6A1172C0142 for ; Wed, 19 Feb 2014 04:52:34 +1100 (EST) Received: from merlin.infradead.org ([2001:4978:20e::2]) by casper.infradead.org with esmtps (Exim 4.80.1 #2 (Red Hat Linux)) id 1WFmja-00030Q-FV; Tue, 18 Feb 2014 15:37:23 +0000 Received: from localhost ([::1] helo=merlin.infradead.org) by merlin.infradead.org with esmtp (Exim 4.80.1 #2 (Red Hat Linux)) id 1WFmj3-00024y-7p; Tue, 18 Feb 2014 15:36:49 +0000 Received: from metis.ext.pengutronix.de ([2001:6f8:1178:4:290:27ff:fe1d:cc33]) by merlin.infradead.org with esmtps (Exim 4.80.1 #2 (Red Hat Linux)) id 1WFmhg-0001tR-3K for linux-arm-kernel@lists.infradead.org; Tue, 18 Feb 2014 15:35:30 +0000 Received: from pizza.hi.pengutronix.de ([10.1.0.104] helo=pizza.pengutronix.de.) by metis.ext.pengutronix.de with esmtp (Exim 4.72) (envelope-from ) id 1WFmhE-0004uq-Kz; Tue, 18 Feb 2014 16:34:56 +0100 From: Philipp Zabel To: Shawn Guo Subject: [PATCH v4 3/7] ARM: imx6: gpc: Add pm clock support to PU power domain Date: Tue, 18 Feb 2014 16:34:43 +0100 Message-Id: <1392737687-25003-4-git-send-email-p.zabel@pengutronix.de> X-Mailer: git-send-email 1.9.0.rc3 In-Reply-To: <1392737687-25003-1-git-send-email-p.zabel@pengutronix.de> References: <1392737687-25003-1-git-send-email-p.zabel@pengutronix.de> X-SA-Exim-Connect-IP: 10.1.0.104 X-SA-Exim-Mail-From: p.zabel@pengutronix.de X-SA-Exim-Scanned: No (on metis.ext.pengutronix.de); SAEximRunCond expanded to false X-PTX-Original-Recipient: linux-arm-kernel@lists.infradead.org X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20140218_103524_768003_A68EF5F7 X-CRM114-Status: GOOD ( 16.92 ) X-Spam-Score: -2.5 (--) X-Spam-Report: SpamAssassin version 3.3.2 on merlin.infradead.org summary: Content analysis details: (-2.5 points) pts rule name description ---- ---------------------- -------------------------------------------------- -0.6 RP_MATCHES_RCVD Envelope sender domain matches handover relay domain -1.9 BAYES_00 BODY: Bayes spam probability is 0 to 1% [score: 0.0000] Cc: Mark Rutland , devicetree@vger.kernel.org, kernel@pengutronix.de, Rob Herring , Philipp Zabel , linux-arm-kernel@lists.infradead.org X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.15 Precedence: list List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , MIME-Version: 1.0 Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+incoming-imx=patchwork.ozlabs.org@lists.infradead.org List-Id: linux-imx-kernel.lists.patchwork.ozlabs.org Drivers still handle clocks themselves, we only enable pm clocks of the GPU and VPU devices in the PU power domain temporarily during powerup so that the reset machinery can work. Signed-off-by: Philipp Zabel --- arch/arm/mach-imx/gpc.c | 74 +++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 74 insertions(+) diff --git a/arch/arm/mach-imx/gpc.c b/arch/arm/mach-imx/gpc.c index abddcc1..c126d22 100644 --- a/arch/arm/mach-imx/gpc.c +++ b/arch/arm/mach-imx/gpc.c @@ -18,6 +18,7 @@ #include #include #include +#include #include #include #include @@ -182,6 +183,7 @@ static int imx6q_pm_pu_power_off(struct generic_pm_domain *genpd) static int imx6q_pm_pu_power_on(struct generic_pm_domain *genpd) { + struct pm_domain_data *pdd; int ret; u32 val; int sw, sw2iso; @@ -192,6 +194,10 @@ static int imx6q_pm_pu_power_on(struct generic_pm_domain *genpd) return ret; } + /* Enable PM clocks for all devices in the PU domain */ + list_for_each_entry(pdd, &genpd->dev_list, list_node) + pm_clk_resume(pdd->dev); + /* Gate off PU domain when GPU/VPU when powered down */ writel_relaxed(0x1, gpc_base + GPC_PGC_GPU_PDN); @@ -208,6 +214,10 @@ static int imx6q_pm_pu_power_on(struct generic_pm_domain *genpd) /* Wait ISO + ISO2SW IPG clock cycles */ ndelay((sw + sw2iso) * 1000 / 66); + /* Disable PM clocks for all devices in the PU domain */ + list_for_each_entry(pdd, &genpd->dev_list, list_node) + pm_clk_suspend(pdd->dev); + return 0; } @@ -217,6 +227,68 @@ static struct generic_pm_domain imx6q_pu_domain = { .power_on = imx6q_pm_pu_power_on, }; +int imx6q_pm_clk_add(struct device *dev) +{ + struct device_node *np = dev->of_node; + const char *con_id; + struct clk *clk; + int i = 0; + + /* Add and prepare named clocks */ + while (!of_property_read_string_index(np, "clock-names", i, &con_id)) { + pm_clk_add(dev, con_id); + clk = of_clk_get(np, i); + if (!IS_ERR(clk)) { + clk_prepare(clk); + clk_put(clk); + } + i++; + } + + /* If no named clocks are given, add and prepare unnamed clock */ + if (i == 1 && of_find_property(dev->of_node, "clocks", NULL)) { + pm_clk_add(dev, NULL); + clk = of_clk_get(np, 0); + if (!IS_ERR(clk)) { + clk_prepare(clk); + clk_put(clk); + } + } + + return 0; +} + +int imx6q_pm_clk_remove(struct device *dev) +{ + struct device_node *np = dev->of_node; + const char *con_id; + struct clk *clk; + int i = 0; + + /* Remove and unprepare named clocks */ + while (!of_property_read_string_index(np, "clock-names", i, &con_id)) { + pm_clk_remove(dev, con_id); + clk = of_clk_get(np, i); + if (!IS_ERR(clk)) { + clk_unprepare(clk); + clk_put(clk); + } + i++; + } + + /* If no named clocks are given, remove and unprepare unnamed clock */ + if (i == 1 && of_find_property(dev->of_node, "clocks", NULL)) { + pm_clk_remove(dev, NULL); + clk = of_clk_get(np, 0); + if (!IS_ERR(clk)) { + clk_unprepare(clk); + clk_put(clk); + } + } + + return 0; +} + static int imx6q_pm_notifier_call(struct notifier_block *nb, unsigned long event, void *data) { @@ -235,6 +307,7 @@ static int imx6q_pm_notifier_call(struct notifier_block *nb, if (ret) dev_err(dev, "failed to add to power domain: %d\n", ret); + imx6q_pm_clk_add(dev); break; case BUS_NOTIFY_UNBOUND_DRIVER: genpd = dev_to_genpd(dev); @@ -245,6 +318,7 @@ static int imx6q_pm_notifier_call(struct notifier_block *nb, if (ret) dev_err(dev, "failed to remove from power domain: %d\n", ret); + imx6q_pm_clk_remove(dev); break; }