From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org Received: from bombadil.infradead.org (bombadil.infradead.org [198.137.202.133]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.lore.kernel.org (Postfix) with ESMTPS id DDAE1C5321D for ; Mon, 26 Aug 2024 12:42:55 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=bombadil.20210309; h=Sender:List-Subscribe:List-Help :List-Post:List-Archive:List-Unsubscribe:List-Id:Content-Transfer-Encoding: Content-Type:MIME-Version:References:In-Reply-To:Message-ID:Subject:Cc:From: To:Date:Reply-To:Content-ID:Content-Description:Resent-Date:Resent-From: Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID:List-Owner; bh=0DFY+wLkYuEWyBy/mhSUmuzkOWFdO8lFfTnXo28Nt74=; b=X0cHY/wq/CcN+dc4u4rls0kcL/ lxJq6doW2XN8fPnAvVpbOEhO2E2fFFWXn18Zfu/VCvq3rvDn1JvL19cphLUH9uI3tBHPtKRwy2WoF e0O5s/fPlHjxTxoQzzyvQJLrCaicIWKfnlcmrS3GUO3rNmVm65oNYcP5T3ic9wZIdHv7vdSjfiYoG 7VTrBGdL2pMCDwr1/r4+mG9y0ldnlFWhdreyX4B0FVshCqg5ydMHszU0Z0YTVPAfVLkEGhlR668pe n8LBd/Uh35C/StIrVAK00CiOyEUDiC01VTHlWYOh99pp85hGlsBatATcrkfHcaZn/WJ00VS0sBVk1 qCoqBuAw==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.97.1 #2 (Red Hat Linux)) id 1siZ3V-00000007LzY-0iI6; Mon, 26 Aug 2024 12:42:45 +0000 Received: from mail-40134.protonmail.ch ([185.70.40.134]) by bombadil.infradead.org with esmtps (Exim 4.97.1 #2 (Red Hat Linux)) id 1siYzP-00000007Kpm-1gv7 for linux-arm-kernel@lists.infradead.org; Mon, 26 Aug 2024 12:38:33 +0000 DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=protonmail.com; s=protonmail3; t=1724675908; x=1724935108; bh=0DFY+wLkYuEWyBy/mhSUmuzkOWFdO8lFfTnXo28Nt74=; h=Date:To:From:Cc:Subject:Message-ID:In-Reply-To:References: Feedback-ID:From:To:Cc:Date:Subject:Reply-To:Feedback-ID: Message-ID:BIMI-Selector; b=HjEsGjgf7W37hkP1e5QLGoI0+JYT5Uf7dmKXwDzgBTfU4bV4ON5OjRMfm3IacW5BT SoYLHbxQt07XGk5rtFdPNAJO3MgtmWF2l2COlFX/pJX4PMMdQr90EiuoCQL9ARxPnE olqXL5ptOWeAmhTkLMYd1TfqIO7APF74Mo8kvkEQsR9VTyf63nsb74ztgPuf3CZBs/ VrRMzUBDslq83Av8BpZV1nMv8njthYTsBGMgNBPAd10l4dQAwSdpdlyyVazJz/3LcU aR+6uXulhQ5VE8YTViSrrqL18C05H5PaRrqQBLfa15Jp3a2fzd9DS4FcLJKNkFOMY+ 7bdqNqg8ON01A== Date: Mon, 26 Aug 2024 12:38:24 +0000 To: Michael Turquette , Stephen Boyd , Rob Herring , Krzysztof Kozlowski , Conor Dooley , Michal Simek , Greg Kroah-Hartman From: Harry Austen Cc: Shubhrajyoti Datta , Dave Ertman , Ira Weiny , linux-clk@vger.kernel.org, devicetree@vger.kernel.org, linux-kernel@vger.kernel.org, linux-arm-kernel@lists.infradead.org, Harry Austen Subject: [PATCH v3 4/9] clk: clocking-wizard: move clock registration to separate function Message-ID: <20240826123602.1872-5-hpausten@protonmail.com> In-Reply-To: <20240826123602.1872-1-hpausten@protonmail.com> References: <20240826123602.1872-1-hpausten@protonmail.com> Feedback-ID: 53116287:user:proton X-Pm-Message-ID: 45e8454da06f098c8983fadc75a227a513988076 MIME-Version: 1.0 Content-Type: text/plain; charset=utf-8 Content-Transfer-Encoding: quoted-printable X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20240826_053831_670668_16B6BEE7 X-CRM114-Status: UNSURE ( 9.34 ) X-CRM114-Notice: Please train this message. X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.34 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+linux-arm-kernel=archiver.kernel.org@lists.infradead.org Provide clear separation of dynamic reconfiguration logic, by moving its setup procedure to its own dedicated function. Signed-off-by: Harry Austen --- drivers/clk/xilinx/clk-xlnx-clock-wizard.c | 143 +++++++++++---------- 1 file changed, 75 insertions(+), 68 deletions(-) diff --git a/drivers/clk/xilinx/clk-xlnx-clock-wizard.c b/drivers/clk/xilin= x/clk-xlnx-clock-wizard.c index f332e0eee56c8..1a65a7d153c35 100644 --- a/drivers/clk/xilinx/clk-xlnx-clock-wizard.c +++ b/drivers/clk/xilinx/clk-xlnx-clock-wizard.c @@ -962,72 +962,30 @@ static const struct versal_clk_data versal_data =3D { =09.is_versal=09=3D true, }; =20 -static int clk_wzrd_probe(struct platform_device *pdev) +static int clk_wzrd_register_output_clocks(struct device *dev, int nr_outp= uts) { =09const char *clkout_name, *clk_name, *clk_mul_name; +=09struct clk_wzrd *clk_wzrd =3D dev_get_drvdata(dev); =09u32 regl, regh, edge, regld, reghd, edged, div; -=09struct device_node *np =3D pdev->dev.of_node; =09const struct versal_clk_data *data; -=09struct clk_wzrd *clk_wzrd; =09unsigned long flags =3D 0; +=09bool is_versal =3D false; =09void __iomem *ctrl_reg; =09u32 reg, reg_f, mult; -=09bool is_versal =3D false; -=09unsigned long rate; -=09int nr_outputs; -=09int i, ret; - -=09ret =3D of_property_read_u32(np, "xlnx,nr-outputs", &nr_outputs); -=09if (ret || nr_outputs > WZRD_NUM_OUTPUTS) -=09=09return -EINVAL; - -=09clk_wzrd =3D devm_kzalloc(&pdev->dev, struct_size(clk_wzrd, clk_data.hw= s, nr_outputs), -=09=09=09=09GFP_KERNEL); -=09if (!clk_wzrd) -=09=09return -ENOMEM; -=09platform_set_drvdata(pdev, clk_wzrd); - -=09clk_wzrd->base =3D devm_platform_ioremap_resource(pdev, 0); -=09if (IS_ERR(clk_wzrd->base)) -=09=09return PTR_ERR(clk_wzrd->base); - -=09ret =3D of_property_read_u32(np, "xlnx,speed-grade", &clk_wzrd->speed_g= rade); -=09if (!ret) { -=09=09if (clk_wzrd->speed_grade < 1 || clk_wzrd->speed_grade > 3) { -=09=09=09dev_warn(&pdev->dev, "invalid speed grade '%d'\n", -=09=09=09=09 clk_wzrd->speed_grade); -=09=09=09clk_wzrd->speed_grade =3D 0; -=09=09} -=09} - -=09clk_wzrd->clk_in1 =3D devm_clk_get(&pdev->dev, "clk_in1"); -=09if (IS_ERR(clk_wzrd->clk_in1)) -=09=09return dev_err_probe(&pdev->dev, PTR_ERR(clk_wzrd->clk_in1), -=09=09=09=09 "clk_in1 not found\n"); +=09int i; =20 -=09clk_wzrd->axi_clk =3D devm_clk_get_enabled(&pdev->dev, "s_axi_aclk"); -=09if (IS_ERR(clk_wzrd->axi_clk)) -=09=09return dev_err_probe(&pdev->dev, PTR_ERR(clk_wzrd->axi_clk), -=09=09=09=09 "s_axi_aclk not found\n"); -=09rate =3D clk_get_rate(clk_wzrd->axi_clk); -=09if (rate > WZRD_ACLK_MAX_FREQ) { -=09=09dev_err(&pdev->dev, "s_axi_aclk frequency (%lu) too high\n", -=09=09=09rate); -=09=09return -EINVAL; -=09} - -=09data =3D device_get_match_data(&pdev->dev); +=09data =3D device_get_match_data(dev); =09if (data) =09=09is_versal =3D data->is_versal; =20 -=09clkout_name =3D devm_kasprintf(&pdev->dev, GFP_KERNEL, "%s_out0", dev_n= ame(&pdev->dev)); +=09clkout_name =3D devm_kasprintf(dev, GFP_KERNEL, "%s_out0", dev_name(dev= )); =09if (!clkout_name) =09=09return -ENOMEM; =20 =09if (is_versal) { =09=09if (nr_outputs =3D=3D 1) { =09=09=09clk_wzrd->clk_data.hws[0] =3D clk_wzrd_ver_register_divider -=09=09=09=09(&pdev->dev, clkout_name, +=09=09=09=09(dev, clkout_name, =09=09=09=09__clk_get_name(clk_wzrd->clk_in1), 0, =09=09=09=09clk_wzrd->base, WZRD_CLK_CFG_REG(is_versal, 3), =09=09=09=09WZRD_CLKOUT_DIVIDE_SHIFT, @@ -1035,7 +993,7 @@ static int clk_wzrd_probe(struct platform_device *pdev= ) =09=09=09=09CLK_DIVIDER_ONE_BASED | CLK_DIVIDER_ALLOW_ZERO, =09=09=09=09DIV_ALL, &clkwzrd_lock); =20 -=09=09=09goto out; +=09=09=09return 0; =09=09} =09=09/* register multiplier */ =09=09edge =3D !!(readl(clk_wzrd->base + WZRD_CLK_CFG_REG(is_versal, 0)) & @@ -1060,7 +1018,7 @@ static int clk_wzrd_probe(struct platform_device *pde= v) =09} else { =09=09if (nr_outputs =3D=3D 1) { =09=09=09clk_wzrd->clk_data.hws[0] =3D clk_wzrd_register_divider -=09=09=09=09(&pdev->dev, clkout_name, +=09=09=09=09(dev, clkout_name, =09=09=09=09__clk_get_name(clk_wzrd->clk_in1), 0, =09=09=09=09clk_wzrd->base, WZRD_CLK_CFG_REG(is_versal, 3), =09=09=09=09WZRD_CLKOUT_DIVIDE_SHIFT, @@ -1068,7 +1026,7 @@ static int clk_wzrd_probe(struct platform_device *pde= v) =09=09=09=09CLK_DIVIDER_ONE_BASED | CLK_DIVIDER_ALLOW_ZERO, =09=09=09=09DIV_ALL, &clkwzrd_lock); =20 -=09=09=09goto out; +=09=09=09return 0; =09=09} =09=09reg =3D readl(clk_wzrd->base + WZRD_CLK_CFG_REG(is_versal, 0)); =09=09reg_f =3D reg & WZRD_CLKFBOUT_FRAC_MASK; @@ -1079,19 +1037,19 @@ static int clk_wzrd_probe(struct platform_device *p= dev) =09=09mult =3D (reg * 1000) + reg_f; =09=09div =3D 1000; =09} -=09clk_name =3D devm_kasprintf(&pdev->dev, GFP_KERNEL, "%s_mul", dev_name(= &pdev->dev)); +=09clk_name =3D devm_kasprintf(dev, GFP_KERNEL, "%s_mul", dev_name(dev)); =09if (!clk_name) =09=09return -ENOMEM; =09clk_wzrd->clks_internal[wzrd_clk_mul] =3D devm_clk_hw_register_fixed_fa= ctor -=09=09=09(&pdev->dev, clk_name, +=09=09=09(dev, clk_name, =09=09=09 __clk_get_name(clk_wzrd->clk_in1), =09=09=090, mult, div); =09if (IS_ERR(clk_wzrd->clks_internal[wzrd_clk_mul])) { -=09=09dev_err(&pdev->dev, "unable to register fixed-factor clock\n"); +=09=09dev_err(dev, "unable to register fixed-factor clock\n"); =09=09return PTR_ERR(clk_wzrd->clks_internal[wzrd_clk_mul]); =09} =20 -=09clk_name =3D devm_kasprintf(&pdev->dev, GFP_KERNEL, "%s_mul_div", dev_n= ame(&pdev->dev)); +=09clk_name =3D devm_kasprintf(dev, GFP_KERNEL, "%s_mul_div", dev_name(dev= )); =09if (!clk_name) =09=09return -ENOMEM; =20 @@ -1108,31 +1066,29 @@ static int clk_wzrd_probe(struct platform_device *p= dev) =20 =09=09clk_mul_name =3D clk_hw_get_name(clk_wzrd->clks_internal[wzrd_clk_mu= l]); =09=09clk_wzrd->clks_internal[wzrd_clk_mul_div] =3D -=09=09=09devm_clk_hw_register_fixed_factor(&pdev->dev, clk_name, -=09=09=09=09=09=09=09 clk_mul_name, 0, 1, div); +=09=09=09devm_clk_hw_register_fixed_factor(dev, clk_name, clk_mul_name, 0,= 1, div); =09} else { =09=09ctrl_reg =3D clk_wzrd->base + WZRD_CLK_CFG_REG(is_versal, 0); =09=09clk_wzrd->clks_internal[wzrd_clk_mul_div] =3D devm_clk_hw_register_d= ivider -=09=09=09(&pdev->dev, clk_name, +=09=09=09(dev, clk_name, =09=09=09 clk_hw_get_name(clk_wzrd->clks_internal[wzrd_clk_mul]), =09=09=09flags, ctrl_reg, 0, 8, CLK_DIVIDER_ONE_BASED | =09=09=09CLK_DIVIDER_ALLOW_ZERO, &clkwzrd_lock); =09} =09if (IS_ERR(clk_wzrd->clks_internal[wzrd_clk_mul_div])) { -=09=09dev_err(&pdev->dev, "unable to register divider clock\n"); +=09=09dev_err(dev, "unable to register divider clock\n"); =09=09return PTR_ERR(clk_wzrd->clks_internal[wzrd_clk_mul_div]); =09} =20 =09/* register div per output */ =09for (i =3D nr_outputs - 1; i >=3D 0 ; i--) { -=09=09clkout_name =3D devm_kasprintf(&pdev->dev, GFP_KERNEL, -=09=09=09=09=09 "%s_out%d", dev_name(&pdev->dev), i); +=09=09clkout_name =3D devm_kasprintf(dev, GFP_KERNEL, "%s_out%d", dev_name= (dev), i); =09=09if (!clkout_name) =09=09=09return -ENOMEM; =20 =09=09if (is_versal) { =09=09=09clk_wzrd->clk_data.hws[i] =3D clk_wzrd_ver_register_divider -=09=09=09=09=09=09(&pdev->dev, +=09=09=09=09=09=09(dev, =09=09=09=09=09=09 clkout_name, clk_name, 0, =09=09=09=09=09=09 clk_wzrd->base, =09=09=09=09=09=09 (WZRD_CLK_CFG_REG(is_versal, 3) + i * 8), @@ -1144,7 +1100,7 @@ static int clk_wzrd_probe(struct platform_device *pde= v) =09=09} else { =09=09=09if (!i) =09=09=09=09clk_wzrd->clk_data.hws[i] =3D clk_wzrd_register_divf -=09=09=09=09=09(&pdev->dev, clkout_name, clk_name, flags, clk_wzrd->base, +=09=09=09=09=09(dev, clkout_name, clk_name, flags, clk_wzrd->base, =09=09=09=09=09(WZRD_CLK_CFG_REG(is_versal, 2) + i * 12), =09=09=09=09=09WZRD_CLKOUT_DIVIDE_SHIFT, =09=09=09=09=09WZRD_CLKOUT_DIVIDE_WIDTH, @@ -1152,7 +1108,7 @@ static int clk_wzrd_probe(struct platform_device *pde= v) =09=09=09=09=09DIV_O, &clkwzrd_lock); =09=09=09else =09=09=09=09clk_wzrd->clk_data.hws[i] =3D clk_wzrd_register_divider -=09=09=09=09=09(&pdev->dev, clkout_name, clk_name, 0, clk_wzrd->base, +=09=09=09=09=09(dev, clkout_name, clk_name, 0, clk_wzrd->base, =09=09=09=09=09(WZRD_CLK_CFG_REG(is_versal, 2) + i * 12), =09=09=09=09=09WZRD_CLKOUT_DIVIDE_SHIFT, =09=09=09=09=09WZRD_CLKOUT_DIVIDE_WIDTH, @@ -1160,13 +1116,64 @@ static int clk_wzrd_probe(struct platform_device *p= dev) =09=09=09=09=09DIV_O, &clkwzrd_lock); =09=09} =09=09if (IS_ERR(clk_wzrd->clk_data.hws[i])) { -=09=09=09dev_err(&pdev->dev, -=09=09=09=09"unable to register divider clock\n"); +=09=09=09dev_err(dev, "unable to register divider clock\n"); =09=09=09return PTR_ERR(clk_wzrd->clk_data.hws[i]); =09=09} =09} =20 -out: +=09return 0; +} + +static int clk_wzrd_probe(struct platform_device *pdev) +{ +=09struct device_node *np =3D pdev->dev.of_node; +=09struct clk_wzrd *clk_wzrd; +=09unsigned long rate; +=09int nr_outputs; +=09int ret; + +=09ret =3D of_property_read_u32(np, "xlnx,nr-outputs", &nr_outputs); +=09if (ret || nr_outputs > WZRD_NUM_OUTPUTS) +=09=09return -EINVAL; + +=09clk_wzrd =3D devm_kzalloc(&pdev->dev, struct_size(clk_wzrd, clk_data.hw= s, nr_outputs), +=09=09=09=09GFP_KERNEL); +=09if (!clk_wzrd) +=09=09return -ENOMEM; +=09platform_set_drvdata(pdev, clk_wzrd); + +=09clk_wzrd->base =3D devm_platform_ioremap_resource(pdev, 0); +=09if (IS_ERR(clk_wzrd->base)) +=09=09return PTR_ERR(clk_wzrd->base); + +=09ret =3D of_property_read_u32(np, "xlnx,speed-grade", &clk_wzrd->speed_g= rade); +=09if (!ret) { +=09=09if (clk_wzrd->speed_grade < 1 || clk_wzrd->speed_grade > 3) { +=09=09=09dev_warn(&pdev->dev, "invalid speed grade '%d'\n", +=09=09=09=09 clk_wzrd->speed_grade); +=09=09=09clk_wzrd->speed_grade =3D 0; +=09=09} +=09} + +=09clk_wzrd->clk_in1 =3D devm_clk_get(&pdev->dev, "clk_in1"); +=09if (IS_ERR(clk_wzrd->clk_in1)) +=09=09return dev_err_probe(&pdev->dev, PTR_ERR(clk_wzrd->clk_in1), +=09=09=09=09 "clk_in1 not found\n"); + +=09clk_wzrd->axi_clk =3D devm_clk_get_enabled(&pdev->dev, "s_axi_aclk"); +=09if (IS_ERR(clk_wzrd->axi_clk)) +=09=09return dev_err_probe(&pdev->dev, PTR_ERR(clk_wzrd->axi_clk), +=09=09=09=09 "s_axi_aclk not found\n"); +=09rate =3D clk_get_rate(clk_wzrd->axi_clk); +=09if (rate > WZRD_ACLK_MAX_FREQ) { +=09=09dev_err(&pdev->dev, "s_axi_aclk frequency (%lu) too high\n", rate); +=09=09return -EINVAL; +=09} + +=09ret =3D clk_wzrd_register_output_clocks(&pdev->dev, nr_outputs); +=09if (ret) +=09=09return ret; + =09clk_wzrd->clk_data.num =3D nr_outputs; =09ret =3D devm_of_clk_add_hw_provider(&pdev->dev, of_clk_hw_onecell_get, = &clk_wzrd->clk_data); =09if (ret) { --=20 2.46.0