[PATCH v6 03/19] clk: mediatek: Add MT8188 topckgen clock support

[Garmin Chang (張家銘)]

On Tue, 2023-03-14 at 10:10 +0100, AngeloGioacchino Del Regno wrote:
> Il 09/03/23 14:54, Garmin.Chang ha scritto:
> > Add MT8188 topckgen clock controller which provides muxes, dividers
> > to handle variety clock selection in other IP blocks.
> > 
> > Signed-off-by: Garmin.Chang <Garmin.Chang at mediatek.com>
> > ---
> >   drivers/clk/mediatek/Makefile              |    2 +-
> >   drivers/clk/mediatek/clk-mt8188-topckgen.c | 1347
> > ++++++++++++++++++++
> >   2 files changed, 1348 insertions(+), 1 deletion(-)
> >   create mode 100644 drivers/clk/mediatek/clk-mt8188-topckgen.c
> > 
> > diff --git a/drivers/clk/mediatek/Makefile
> > b/drivers/clk/mediatek/Makefile
> > index 1f822fcf6084..d845bf7308c3 100644
> > --- a/drivers/clk/mediatek/Makefile
> > +++ b/drivers/clk/mediatek/Makefile
> > @@ -91,7 +91,7 @@ obj-$(CONFIG_COMMON_CLK_MT8186) += clk-mt8186-
> > mcu.o clk-mt8186-topckgen.o clk-mt
> >   				   clk-mt8186-mfg.o clk-mt8186-mm.o
> > clk-mt8186-wpe.o \
> >   				   clk-mt8186-img.o clk-mt8186-vdec.o
> > clk-mt8186-venc.o \
> >   				   clk-mt8186-cam.o clk-mt8186-mdp.o
> > clk-mt8186-ipe.o
> > -obj-$(CONFIG_COMMON_CLK_MT8188) += clk-mt8188-apmixedsys.o
> > +obj-$(CONFIG_COMMON_CLK_MT8188) += clk-mt8188-apmixedsys.o clk-
> > mt8188-topckgen.o
> >   obj-$(CONFIG_COMMON_CLK_MT8192) += clk-mt8192.o
> >   obj-$(CONFIG_COMMON_CLK_MT8192_AUDSYS) += clk-mt8192-aud.o
> >   obj-$(CONFIG_COMMON_CLK_MT8192_CAMSYS) += clk-mt8192-cam.o
> > diff --git a/drivers/clk/mediatek/clk-mt8188-topckgen.c
> > b/drivers/clk/mediatek/clk-mt8188-topckgen.c
> > new file mode 100644
> > index 000000000000..b3f9577de081
> > --- /dev/null
> > +++ b/drivers/clk/mediatek/clk-mt8188-topckgen.c
> > @@ -0,0 +1,1347 @@
> 
> ..snip..
> 
> > +
> > +static const struct of_device_id of_match_clk_mt8188_topck[] = {
> > +	{ .compatible = "mediatek,mt8188-topckgen", },
> 
> 	{ .compatible = "mediatek,mt8188-topckgen" },
> 	{ /* sentinel */ }
> 
Thank you for your suggestions.

Ok, I would remove comma in v7.
> > +	{}
> > +};
> > +
> > +/* Register mux notifier for MFG mux */
> > +static int clk_mt8188_reg_mfg_mux_notifier(struct device *dev,
> > struct clk *clk)
> > +{
> > +	struct mtk_mux_nb *mfg_mux_nb;
> > +
> > +	mfg_mux_nb = devm_kzalloc(dev, sizeof(*mfg_mux_nb),
> > GFP_KERNEL);
> > +	if (!mfg_mux_nb)
> > +		return -ENOMEM;
> > +
> > +	mfg_mux_nb->ops = &clk_mux_ops;
> > +	mfg_mux_nb->bypass_index = 0; /* Bypass to TOP_MFG_CORE_TMP */
> > +
> > +	return devm_mtk_clk_mux_notifier_register(dev, clk,
> > mfg_mux_nb);
> > +}
> > +
> > +static int clk_mt8188_topck_probe(struct platform_device *pdev)
> > +{
> > +	struct clk_hw_onecell_data *top_clk_data;
> > +	struct device_node *node = pdev->dev.of_node;
> > +	struct clk_hw *hw;
> > +	int r;
> > +	void __iomem *base;
> > +
> > +	top_clk_data = mtk_alloc_clk_data(CLK_TOP_NR_CLK);
> > +	if (!top_clk_data)
> > +		return -ENOMEM;
> > +
> > +	base = devm_platform_ioremap_resource(pdev, 0);
> > +	if (IS_ERR(base)) {
> > +		r = PTR_ERR(base);
> > +		goto free_top_data;
> > +	}
> > +
> > +	r = mtk_clk_register_fixed_clks(top_fixed_clks,
> > ARRAY_SIZE(top_fixed_clks),
> > +					top_clk_data);
> > +	if (r)
> > +		goto free_top_data;
> > +
> > +	r = mtk_clk_register_factors(top_divs, ARRAY_SIZE(top_divs),
> > top_clk_data);
> > +	if (r)
> > +		goto unregister_fixed_clks;
> > +
> > +	r = mtk_clk_register_muxes(&pdev->dev, top_mtk_muxes,
> > +				   ARRAY_SIZE(top_mtk_muxes), node,
> > +				   &mt8188_clk_lock, top_clk_data);
> > +	if (r)
> > +		goto unregister_factors;
> > +
> > +	hw = devm_clk_hw_register_mux(&pdev->dev, "mfg_ck_fast_ref",
> > mfg_fast_ref_parents,
> > +				      ARRAY_SIZE(mfg_fast_ref_parents),
> > CLK_SET_RATE_PARENT,
> > +				      (base + 0x250), 8, 1, 0,
> > &mt8188_clk_lock);
> 
> If you make this a mtk mux and put it in top_mtk_muxes, you can
> migrate topckgen to
> the simple_probe() mechanism, greatly reducing the size of this file.
> 
After checking, the mt8195 chip uses top_mtk_muxes and does not use
simple_probe() mechanism.

mt8188 and mt8195 also use top_mtk_muxes in the same way, so
mt8188 will not be modified this time.

> > +	if (IS_ERR(hw)) {
> > +		r = PTR_ERR(hw);
> > +		goto unregister_muxes;
> > +	}
> > +	top_clk_data->hws[CLK_TOP_MFG_CK_FAST_REF] = hw;
> > +
> > +	r = clk_mt8188_reg_mfg_mux_notifier(&pdev->dev,
> > +					    top_clk_data-
> > >hws[CLK_TOP_MFG_CK_FAST_REF]->clk);
> > +	if (r)
> > +		goto unregister_muxes;
> > +
> > +	r = mtk_clk_register_composites(&pdev->dev, top_adj_divs,
> > +					ARRAY_SIZE(top_adj_divs), base,
> > +					&mt8188_clk_lock,
> > top_clk_data);
> > +	if (r)
> > +		goto unregister_muxes;
> > +
> > +	r = mtk_clk_register_gates(&pdev->dev, node, top_clks,
> > +				   ARRAY_SIZE(top_clks), top_clk_data);
> > +	if (r)
> > +		goto unregister_composite_divs;
> > +
> > +	r = of_clk_add_hw_provider(node, of_clk_hw_onecell_get,
> > top_clk_data);
> > +	if (r)
> > +		goto unregister_gates;
> > +
> > +	platform_set_drvdata(pdev, top_clk_data);
> > +
> > +	return r;
> > +
> > +unregister_gates:
> > +	mtk_clk_unregister_gates(top_clks, ARRAY_SIZE(top_clks),
> > top_clk_data);
> > +unregister_composite_divs:
> > +	mtk_clk_unregister_composites(top_adj_divs,
> > ARRAY_SIZE(top_adj_divs), top_clk_data);
> > +unregister_muxes:
> > +	mtk_clk_unregister_muxes(top_mtk_muxes,
> > ARRAY_SIZE(top_mtk_muxes), top_clk_data);
> > +unregister_factors:
> > +	mtk_clk_unregister_factors(top_divs, ARRAY_SIZE(top_divs),
> > top_clk_data);
> > +unregister_fixed_clks:
> > +	mtk_clk_unregister_fixed_clks(top_fixed_clks,
> > ARRAY_SIZE(top_fixed_clks), top_clk_data);
> > +free_top_data:
> > +	mtk_free_clk_data(top_clk_data);
> > +	return r;
> > +}
> > +
> > +static int clk_mt8188_topck_remove(struct platform_device *pdev)
> > +{
> > +	struct clk_hw_onecell_data *top_clk_data =
> > platform_get_drvdata(pdev);
> > +	struct device_node *node = pdev->dev.of_node;
> > +
> > +	of_clk_del_provider(node);
> > +	mtk_clk_unregister_gates(top_clks, ARRAY_SIZE(top_clks),
> > top_clk_data);
> > +	mtk_clk_unregister_composites(top_adj_divs,
> > ARRAY_SIZE(top_adj_divs), top_clk_data);
> > +	mtk_clk_unregister_muxes(top_mtk_muxes,
> > ARRAY_SIZE(top_mtk_muxes), top_clk_data);
> > +	mtk_clk_unregister_factors(top_divs, ARRAY_SIZE(top_divs),
> > top_clk_data);
> > +	mtk_clk_unregister_fixed_clks(top_fixed_clks,
> > ARRAY_SIZE(top_fixed_clks), top_clk_data);
> > +	mtk_free_clk_data(top_clk_data);
> > +
> > +	return 0;
> > +}
> > +
> > +static struct platform_driver clk_mt8188_topck_drv = {
> > +	.probe = clk_mt8188_topck_probe,
> > +	.remove = clk_mt8188_topck_remove,
> > +	.driver = {
> > +		.name = "clk-mt8188-topck",
> > +		.of_match_table = of_match_clk_mt8188_topck,
> > +	},
> > +};
> > +builtin_platform_driver(clk_mt8188_topck_drv);
> 
> module_platform_driver....
> MODULE_LICENSE....