From patchwork Fri Jun 19 02:49:15 2015 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Scott Wood X-Patchwork-Id: 486562 Return-Path: X-Original-To: patchwork-incoming@ozlabs.org Delivered-To: patchwork-incoming@ozlabs.org Received: from lists.ozlabs.org (lists.ozlabs.org [103.22.144.68]) (using TLSv1.2 with cipher AECDH-AES256-SHA (256/256 bits)) (No client certificate requested) by ozlabs.org (Postfix) with ESMTPS id 76C2D14016A for ; Fri, 19 Jun 2015 12:56:23 +1000 (AEST) Received: from ozlabs.org (lists.ozlabs.org [IPv6:2401:3900:2:1::3]) by lists.ozlabs.org (Postfix) with ESMTP id 5CDC71A1CF7 for ; Fri, 19 Jun 2015 12:56:23 +1000 (AEST) X-Original-To: linuxppc-dev@lists.ozlabs.org Delivered-To: linuxppc-dev@lists.ozlabs.org Received: from na01-by2-obe.outbound.protection.outlook.com (mail-by2on0122.outbound.protection.outlook.com [207.46.100.122]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-SHA384 (256/256 bits)) (No client certificate requested) by lists.ozlabs.org (Postfix) with ESMTPS id EFB1C1A0F36 for ; Fri, 19 Jun 2015 12:49:43 +1000 (AEST) Authentication-Results: linaro.org; dkim=none (message not signed) header.d=none; Received: from snotra.am.freescale.net (192.88.168.50) by BLUPR03MB1475.namprd03.prod.outlook.com (10.163.81.17) with Microsoft SMTP Server (TLS) id 15.1.190.14; Fri, 19 Jun 2015 02:49:37 +0000 From: Scott Wood To: Mike Turquette , Tang Yuantian Subject: [RFC PATCH 5/8] clk: qoriq: Redirect legacy clock nodes to new clocks Date: Thu, 18 Jun 2015 21:49:15 -0500 Message-ID: <1434682158-7243-6-git-send-email-scottwood@freescale.com> X-Mailer: git-send-email 2.1.4 In-Reply-To: <1434682158-7243-1-git-send-email-scottwood@freescale.com> References: <1434682158-7243-1-git-send-email-scottwood@freescale.com> MIME-Version: 1.0 X-Originating-IP: [192.88.168.50] X-ClientProxiedBy: BLUPR08CA0070.namprd08.prod.outlook.com (10.141.200.50) To BLUPR03MB1475.namprd03.prod.outlook.com (25.163.81.17) X-Microsoft-Exchange-Diagnostics: 1; BLUPR03MB1475; 2:8LQWQ5SnqbW1SBQA3SlV9eBsxyxtQ3lt7HIzMOYrxNjY6a6ZJCAqkjwR7oH5KCE0; 2:ZVdQo+U+6thWv5heHGCLEuASV6Uoy1mD7Qb6GYJHXPO3tI4cEC13V4IWRmB2mf60gg+yzBfv7b+fMd4lE6SmeL6hzXkTfukh+sTUC/ITfHvIxz119YRUAEEtYzxQEUebWoDssDGT3W9qKotzseQhuw==; 6:7sbb1vWpSkhAC5qlhxwqNvuhNY9Omq0GkoPVg8YZzRGi0FIk9gg/9SPLxFUZvVL4eT8MREQjuIbmXIZpAWBqibkhDem1xvGr7mcQppAbvEXyEq6mR4njLwfy6u6/APpzd0z2QI0nCA6KwWRLSiYxKcmj2m4Lpa2xHQVD9NVH5VPNqc10reWxluy++q/zvG+TVYwayo/LBzNKuzvwhDwFXdcVXj2VeHg6P9wYEuI/UxVt7Hvpzgh+jFSn5AbYfd73olm14Qk8SghqEfVVITkG9aKz4TTcFhHUJ2LH+jbw9wnvK1Ypcg3kO8WOMOou+A8JH+RSy7FTI6GDeWtqLXWrbZyswIoJjeEJ9zCh0KoatA8+qlHIS9ZWuFQcYtKKArhWln2O5Fe7sNGA1zRn8pacxVOj+dJ7XMztc38dUblZHW33lPJ3aMyGSWzBnO7Y3erF2ll7iRNvCVVqkY2GcrbsLhfxrdcX4aQDfbx7KM0wvSn3z8rbpD7pR/Ouxx3jnW9iDFMZ9sBzQ8e7BJw8r5IMiLj13N78I8G5D+QThI1lUc59aH2MxyWFv2kxsUXI850eyQV3J1WVueAZVpKCxoXv8Mm2w+eEIOBx5bbbWvKNyOs= X-Microsoft-Antispam: UriScan:;BCL:0;PCL:0;RULEID:;SRVR:BLUPR03MB1475; X-Microsoft-Antispam-PRVS: X-Exchange-Antispam-Report-Test: UriScan:; X-Exchange-Antispam-Report-CFA-Test: BCL:0; PCL:0; RULEID:(601004)(5005006)(3002001); SRVR:BLUPR03MB1475; BCL:0; PCL:0; RULEID:; SRVR:BLUPR03MB1475; X-Microsoft-Exchange-Diagnostics: 1; BLUPR03MB1475; 3:i3p/inm6SYzBaBJxeW6jVKH0NoCwzsbADomABbKrzLvB4W5g2MtrUK1UkrvKAwChBzrZ8lusMVqOJNAIHdwbvIbnMbLTipIp1O/Za3qCvVSBtPDf6HWXHgCsCFpdAyiTdW5TcPfWLRGDVLx0gpc6aZ2ob5DFJUZtuc7SQbbB/IucCYsAsDsZp++TsHxLf9zeeJWgg/sUtKU+jPfkIhJIJT27S3VtAYaM0QTc6Bwm7YNwZGVgt8lVFaiYB/ophGyeUnHGy2PEh+8CWwPkPH5aza+RhxGcSaw50Ys0XLyws54= X-Forefront-PRVS: 0612E553B4 X-Forefront-Antispam-Report: SFV:NSPM; SFS:(10019020)(6009001)(86362001)(77096005)(33646002)(76176999)(40100003)(87976001)(122386002)(36756003)(50466002)(189998001)(50986999)(50226001)(92566002)(48376002)(62966003)(77156002)(229853001)(42186005)(5001960100002)(19580395003)(107886002)(2950100001)(46102003)(66066001)(19580405001)(47776003)(5001770100001)(4001450100001)(217873001)(4001430100001); DIR:OUT; SFP:1102; SCL:1; SRVR:BLUPR03MB1475; H:snotra.am.freescale.net; FPR:; SPF:None; MLV:sfv; LANG:en; X-Microsoft-Exchange-Diagnostics: 1; BLUPR03MB1475; 9:/Jn1aF8mzH3bjy3XotXl1sBZ0UFzeU11B8rBEnOcwrbtKIDO1kobq6cIjCOCnTT9NY64WRCyzY7YZUkQ1+VHJl8S5I6vMHoEvgzYJWthQBRf0clcq01FcCkkPEDn+rpIkEMPZWfSvPtMRySxkP71c2yIS+5LHZyn+2b8g9sU6l8LXdKrN4CpComu2CC5G9BqXVaorW7gC7iEv6Lm+qUdkjyl/omoe1pCqZu6Uic5RJgOFvwTNfg0/yQHfSWJtiYAZ5fTYo93r3TVBvtPVLYRf/cZvHZ8kVdN8Ui4+ZxaHdZ8sqzc8mCxIuYbN6olI/tCevvUHV4UtBCUt7pDujoXKVXGDtBFFq5NkitdxmGOKLBUwxApJRomP54dsE/WkM9gn6jsidk++yAZJcszRcVO3NTs1ie5gFzmW6WpNTKHpRrxAFS/hQntT5Ypph3mm7T2mt5/mFTDUBdg36VNLESvw3K8B/xhj3emXzeTsptnIujBH9E6hXsYzngzdL3oTLU4IXpG/gbTm0ezeQzZPfjQMaQwUE0SbxEPCc/DI6K52w4rOzMk+xynDveCsCTxdryeayVcUUnDqfyUrWth8mcQPTqmmOfSC8lP1wjy/eyyxhIKoQazv0KhHWY++npTcAO+S3Mx1AovMrMeCVQ2I8S4J461QtZN6KFRSidW5YBHskvVwNdeel7gpLHE2u0u2Pc6H3rk04ip6R26ifVlSrE2I0zxAa57Nom2/urGsV3juP77jUTioydPhlQ52te5QmJQtEh7AszYDgObYu0yL4uj3FYAuvehnWQHLRE2edOb+rcgR6R0RNKtV0ZmrA1CdfxWXQCMD3xxP4gMuYFBChG80KbT94Ix02YA3XMXVBFcSl5Iz4IieVhh8BvIgQwvIPgk X-Microsoft-Exchange-Diagnostics: 1; BLUPR03MB1475; 3:sBaxqxs1WpmVeOBrEp1+9gnu6jv1Xw/jcx4+LSnSxNjUQw+gT3+5Jln/hUo9T03rbVUtkiT0T1nQG/62uMvnWS4LYsCrj66OsoqsZjJV9dDKYfI5KWpTd4aVnH7hIyztIfSzDF7niDo2uk2wLfx4iw==; 10:EfMJxZvWnFeWFohJpc4+CJLWQnC1z1elXK1FkodOjpdZzvaFHJwCXe7ZlOknXA1ydUlMsUPG1IVh0kWZ9ZXotKRr1T3WWW6EqRz4sPpjScE=; 6:fL7quW88/nj9T1YBnSl7WAZyUVsiPC74j35prkWXiE5pWbhu37JHtcamAkjB7hiY X-OriginatorOrg: freescale.com X-MS-Exchange-CrossTenant-OriginalArrivalTime: 19 Jun 2015 02:49:37.7598 (UTC) X-MS-Exchange-CrossTenant-FromEntityHeader: Hosted X-MS-Exchange-Transport-CrossTenantHeadersStamped: BLUPR03MB1475 X-BeenThere: linuxppc-dev@lists.ozlabs.org X-Mailman-Version: 2.1.20 Precedence: list List-Id: Linux on PowerPC Developers Mail List List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Cc: devicetree@vger.kernel.org, linux-pm@vger.kernel.org, "Rafael J. Wysocki" , Liberman Igal-B31950 , Scott Wood , linuxppc-dev@lists.ozlabs.org, linux-clk@vger.kernel.org, linux-arm-kernel@lists.infradead.org, Bucur Madalin-Cristian-B32716 Errors-To: linuxppc-dev-bounces+patchwork-incoming=ozlabs.org@lists.ozlabs.org Sender: "Linuxppc-dev" Having multiple clock implementations pointing at the same hardware is asking for trouble if both get used -- for example, cached values will be incorrect. Point the legacy nodes at the new clocks, before anything starts using the new clocks. The pll/mux details in old device trees will be ignored, but "clocks" properties pointing at the old nodes will still work. This also lets us get rid of most of the legacy code. Signed-off-by: Scott Wood --- drivers/clk/clk-qoriq.c | 348 ++++++++---------------------------------------- 1 file changed, 54 insertions(+), 294 deletions(-) diff --git a/drivers/clk/clk-qoriq.c b/drivers/clk/clk-qoriq.c index b94dc2f..f6aa106 100644 --- a/drivers/clk/clk-qoriq.c +++ b/drivers/clk/clk-qoriq.c @@ -763,233 +763,24 @@ static void __init create_muxes(struct clockgen *cg) } /* Legacy node */ -struct cmux_clk { - struct clk_hw hw; - void __iomem *reg; - unsigned int clk_per_pll; - u32 flags; -}; - -#define PLL_KILL BIT(31) -#define CLKSEL_ADJUST BIT(0) -#define to_cmux_clk(p) container_of(p, struct cmux_clk, hw) - -static int cmux_set_parent(struct clk_hw *hw, u8 idx) -{ - struct cmux_clk *clk = to_cmux_clk(hw); - u32 clksel; - - clksel = ((idx / clk->clk_per_pll) << 2) + idx % clk->clk_per_pll; - if (clk->flags & CLKSEL_ADJUST) - clksel += 8; - clksel = (clksel & 0xf) << CLKSEL_SHIFT; - iowrite32be(clksel, clk->reg); - - return 0; -} - -static u8 cmux_get_parent(struct clk_hw *hw) -{ - struct cmux_clk *clk = to_cmux_clk(hw); - u32 clksel; - - clksel = ioread32be(clk->reg); - clksel = (clksel >> CLKSEL_SHIFT) & 0xf; - if (clk->flags & CLKSEL_ADJUST) - clksel -= 8; - clksel = (clksel >> 2) * clk->clk_per_pll + clksel % 4; - - return clksel; -} - -static const struct clk_ops legacy_cmux_ops = { - .get_parent = cmux_get_parent, - .set_parent = cmux_set_parent, -}; - static void __init core_mux_init(struct device_node *np) { struct clk *clk; - struct clk_init_data init; - struct cmux_clk *cmux_clk; - struct device_node *node; - int rc, count, i; - u32 offset; - const char *clk_name; - const char **parent_names; - struct of_phandle_args clkspec; + struct resource res; + int idx, rc; - rc = of_property_read_u32(np, "reg", &offset); - if (rc) { - pr_err("%s: could not get reg property\n", np->name); + if (of_address_to_resource(np, 0, &res)) return; - } - - /* get the input clock source count */ - count = of_property_count_strings(np, "clock-names"); - if (count < 0) { - pr_err("%s: get clock count error\n", np->name); - return; - } - parent_names = kcalloc(count, sizeof(char *), GFP_KERNEL); - if (!parent_names) - return; - - for (i = 0; i < count; i++) - parent_names[i] = of_clk_get_parent_name(np, i); - - cmux_clk = kzalloc(sizeof(*cmux_clk), GFP_KERNEL); - if (!cmux_clk) - goto err_name; - cmux_clk->reg = of_iomap(np, 0); - if (!cmux_clk->reg) { - pr_err("%s: could not map register\n", __func__); - goto err_clk; - } - - rc = of_parse_phandle_with_args(np, "clocks", "#clock-cells", 0, - &clkspec); - if (rc) { - pr_err("%s: parse clock node error\n", __func__); - goto err_clk; - } - - cmux_clk->clk_per_pll = of_property_count_strings(clkspec.np, - "clock-output-names"); - of_node_put(clkspec.np); - - node = of_find_compatible_node(NULL, NULL, "fsl,p4080-clockgen"); - if (node && (offset >= 0x80)) - cmux_clk->flags = CLKSEL_ADJUST; - - rc = of_property_read_string_index(np, "clock-output-names", - 0, &clk_name); - if (rc) { - pr_err("%s: read clock names error\n", np->name); - goto err_clk; - } - - init.name = clk_name; - init.ops = &legacy_cmux_ops; - init.parent_names = parent_names; - init.num_parents = count; - init.flags = 0; - cmux_clk->hw.init = &init; - - clk = clk_register(NULL, &cmux_clk->hw); - if (IS_ERR(clk)) { - pr_err("%s: could not register clock\n", clk_name); - goto err_clk; - } + idx = (res.start & 0xf0) >> 5; + clk = clockgen.cmux[idx]; rc = of_clk_add_provider(np, of_clk_src_simple_get, clk); if (rc) { - pr_err("Could not register clock provider for node:%s\n", - np->name); - goto err_clk; - } - goto err_name; - -err_clk: - kfree(cmux_clk); -err_name: - /* free *_names because they are reallocated when registered */ - kfree(parent_names); -} - -/* Legacy node */ -static void __init core_pll_init(struct device_node *np) -{ - u32 mult; - int i, rc, count; - const char *clk_name, *parent_name; - struct clk_onecell_data *onecell_data; - struct clk **subclks; - void __iomem *base; - - base = of_iomap(np, 0); - if (!base) { - pr_err("iomap error\n"); + pr_err("%s: Couldn't register clk provider for node %s: %d\n", + __func__, np->name, rc); return; } - - /* get the multiple of PLL */ - mult = ioread32be(base); - - /* check if this PLL is disabled */ - if (mult & PLL_KILL) { - pr_debug("PLL:%s is disabled\n", np->name); - goto err_map; - } - mult = (mult >> 1) & 0x3f; - - parent_name = of_clk_get_parent_name(np, 0); - if (!parent_name) { - pr_err("PLL: %s must have a parent\n", np->name); - goto err_map; - } - - count = of_property_count_strings(np, "clock-output-names"); - if (count < 0 || count > 4) { - pr_err("%s: clock is not supported\n", np->name); - goto err_map; - } - - subclks = kcalloc(count, sizeof(struct clk *), GFP_KERNEL); - if (!subclks) - goto err_map; - - onecell_data = kmalloc(sizeof(*onecell_data), GFP_KERNEL); - if (!onecell_data) - goto err_clks; - - for (i = 0; i < count; i++) { - rc = of_property_read_string_index(np, "clock-output-names", - i, &clk_name); - if (rc) { - pr_err("%s: could not get clock names\n", np->name); - goto err_cell; - } - - /* - * when count == 4, there are 4 output clocks: - * /1, /2, /3, /4 respectively - * when count < 4, there are at least 2 output clocks: - * /1, /2, (/4, if count == 3) respectively. - */ - if (count == 4) - subclks[i] = clk_register_fixed_factor(NULL, clk_name, - parent_name, 0, mult, 1 + i); - else - - subclks[i] = clk_register_fixed_factor(NULL, clk_name, - parent_name, 0, mult, 1 << i); - - if (IS_ERR(subclks[i])) { - pr_err("%s: could not register clock\n", clk_name); - goto err_cell; - } - } - - onecell_data->clks = subclks; - onecell_data->clk_num = count; - - rc = of_clk_add_provider(np, of_clk_src_onecell_get, onecell_data); - if (rc) { - pr_err("Could not register clk provider for node:%s\n", - np->name); - goto err_cell; - } - - iounmap(base); - return; -err_cell: - kfree(onecell_data); -err_clks: - kfree(subclks); -err_map: - iounmap(base); } static struct clk * __init create_sysclk(struct device_node *clockgen, @@ -1027,21 +818,14 @@ static struct clk * __init create_sysclk(struct device_node *clockgen, /* Legacy node */ static void __init sysclk_init(struct device_node *node) { - struct device_node *np = of_get_parent(node); - struct clk *clk; + struct clk *clk = clockgen.sysclk; - if (!np) { - pr_err("could not get parent node\n"); - return; - } - - clk = create_sysclk(np, "sysclk"); - of_node_put(np); - - if (!IS_ERR(clk)) + if (clk) of_clk_add_provider(node, of_clk_src_simple_get, clk); } +#define PLL_KILL BIT(31) + static void __init create_one_pll(struct clockgen *cg, int idx) { u32 __iomem *reg; @@ -1097,85 +881,61 @@ static void __init create_plls(struct clockgen *cg) create_one_pll(cg, i); } -/* Legacy node */ -static void __init pltfrm_pll_init(struct device_node *np) +static void __init legacy_pll_init(struct device_node *np, int idx) { - void __iomem *base; - uint32_t mult; - const char *parent_name, *clk_name; - int i, _errno; - struct clk_onecell_data *cod; - - base = of_iomap(np, 0); - if (!base) { - pr_err("%s(): %s: of_iomap() failed\n", __func__, np->name); - return; - } - - /* Get the multiple of PLL */ - mult = ioread32be(base); - - iounmap(base); + struct clockgen_pll *pll; + struct clk_onecell_data *onecell_data; + struct clk **subclks; + int count, rc, i; - /* Check if this PLL is disabled */ - if (mult & PLL_KILL) { - pr_debug("%s(): %s: Disabled\n", __func__, np->name); - return; - } - mult = (mult & GENMASK(6, 1)) >> 1; + pll = &clockgen.pll[idx]; + count = ARRAY_SIZE(pll->div); - parent_name = of_clk_get_parent_name(np, 0); - if (!parent_name) { - pr_err("%s(): %s: of_clk_get_parent_name() failed\n", - __func__, np->name); + subclks = kcalloc(count, sizeof(struct clk *), GFP_KERNEL); + if (!subclks) return; - } - i = of_property_count_strings(np, "clock-output-names"); - if (i < 0) { - pr_err("%s(): %s: of_property_count_strings(clock-output-names) = %d\n", - __func__, np->name, i); - return; - } + onecell_data = kmalloc(sizeof(*onecell_data), GFP_KERNEL); + if (!onecell_data) + goto err_clks; - cod = kmalloc(sizeof(*cod) + i * sizeof(struct clk *), GFP_KERNEL); - if (!cod) - return; - cod->clks = (struct clk **)(cod + 1); - cod->clk_num = i; - - for (i = 0; i < cod->clk_num; i++) { - _errno = of_property_read_string_index(np, "clock-output-names", - i, &clk_name); - if (_errno < 0) { - pr_err("%s(): %s: of_property_read_string_index(clock-output-names) = %d\n", - __func__, np->name, _errno); - goto return_clk_unregister; - } + for (i = 0; i < count; i++) + subclks[i] = pll->div[i].clk; - cod->clks[i] = clk_register_fixed_factor(NULL, clk_name, - parent_name, 0, mult, 1 + i); - if (IS_ERR(cod->clks[i])) { - pr_err("%s(): %s: clk_register_fixed_factor(%s) = %ld\n", - __func__, np->name, - clk_name, PTR_ERR(cod->clks[i])); - goto return_clk_unregister; - } - } + onecell_data->clks = subclks; + onecell_data->clk_num = count; - _errno = of_clk_add_provider(np, of_clk_src_onecell_get, cod); - if (_errno < 0) { - pr_err("%s(): %s: of_clk_add_provider() = %d\n", - __func__, np->name, _errno); - goto return_clk_unregister; + rc = of_clk_add_provider(np, of_clk_src_onecell_get, onecell_data); + if (rc) { + pr_err("%s: Couldn't register clk provider for node %s: %d\n", + __func__, np->name, rc); + goto err_cell; } return; +err_cell: + kfree(onecell_data); +err_clks: + kfree(subclks); +} -return_clk_unregister: - while (--i >= 0) - clk_unregister(cod->clks[i]); - kfree(cod); +/* Legacy node */ +static void __init core_pll_init(struct device_node *np) +{ + struct resource res; + int idx; + + if (of_address_to_resource(np, 0, &res)) + return; + + idx = (res.start & 0xf0) >> 5; + legacy_pll_init(np, CGA_PLL1 + idx); +} + +/* Legacy node */ +static void __init pltfrm_pll_init(struct device_node *np) +{ + legacy_pll_init(np, PLATFORM_PLL); } #ifdef CONFIG_PPC