[PATCH 6/6] clk: mediatek: Add support for other clock types in simple probe/remove
Yassine Oudjana
yassine.oudjana at gmail.com
Thu May 19 06:47:28 PDT 2022
From: Yassine Oudjana <y.oudjana at protonmail.com>
Simple probe/remove functions currently support gates only. Add
PLLs, fixed clocks, fixed factors and muxes to support most
clock controllers. struct mtk_clk_desc now takes descriptions
for all of these clocks, and only the ones set will be registered.
Most clock controllers will only use a subset of the types
supported.
Signed-off-by: Yassine Oudjana <y.oudjana at protonmail.com>
---
Dependencies:
- clk: mediatek: Move to struct clk_hw provider APIs (series)
https://patchwork.kernel.org/project/linux-mediatek/cover/20220510104804.544597-1-wenst@chromium.org/
- Cleanup MediaTek clk reset drivers and support MT8192/MT8195 (series)
https://patchwork.kernel.org/project/linux-mediatek/cover/20220503093856.22250-1-rex-bc.chen@mediatek.com/
- Export required symbols to compile clk drivers as module (single patch)
https://patchwork.kernel.org/project/linux-mediatek/patch/20220518111652.223727-7-angelogioacchino.delregno@collabora.com/
drivers/clk/mediatek/clk-mtk.c | 88 +++++++++++++++++++++++++++++-----
drivers/clk/mediatek/clk-mtk.h | 17 ++++++-
2 files changed, 92 insertions(+), 13 deletions(-)
diff --git a/drivers/clk/mediatek/clk-mtk.c b/drivers/clk/mediatek/clk-mtk.c
index 3382802663f4..df1209d5b6fb 100644
--- a/drivers/clk/mediatek/clk-mtk.c
+++ b/drivers/clk/mediatek/clk-mtk.c
@@ -15,8 +15,10 @@
#include <linux/platform_device.h>
#include <linux/slab.h>
-#include "clk-mtk.h"
#include "clk-gate.h"
+#include "clk-mtk.h"
+#include "clk-mux.h"
+#include "clk-pll.h"
struct clk_hw_onecell_data *mtk_alloc_clk_data(unsigned int clk_num)
{
@@ -434,20 +436,55 @@ int mtk_clk_simple_probe(struct platform_device *pdev)
if (!clk_ctrl)
return -ENOMEM;
- clk_ctrl->clk_data = mtk_alloc_clk_data(mcd->num_clks);
+ clk_ctrl->clk_data = mtk_alloc_clk_data(mcd->num_plls
+ + mcd->num_fixed_clks
+ + mcd->num_factors
+ + mcd->num_muxes
+ + mcd->num_gates);
if (!clk_ctrl->clk_data) {
r = -ENOMEM;
goto free_clk_ctrl;
}
- r = mtk_clk_register_gates_with_dev(node, mcd->clks, mcd->num_clks,
- clk_ctrl->clk_data, &pdev->dev);
- if (r)
- goto free_clk_data;
+ if (mcd->plls) {
+ r = mtk_clk_register_plls(node, mcd->plls, mcd->num_plls,
+ clk_ctrl->clk_data);
+ if (r)
+ goto free_clk_data;
+ }
+
+ if (mcd->fixed_clks) {
+ r = mtk_clk_register_fixed_clks(mcd->fixed_clks, mcd->num_fixed_clks,
+ clk_ctrl->clk_data);
+ if (r)
+ goto unregister_plls;
+ }
+
+ if (mcd->factors) {
+ r = mtk_clk_register_factors(mcd->factors, mcd->num_factors,
+ clk_ctrl->clk_data);
+ if (r)
+ goto unregister_fixed_clks;
+ }
+
+ if (mcd->muxes) {
+ spin_lock_init(&clk_ctrl->mux_lock);
+ r = mtk_clk_register_muxes(mcd->muxes, mcd->num_muxes, node,
+ &clk_ctrl->mux_lock, clk_ctrl->clk_data);
+ if (r)
+ goto unregister_factors;
+ }
+
+ if (mcd->gates) {
+ r = mtk_clk_register_gates_with_dev(node, mcd->gates, mcd->num_gates,
+ clk_ctrl->clk_data, &pdev->dev);
+ if (r)
+ goto unregister_muxes;
+ }
r = of_clk_add_hw_provider(node, of_clk_hw_onecell_get, clk_ctrl->clk_data);
if (r)
- goto unregister_clks;
+ goto unregister_gates;
platform_set_drvdata(pdev, clk_ctrl);
@@ -457,14 +494,30 @@ int mtk_clk_simple_probe(struct platform_device *pdev)
mcd->rst_desc);
if (IS_ERR(clk_ctrl->rst_data)) {
r = PTR_ERR(clk_ctrl->rst_data);
- goto unregister_clks;
+ goto unregister_clk_provider;
}
}
return r;
-unregister_clks:
- mtk_clk_unregister_gates(mcd->clks, mcd->num_clks, clk_ctrl->clk_data);
+unregister_clk_provider:
+ of_clk_del_provider(node);
+unregister_gates:
+ if (mcd->gates)
+ mtk_clk_unregister_gates(mcd->gates, mcd->num_gates, clk_ctrl->clk_data);
+unregister_muxes:
+ if (mcd->muxes)
+ mtk_clk_unregister_muxes(mcd->muxes, mcd->num_muxes, clk_ctrl->clk_data);
+unregister_factors:
+ if (mcd->factors)
+ mtk_clk_unregister_factors(mcd->factors, mcd->num_factors, clk_ctrl->clk_data);
+unregister_fixed_clks:
+ if (mcd->fixed_clks)
+ mtk_clk_unregister_fixed_clks(mcd->fixed_clks, mcd->num_fixed_clks,
+ clk_ctrl->clk_data);
+unregister_plls:
+ if (mcd->plls)
+ mtk_clk_unregister_plls(mcd->plls, mcd->num_plls, clk_ctrl->clk_data);
free_clk_data:
mtk_free_clk_data(clk_ctrl->clk_data);
free_clk_ctrl:
@@ -480,9 +533,22 @@ int mtk_clk_simple_remove(struct platform_device *pdev)
struct device_node *node = pdev->dev.of_node;
of_clk_del_provider(node);
+
if (clk_ctrl->rst_data)
mtk_unregister_reset_controller(clk_ctrl->rst_data);
- mtk_clk_unregister_gates(mcd->clks, mcd->num_clks, clk_ctrl->clk_data);
+
+ if (mcd->gates)
+ mtk_clk_unregister_gates(mcd->gates, mcd->num_gates, clk_ctrl->clk_data);
+ if (mcd->muxes)
+ mtk_clk_unregister_muxes(mcd->muxes, mcd->num_muxes, clk_ctrl->clk_data);
+ if (mcd->factors)
+ mtk_clk_unregister_factors(mcd->factors, mcd->num_factors, clk_ctrl->clk_data);
+ if (mcd->fixed_clks)
+ mtk_clk_unregister_fixed_clks(mcd->fixed_clks, mcd->num_fixed_clks,
+ clk_ctrl->clk_data);
+ if (mcd->plls)
+ mtk_clk_unregister_plls(mcd->plls, mcd->num_plls, clk_ctrl->clk_data);
+
mtk_free_clk_data(clk_ctrl->clk_data);
kfree(clk_ctrl);
diff --git a/drivers/clk/mediatek/clk-mtk.h b/drivers/clk/mediatek/clk-mtk.h
index fa092bca97c8..23bce98bca20 100644
--- a/drivers/clk/mediatek/clk-mtk.h
+++ b/drivers/clk/mediatek/clk-mtk.h
@@ -13,6 +13,9 @@
#include <linux/spinlock.h>
#include <linux/types.h>
+#include "clk-gate.h"
+#include "clk-mux.h"
+#include "clk-pll.h"
#include "reset.h"
#define MAX_MUX_GATE_BIT 31
@@ -191,12 +194,22 @@ struct clk_hw *mtk_clk_register_ref2usb_tx(const char *name,
struct mtk_simple_clk_controller {
struct clk_hw_onecell_data *clk_data;
+ spinlock_t mux_lock;
struct mtk_clk_rst_data *rst_data;
};
struct mtk_clk_desc {
- const struct mtk_gate *clks;
- size_t num_clks;
+ const struct mtk_pll_data *plls;
+ size_t num_plls;
+ const struct mtk_fixed_clk *fixed_clks;
+ size_t num_fixed_clks;
+ const struct mtk_fixed_factor *factors;
+ size_t num_factors;
+ const struct mtk_mux *muxes;
+ size_t num_muxes;
+ const struct mtk_gate *gates;
+ size_t num_gates;
+
const struct mtk_clk_rst_desc *rst_desc;
};
--
2.36.1
More information about the Linux-mediatek
mailing list