To implement frequency hopping and spread spectrum clocking
function, we introduce new clock type and APIs to handle
FHCTL hardware.
Co-developed-by: Edward-JW Yang <edward-jw.yang@mediatek.com>
Signed-off-by: Edward-JW Yang <edward-jw.yang@mediatek.com>
Signed-off-by: Johnson Wang <johnson.wang@mediatek.com>
---
drivers/clk/mediatek/Makefile | 2 +-
drivers/clk/mediatek/clk-fhctl.c | 244 ++++++++++++++++++++++++++++
drivers/clk/mediatek/clk-fhctl.h | 26 +++
drivers/clk/mediatek/clk-pllfh.c | 268 +++++++++++++++++++++++++++++++
drivers/clk/mediatek/clk-pllfh.h | 82 ++++++++++
5 files changed, 621 insertions(+), 1 deletion(-)
create mode 100644 drivers/clk/mediatek/clk-fhctl.c
create mode 100644 drivers/clk/mediatek/clk-fhctl.h
create mode 100644 drivers/clk/mediatek/clk-pllfh.c
create mode 100644 drivers/clk/mediatek/clk-pllfh.h
diff --git a/drivers/clk/mediatek/Makefile b/drivers/clk/mediatek/Makefile
index caf2ce93d666..0e674a55e51e 100644
--- a/drivers/clk/mediatek/Makefile
+++ b/drivers/clk/mediatek/Makefile
@@ -1,5 +1,5 @@
# SPDX-License-Identifier: GPL-2.0
-obj-$(CONFIG_COMMON_CLK_MEDIATEK) += clk-mtk.o clk-pll.o clk-gate.o clk-apmixed.o clk-cpumux.o reset.o clk-mux.o
+obj-$(CONFIG_COMMON_CLK_MEDIATEK) += clk-mtk.o clk-pll.o clk-gate.o clk-apmixed.o clk-cpumux.o reset.o clk-mux.o clk-fhctl.o clk-pllfh.o
obj-$(CONFIG_COMMON_CLK_MT6765) += clk-mt6765.o
obj-$(CONFIG_COMMON_CLK_MT6765_AUDIOSYS) += clk-mt6765-audio.o
diff --git a/drivers/clk/mediatek/clk-fhctl.c b/drivers/clk/mediatek/clk-fhctl.c
new file mode 100644
index 000000000000..4f271acef5fe
--- /dev/null
+++ b/drivers/clk/mediatek/clk-fhctl.c
@@ -0,0 +1,244 @@
+// SPDX-License-Identifier: GPL-2.0-only
+/*
+ * Copyright (c) 2022 MediaTek Inc.
+ * Author: Edward-JW Yang <edward-jw.yang@mediatek.com>
+ */
+
+#include <linux/io.h>
+#include <linux/iopoll.h>
+
+#include "clk-mtk.h"
+#include "clk-pllfh.h"
+#include "clk-fhctl.h"
+
+#define PERCENT_TO_DDSLMT(dds, percent_m10) \
+ ((((dds) * (percent_m10)) >> 5) / 100)
+
+static const struct fhctl_offset fhctl_offset = {
+ .offset_hp_en = 0x0,
+ .offset_clk_con = 0x8,
+ .offset_rst_con = 0xc,
+ .offset_slope0 = 0x10,
+ .offset_slope1 = 0x14,
+ .offset_cfg = 0x0,
+ .offset_updnlmt = 0x4,
+ .offset_dds = 0x8,
+ .offset_dvfs = 0xc,
+ .offset_mon = 0x10,
+};
+
+const struct fhctl_offset *fhctl_get_offset_table(void)
+{
+ return &fhctl_offset;
+}
+
+static void dump_hw(struct mtk_clk_pll *pll, struct fh_pll_regs *regs,
+ const struct fh_pll_data *data)
+{
+ pr_info("hp_en<%x>,clk_con<%x>,slope0<%x>,slope1<%x>\n",
+ readl(regs->reg_hp_en), readl(regs->reg_clk_con),
+ readl(regs->reg_slope0), readl(regs->reg_slope1));
+ pr_info("cfg<%x>,lmt<%x>,dds<%x>,dvfs<%x>,mon<%x>\n",
+ readl(regs->reg_cfg), readl(regs->reg_updnlmt),
+ readl(regs->reg_dds), readl(regs->reg_dvfs),
+ readl(regs->reg_mon));
+ pr_info("pcw<%x>\n", readl(pll->pcw_addr));
+}
+
+static int fhctl_set_ssc_regs(struct mtk_clk_pll *pll, struct fh_pll_regs *regs,
+ const struct fh_pll_data *data, u32 rate)
+{
+ u32 updnlmt_val, r;
+
+ writel((readl(regs->reg_cfg) & ~(data->frddsx_en)), regs->reg_cfg);
+ writel((readl(regs->reg_cfg) & ~(data->sfstrx_en)), regs->reg_cfg);
+ writel((readl(regs->reg_cfg) & ~(data->fhctlx_en)), regs->reg_cfg);
+
+ if (rate > 0) {
+ /* Set the relative parameter registers (dt/df/upbnd/downbnd) */
+ r = readl(regs->reg_cfg);
+ r &= ~(data->msk_frddsx_dys);
+ r |= (data->df_val << (ffs(data->msk_frddsx_dys) - 1));
+ writel(r, regs->reg_cfg);
+
+ r = readl(regs->reg_cfg);
+ r &= ~(data->msk_frddsx_dts);
+ r |= (data->dt_val << (ffs(data->msk_frddsx_dts) - 1));
+ writel(r, regs->reg_cfg);
+
+ writel((readl(pll->pcw_addr) & data->dds_mask) | data->tgl_org,
+ regs->reg_dds);
+
+ /* Calculate UPDNLMT */
+ updnlmt_val = PERCENT_TO_DDSLMT((readl(regs->reg_dds) &
+ data->dds_mask), rate) <<
+ data->updnlmt_shft;
+
+ writel(updnlmt_val, regs->reg_updnlmt);
+ writel(readl(regs->reg_hp_en) | BIT(data->fh_id),
+ regs->reg_hp_en);
+ /* Enable SSC */
+ writel(readl(regs->reg_cfg) | data->frddsx_en, regs->reg_cfg);
+ /* Enable Hopping control */
+ writel(readl(regs->reg_cfg) | data->fhctlx_en, regs->reg_cfg);
+
+ } else {
+ /* Switch to APMIXEDSYS control */
+ writel(readl(regs->reg_hp_en) & ~BIT(data->fh_id),
+ regs->reg_hp_en);
+ /* Wait for DDS to be stable */
+ udelay(30);
+ }
+
+ return 0;
+}
+
+static int hopping_hw_flow(struct mtk_clk_pll *pll, struct fh_pll_regs *regs,
+ const struct fh_pll_data *data,
+ struct fh_pll_state *state, unsigned int new_dds)
+{
+ u32 dds_mask = data->dds_mask;
+ u32 mon_dds = 0;
+ u32 con_pcw_tmp;
+ int ret;
+
+ if (state->ssc_rate)
+ fhctl_set_ssc_regs(pll, regs, data, 0);
+
+ writel((readl(pll->pcw_addr) & dds_mask) | data->tgl_org,
+ regs->reg_dds);
+
+ writel(readl(regs->reg_cfg) | data->sfstrx_en, regs->reg_cfg);
+ writel(readl(regs->reg_cfg) | data->fhctlx_en, regs->reg_cfg);
+ writel(data->slope0_value, regs->reg_slope0);
+ writel(data->slope1_value, regs->reg_slope1);
+
+ writel(readl(regs->reg_hp_en) | BIT(data->fh_id), regs->reg_hp_en);
+ writel((new_dds) | (data->dvfs_tri), regs->reg_dvfs);
+
+ /* Wait 1000 us until DDS stable */
+ ret = readl_poll_timeout_atomic(regs->reg_mon, mon_dds,
+ (mon_dds & dds_mask) == new_dds,
+ 10, 1000);
+ if (ret) {
+ pr_warn("%s: FHCTL hopping timeout\n", pll->data->name);
+ dump_hw(pll, regs, data);
+ }
+
+ con_pcw_tmp = readl(pll->pcw_addr) & (~dds_mask);
+ con_pcw_tmp = (con_pcw_tmp | (readl(regs->reg_mon) & dds_mask) |
+ data->pcwchg);
+
+ writel(con_pcw_tmp, pll->pcw_addr);
+ writel(readl(regs->reg_hp_en) & ~BIT(data->fh_id), regs->reg_hp_en);
+
+ if (state->ssc_rate)
+ fhctl_set_ssc_regs(pll, regs, data, state->ssc_rate);
+
+ return ret;
+}
+
+static unsigned int __get_postdiv(struct mtk_clk_pll *pll)
+{
+ unsigned int regval;
+
+ regval = readl(pll->pd_addr) >> pll->data->pd_shift;
+ regval &= POSTDIV_MASK;
+
+ return BIT(regval);
+}
+
+static void __set_postdiv(struct mtk_clk_pll *pll, unsigned int postdiv)
+{
+ unsigned int regval;
+
+ regval = readl(pll->pd_addr);
+ regval &= ~(POSTDIV_MASK << pll->data->pd_shift);
+ regval |= (ffs(postdiv) - 1) << pll->data->pd_shift;
+ writel(regval, pll->pd_addr);
+}
+
+static int fhctl_hopping(struct mtk_fh *fh, unsigned int new_dds,
+ unsigned int postdiv)
+{
+ const struct fh_pll_data *data = &fh->pllfh_data->data;
+ struct fh_pll_state *state = &fh->pllfh_data->state;
+ struct fh_pll_regs *regs = &fh->regs;
+ struct mtk_clk_pll *pll = &fh->clk_pll;
+ spinlock_t *lock = fh->lock;
+ unsigned int pll_postdiv;
+ unsigned long flags = 0;
+ int ret;
+
+ if (postdiv) {
+ pll_postdiv = __get_postdiv(pll);
+
+ if (postdiv > pll_postdiv)
+ __set_postdiv(pll, postdiv);
+ }
+
+ spin_lock_irqsave(lock, flags);
+
+ ret = hopping_hw_flow(pll, regs, data, state, new_dds);
+
+ spin_unlock_irqrestore(lock, flags);
+
+ if (postdiv && postdiv < pll_postdiv)
+ __set_postdiv(pll, postdiv);
+
+ return ret;
+}
+
+static int fhctl_ssc_enable(struct mtk_fh *fh, u32 rate)
+{
+ const struct fh_pll_data *data = &fh->pllfh_data->data;
+ struct fh_pll_state *state = &fh->pllfh_data->state;
+ struct fh_pll_regs *regs = &fh->regs;
+ struct mtk_clk_pll *pll = &fh->clk_pll;
+ spinlock_t *lock = fh->lock;
+ unsigned long flags = 0;
+
+ spin_lock_irqsave(lock, flags);
+
+ fhctl_set_ssc_regs(pll, regs, data, rate);
+ state->ssc_rate = rate;
+
+ spin_unlock_irqrestore(lock, flags);
+
+ return 0;
+}
+
+static const struct fh_operation fhctl_ops = {
+ .hopping = fhctl_hopping,
+ .ssc_enable = fhctl_ssc_enable,
+};
+
+const struct fh_operation *fhctl_get_ops(void)
+{
+ return &fhctl_ops;
+}
+
+void fhctl_hw_init(struct mtk_fh *fh)
+{
+ const struct fh_pll_data data = fh->pllfh_data->data;
+ struct fh_pll_state state = fh->pllfh_data->state;
+ struct fh_pll_regs regs = fh->regs;
+ u32 val;
+
+ /* initial hw register */
+ val = readl(regs.reg_clk_con) | BIT(data.fh_id);
+ writel(val, regs.reg_clk_con);
+
+ val = readl(regs.reg_rst_con) & ~BIT(data.fh_id);
+ writel(val, regs.reg_rst_con);
+ val = readl(regs.reg_rst_con) | BIT(data.fh_id);
+ writel(val, regs.reg_rst_con);
+
+ writel(0x0, regs.reg_cfg);
+ writel(0x0, regs.reg_updnlmt);
+ writel(0x0, regs.reg_dds);
+
+ /* enable ssc if needed */
+ if (state.ssc_rate)
+ fh->ops->ssc_enable(fh, state.ssc_rate);
+}
diff --git a/drivers/clk/mediatek/clk-fhctl.h b/drivers/clk/mediatek/clk-fhctl.h
new file mode 100644
index 000000000000..51275febf086
--- /dev/null
+++ b/drivers/clk/mediatek/clk-fhctl.h
@@ -0,0 +1,26 @@
+/* SPDX-License-Identifier: GPL-2.0-only */
+/*
+ * Copyright (c) 2022 MediaTek Inc.
+ * Author: Edward-JW Yang <edward-jw.yang@mediatek.com>
+ */
+
+#ifndef __CLK_FHCTL_H
+#define __CLK_FHCTL_H
+
+struct fhctl_offset {
+ u32 offset_hp_en;
+ u32 offset_clk_con;
+ u32 offset_rst_con;
+ u32 offset_slope0;
+ u32 offset_slope1;
+ u32 offset_cfg;
+ u32 offset_updnlmt;
+ u32 offset_dds;
+ u32 offset_dvfs;
+ u32 offset_mon;
+};
+const struct fhctl_offset *fhctl_get_offset_table(void);
+const struct fh_operation *fhctl_get_ops(void);
+void fhctl_hw_init(struct mtk_fh *fh);
+
+#endif
diff --git a/drivers/clk/mediatek/clk-pllfh.c b/drivers/clk/mediatek/clk-pllfh.c
new file mode 100644
index 000000000000..15e5781fecca
--- /dev/null
+++ b/drivers/clk/mediatek/clk-pllfh.c
@@ -0,0 +1,268 @@
+// SPDX-License-Identifier: GPL-2.0-only
+/*
+ * Copyright (c) 2022 MediaTek Inc.
+ * Author: Edward-JW Yang <edward-jw.yang@mediatek.com>
+ */
+
+#include <linux/of.h>
+#include <linux/of_address.h>
+#include <linux/io.h>
+#include <linux/slab.h>
+#include <linux/clkdev.h>
+#include <linux/delay.h>
+
+#include "clk-mtk.h"
+#include "clk-pllfh.h"
+#include "clk-fhctl.h"
+
+static DEFINE_SPINLOCK(pllfh_lock);
+
+inline struct mtk_fh *to_mtk_fh(struct clk_hw *hw)
+{
+ struct mtk_clk_pll *pll = to_mtk_clk_pll(hw);
+
+ return container_of(pll, struct mtk_fh, clk_pll);
+}
+
+static int mtk_fhctl_set_rate(struct clk_hw *hw, unsigned long rate,
+ unsigned long parent_rate)
+{
+ struct mtk_clk_pll *pll = to_mtk_clk_pll(hw);
+ struct mtk_fh *fh = to_mtk_fh(hw);
+ u32 pcw = 0;
+ u32 postdiv;
+
+ mtk_pll_calc_values(pll, &pcw, &postdiv, rate, parent_rate);
+
+ return fh->ops->hopping(fh, pcw, postdiv);
+}
+
+static const struct clk_ops mtk_pllfh_ops = {
+ .is_prepared = mtk_pll_is_prepared,
+ .prepare = mtk_pll_prepare,
+ .unprepare = mtk_pll_unprepare,
+ .recalc_rate = mtk_pll_recalc_rate,
+ .round_rate = mtk_pll_round_rate,
+ .set_rate = mtk_fhctl_set_rate,
+};
+
+static struct mtk_pllfh_data *get_pllfh_by_id(struct mtk_pllfh_data *pllfhs,
+ int num_fhs, int pll_id)
+{
+ int i;
+
+ for (i = 0; i < num_fhs; i++)
+ if (pllfhs[i].data.pll_id == pll_id)
+ return &pllfhs[i];
+
+ return NULL;
+}
+
+void fhctl_parse_dt(const u8 *compatible_node, struct mtk_pllfh_data *pllfhs,
+ int num_fhs)
+{
+ void __iomem *base;
+ struct device_node *node;
+ u32 num_clocks, pll_id, ssc_rate;
+ int offset, i;
+
+ node = of_find_compatible_node(NULL, NULL, compatible_node);
+ if (!node) {
+ pr_err("cannot find \"%s\"\n", compatible_node);
+ return;
+ }
+
+ base = of_iomap(node, 0);
+ if (!base) {
+ pr_err("%s(): ioremap failed\n", __func__);
+ return;
+ }
+
+ num_clocks = of_clk_get_parent_count(node);
+ if (!num_clocks) {
+ pr_err("%s(): failed to get clocks property\n", __func__);
+ return;
+ }
+
+ for (i = 0; i < num_clocks; i++) {
+ struct mtk_pllfh_data *pllfh;
+
+ offset = i * 2;
+
+ of_property_read_u32_index(node, "clocks", offset + 1, &pll_id);
+ of_property_read_u32_index(node,
+ "mediatek,hopping-ssc-percents",
+ i, &ssc_rate);
+
+ pllfh = get_pllfh_by_id(pllfhs, num_fhs, pll_id);
+ if (!pllfh)
+ continue;
+
+ pllfh->state.fh_enable = 1;
+ pllfh->state.ssc_rate = ssc_rate;
+ pllfh->state.base = base;
+ }
+}
+
+static void pllfh_init(struct mtk_fh *fh, struct mtk_pllfh_data *pllfh_data)
+{
+ struct fh_pll_regs *regs = &fh->regs;
+ const struct fhctl_offset *offset;
+ void __iomem *base = pllfh_data->state.base;
+ void __iomem *fhx_base = base + pllfh_data->data.fhx_offset;
+
+ offset = fhctl_get_offset_table();
+
+ regs->reg_hp_en = base + offset->offset_hp_en;
+ regs->reg_clk_con = base + offset->offset_clk_con;
+ regs->reg_rst_con = base + offset->offset_rst_con;
+ regs->reg_slope0 = base + offset->offset_slope0;
+ regs->reg_slope1 = base + offset->offset_slope1;
+
+ regs->reg_cfg = fhx_base + offset->offset_cfg;
+ regs->reg_updnlmt = fhx_base + offset->offset_updnlmt;
+ regs->reg_dds = fhx_base + offset->offset_dds;
+ regs->reg_dvfs = fhx_base + offset->offset_dvfs;
+ regs->reg_mon = fhx_base + offset->offset_mon;
+
+ fh->pllfh_data = pllfh_data;
+ fh->lock = &pllfh_lock;
+
+ fh->ops = fhctl_get_ops();
+}
+
+static bool fhctl_is_supported_and_enabled(const struct mtk_pllfh_data *pllfh)
+{
+ return pllfh && (pllfh->state.fh_enable == 1);
+}
+
+static struct clk_hw *
+mtk_clk_register_pllfh(const struct mtk_pll_data *pll_data,
+ struct mtk_pllfh_data *pllfh_data, void __iomem *base)
+{
+ struct clk_hw *hw;
+ struct mtk_fh *fh;
+
+ fh = kzalloc(sizeof(*fh), GFP_KERNEL);
+ if (!fh)
+ return ERR_PTR(-ENOMEM);
+
+ pllfh_init(fh, pllfh_data);
+
+ hw = mtk_clk_register_pll_ops(&fh->clk_pll, pll_data, base,
+ &mtk_pllfh_ops);
+
+ if (IS_ERR(hw))
+ kfree(fh);
+ else
+ fhctl_hw_init(fh);
+
+ return hw;
+}
+
+static void mtk_clk_unregister_pllfh(struct clk_hw *hw)
+{
+ struct mtk_fh *fh;
+
+ if (!hw)
+ return;
+
+ fh = to_mtk_fh(hw);
+
+ clk_hw_unregister(hw);
+ kfree(fh);
+}
+
+int mtk_clk_register_pllfhs(struct device_node *node,
+ const struct mtk_pll_data *plls, int num_plls,
+ struct mtk_pllfh_data *pllfhs, int num_fhs,
+ struct clk_hw_onecell_data *clk_data)
+{
+ void __iomem *base;
+ int i;
+ struct clk_hw *hw;
+
+ base = of_iomap(node, 0);
+ if (!base) {
+ pr_err("%s(): ioremap failed\n", __func__);
+ return -EINVAL;
+ }
+
+ for (i = 0; i < num_plls; i++) {
+ const struct mtk_pll_data *pll = &plls[i];
+ struct mtk_pllfh_data *pllfh;
+
+ pllfh = get_pllfh_by_id(pllfhs, num_fhs, pll->id);
+
+ if (fhctl_is_supported_and_enabled(pllfh))
+ hw = mtk_clk_register_pllfh(pll, pllfh, base);
+ else
+ hw = mtk_clk_register_pll(pll, base);
+
+ if (IS_ERR(hw)) {
+ pr_err("Failed to register clk %s: %pe\n", pll->name,
+ hw);
+ goto err;
+ }
+
+ clk_data->hws[pll->id] = hw;
+ }
+
+ return 0;
+
+err:
+ while (--i >= 0) {
+ const struct mtk_pll_data *pll = &plls[i];
+ struct mtk_pllfh_data *pllfh;
+
+ pllfh = get_pllfh_by_id(pllfhs, num_fhs, pll->id);
+
+ if (fhctl_is_supported_and_enabled(pllfh))
+ mtk_clk_unregister_pllfh(clk_data->hws[pll->id]);
+ else
+ mtk_clk_unregister_pll(clk_data->hws[pll->id]);
+
+ clk_data->hws[pll->id] = ERR_PTR(-ENOENT);
+ }
+
+ iounmap(base);
+
+ return PTR_ERR(hw);
+}
+
+void mtk_clk_unregister_pllfhs(const struct mtk_pll_data *plls, int num_plls,
+ struct mtk_pllfh_data *pllfhs, int num_fhs,
+ struct clk_hw_onecell_data *clk_data)
+{
+ void __iomem *base = NULL, *fhctl_base = NULL;
+ int i;
+
+ if (!clk_data)
+ return;
+
+ for (i = num_plls; i > 0; i--) {
+ const struct mtk_pll_data *pll = &plls[i - 1];
+ struct mtk_pllfh_data *pllfh;
+
+ if (IS_ERR_OR_NULL(clk_data->hws[pll->id]))
+ continue;
+
+ pllfh = get_pllfh_by_id(pllfhs, num_fhs, pll->id);
+
+ if (fhctl_is_supported_and_enabled(pllfh)) {
+ fhctl_base = pllfh->state.base;
+ mtk_clk_unregister_pllfh(clk_data->hws[pll->id]);
+ } else {
+ base = mtk_clk_pll_get_base(clk_data->hws[pll->id],
+ pll);
+ mtk_clk_unregister_pll(clk_data->hws[pll->id]);
+ }
+
+ clk_data->hws[pll->id] = ERR_PTR(-ENOENT);
+ }
+
+ if (fhctl_base)
+ iounmap(fhctl_base);
+
+ iounmap(base);
+}
diff --git a/drivers/clk/mediatek/clk-pllfh.h b/drivers/clk/mediatek/clk-pllfh.h
new file mode 100644
index 000000000000..effc7976c496
--- /dev/null
+++ b/drivers/clk/mediatek/clk-pllfh.h
@@ -0,0 +1,82 @@
+/* SPDX-License-Identifier: GPL-2.0-only */
+/*
+ * Copyright (c) 2022 MediaTek Inc.
+ * Author: Edward-JW Yang <edward-jw.yang@mediatek.com>
+ */
+
+#ifndef __DRV_CLKFH_H
+#define __DRV_CLKFH_H
+
+#include "clk-pll.h"
+
+struct fh_pll_state {
+ void __iomem *base;
+ u32 fh_enable;
+ u32 ssc_rate;
+};
+
+struct fh_pll_data {
+ int pll_id;
+ int fh_id;
+ u32 fhx_offset;
+ u32 dds_mask;
+ u32 slope0_value;
+ u32 slope1_value;
+ u32 sfstrx_en;
+ u32 frddsx_en;
+ u32 fhctlx_en;
+ u32 tgl_org;
+ u32 dvfs_tri;
+ u32 pcwchg;
+ u32 dt_val;
+ u32 df_val;
+ u32 updnlmt_shft;
+ u32 msk_frddsx_dys;
+ u32 msk_frddsx_dts;
+};
+
+struct mtk_pllfh_data {
+ struct fh_pll_state state;
+ const struct fh_pll_data data;
+};
+
+struct fh_pll_regs {
+ void __iomem *reg_hp_en;
+ void __iomem *reg_clk_con;
+ void __iomem *reg_rst_con;
+ void __iomem *reg_slope0;
+ void __iomem *reg_slope1;
+ void __iomem *reg_cfg;
+ void __iomem *reg_updnlmt;
+ void __iomem *reg_dds;
+ void __iomem *reg_dvfs;
+ void __iomem *reg_mon;
+};
+
+struct mtk_fh {
+ struct mtk_clk_pll clk_pll;
+ struct fh_pll_regs regs;
+ struct mtk_pllfh_data *pllfh_data;
+ const struct fh_operation *ops;
+ spinlock_t *lock;
+};
+
+struct fh_operation {
+ int (*hopping)(struct mtk_fh *fh, unsigned int new_dds,
+ unsigned int postdiv);
+ int (*ssc_enable)(struct mtk_fh *fh, u32 rate);
+};
+
+int mtk_clk_register_pllfhs(struct device_node *node,
+ const struct mtk_pll_data *plls, int num_plls,
+ struct mtk_pllfh_data *pllfhs, int num_pllfhs,
+ struct clk_hw_onecell_data *clk_data);
+
+void mtk_clk_unregister_pllfhs(const struct mtk_pll_data *plls, int num_plls,
+ struct mtk_pllfh_data *pllfhs, int num_fhs,
+ struct clk_hw_onecell_data *clk_data);
+
+void fhctl_parse_dt(const u8 *compatible_node, struct mtk_pllfh_data *pllfhs,
+ int num_pllfhs);
+
+#endif /* __DRV_CLKFH_H */
--
2.18.0
On Wed, 2022-09-14 at 20:45 +0800, Johnson Wang wrote: > To implement frequency hopping and spread spectrum clocking > function, we introduce new clock type and APIs to handle > FHCTL hardware. > > Co-developed-by: Edward-JW Yang <edward-jw.yang@mediatek.com> > Signed-off-by: Edward-JW Yang <edward-jw.yang@mediatek.com> > Signed-off-by: Johnson Wang <johnson.wang@mediatek.com> > --- > drivers/clk/mediatek/Makefile | 2 +- > drivers/clk/mediatek/clk-fhctl.c | 244 ++++++++++++++++++++++++++++ > drivers/clk/mediatek/clk-fhctl.h | 26 +++ > drivers/clk/mediatek/clk-pllfh.c | 268 +++++++++++++++++++++++++++++++ > drivers/clk/mediatek/clk-pllfh.h | 82 ++++++++++ > 5 files changed, 621 insertions(+), 1 deletion(-) > create mode 100644 drivers/clk/mediatek/clk-fhctl.c > create mode 100644 drivers/clk/mediatek/clk-fhctl.h > create mode 100644 drivers/clk/mediatek/clk-pllfh.c > create mode 100644 drivers/clk/mediatek/clk-pllfh.h > > diff --git a/drivers/clk/mediatek/Makefile b/drivers/clk/mediatek/Makefile > index caf2ce93d666..0e674a55e51e 100644 > --- a/drivers/clk/mediatek/Makefile > +++ b/drivers/clk/mediatek/Makefile > @@ -1,5 +1,5 @@ > # SPDX-License-Identifier: GPL-2.0 > -obj-$(CONFIG_COMMON_CLK_MEDIATEK) += clk-mtk.o clk-pll.o clk-gate.o clk-apmixed.o clk-cpumux.o reset.o clk-mux.o > +obj-$(CONFIG_COMMON_CLK_MEDIATEK) += clk-mtk.o clk-pll.o clk-gate.o clk-apmixed.o clk-cpumux.o reset.o clk-mux.o clk-fhctl.o clk-pllfh.o We need to add a config for clk-fhctl.o and clk-pllfh.o. It's only used by specfic project. > > obj-$(CONFIG_COMMON_CLK_MT6765) += clk-mt6765.o > obj-$(CONFIG_COMMON_CLK_MT6765_AUDIOSYS) += clk-mt6765-audio.o > diff --git a/drivers/clk/mediatek/clk-fhctl.c b/drivers/clk/mediatek/clk-fhctl.c > new file mode 100644 > index 000000000000..4f271acef5fe > --- /dev/null > +++ b/drivers/clk/mediatek/clk-fhctl.c > @@ -0,0 +1,244 @@ > +// SPDX-License-Identifier: GPL-2.0-only > +/* > + * Copyright (c) 2022 MediaTek Inc. > + * Author: Edward-JW Yang <edward-jw.yang@mediatek.com> > + */ > + > +#include <linux/io.h> > +#include <linux/iopoll.h> > + > +#include "clk-mtk.h" > +#include "clk-pllfh.h" > +#include "clk-fhctl.h" > + > +#define PERCENT_TO_DDSLMT(dds, percent_m10) \ > + ((((dds) * (percent_m10)) >> 5) / 100) > + > +static const struct fhctl_offset fhctl_offset = { > + .offset_hp_en = 0x0, > + .offset_clk_con = 0x8, > + .offset_rst_con = 0xc, > + .offset_slope0 = 0x10, > + .offset_slope1 = 0x14, > + .offset_cfg = 0x0, > + .offset_updnlmt = 0x4, > + .offset_dds = 0x8, > + .offset_dvfs = 0xc, > + .offset_mon = 0x10, > +}; > + > +const struct fhctl_offset *fhctl_get_offset_table(void) > +{ > + return &fhctl_offset; > +} > + > +static void dump_hw(struct mtk_clk_pll *pll, struct fh_pll_regs *regs, > + const struct fh_pll_data *data) > +{ > + pr_info("hp_en<%x>,clk_con<%x>,slope0<%x>,slope1<%x>\n", > + readl(regs->reg_hp_en), readl(regs->reg_clk_con), > + readl(regs->reg_slope0), readl(regs->reg_slope1)); > + pr_info("cfg<%x>,lmt<%x>,dds<%x>,dvfs<%x>,mon<%x>\n", > + readl(regs->reg_cfg), readl(regs->reg_updnlmt), > + readl(regs->reg_dds), readl(regs->reg_dvfs), > + readl(regs->reg_mon)); > + pr_info("pcw<%x>\n", readl(pll->pcw_addr)); > +} > + > +static int fhctl_set_ssc_regs(struct mtk_clk_pll *pll, struct fh_pll_regs *regs, > + const struct fh_pll_data *data, u32 rate) > +{ > + u32 updnlmt_val, r; > + > + writel((readl(regs->reg_cfg) & ~(data->frddsx_en)), regs->reg_cfg); > + writel((readl(regs->reg_cfg) & ~(data->sfstrx_en)), regs->reg_cfg); > + writel((readl(regs->reg_cfg) & ~(data->fhctlx_en)), regs->reg_cfg); > + > + if (rate > 0) { > + /* Set the relative parameter registers (dt/df/upbnd/downbnd) */ > + r = readl(regs->reg_cfg); > + r &= ~(data->msk_frddsx_dys); > + r |= (data->df_val << (ffs(data->msk_frddsx_dys) - 1)); > + writel(r, regs->reg_cfg); > + > + r = readl(regs->reg_cfg); > + r &= ~(data->msk_frddsx_dts); > + r |= (data->dt_val << (ffs(data->msk_frddsx_dts) - 1)); > + writel(r, regs->reg_cfg); > + > + writel((readl(pll->pcw_addr) & data->dds_mask) | data->tgl_org, > + regs->reg_dds); > + > + /* Calculate UPDNLMT */ > + updnlmt_val = PERCENT_TO_DDSLMT((readl(regs->reg_dds) & > + data->dds_mask), rate) << > + data->updnlmt_shft; > + > + writel(updnlmt_val, regs->reg_updnlmt); > + writel(readl(regs->reg_hp_en) | BIT(data->fh_id), > + regs->reg_hp_en); > + /* Enable SSC */ > + writel(readl(regs->reg_cfg) | data->frddsx_en, regs->reg_cfg); > + /* Enable Hopping control */ > + writel(readl(regs->reg_cfg) | data->fhctlx_en, regs->reg_cfg); > + > + } else { > + /* Switch to APMIXEDSYS control */ > + writel(readl(regs->reg_hp_en) & ~BIT(data->fh_id), > + regs->reg_hp_en); > + /* Wait for DDS to be stable */ > + udelay(30); > + } > + > + return 0; > +} > + > +static int hopping_hw_flow(struct mtk_clk_pll *pll, struct fh_pll_regs *regs, > + const struct fh_pll_data *data, > + struct fh_pll_state *state, unsigned int new_dds) > +{ > + u32 dds_mask = data->dds_mask; > + u32 mon_dds = 0; > + u32 con_pcw_tmp; > + int ret; > + > + if (state->ssc_rate) > + fhctl_set_ssc_regs(pll, regs, data, 0); > + > + writel((readl(pll->pcw_addr) & dds_mask) | data->tgl_org, > + regs->reg_dds); > + > + writel(readl(regs->reg_cfg) | data->sfstrx_en, regs->reg_cfg); > + writel(readl(regs->reg_cfg) | data->fhctlx_en, regs->reg_cfg); > + writel(data->slope0_value, regs->reg_slope0); > + writel(data->slope1_value, regs->reg_slope1); > + > + writel(readl(regs->reg_hp_en) | BIT(data->fh_id), regs->reg_hp_en); > + writel((new_dds) | (data->dvfs_tri), regs->reg_dvfs); > + > + /* Wait 1000 us until DDS stable */ > + ret = readl_poll_timeout_atomic(regs->reg_mon, mon_dds, > + (mon_dds & dds_mask) == new_dds, > + 10, 1000); > + if (ret) { > + pr_warn("%s: FHCTL hopping timeout\n", pll->data->name); > + dump_hw(pll, regs, data); > + } > + > + con_pcw_tmp = readl(pll->pcw_addr) & (~dds_mask); > + con_pcw_tmp = (con_pcw_tmp | (readl(regs->reg_mon) & dds_mask) | > + data->pcwchg); > + > + writel(con_pcw_tmp, pll->pcw_addr); > + writel(readl(regs->reg_hp_en) & ~BIT(data->fh_id), regs->reg_hp_en); > + > + if (state->ssc_rate) > + fhctl_set_ssc_regs(pll, regs, data, state->ssc_rate); > + > + return ret; > +} > + > +static unsigned int __get_postdiv(struct mtk_clk_pll *pll) > +{ > + unsigned int regval; > + > + regval = readl(pll->pd_addr) >> pll->data->pd_shift; > + regval &= POSTDIV_MASK; > + > + return BIT(regval); > +} > + > +static void __set_postdiv(struct mtk_clk_pll *pll, unsigned int postdiv) > +{ > + unsigned int regval; > + > + regval = readl(pll->pd_addr); > + regval &= ~(POSTDIV_MASK << pll->data->pd_shift); > + regval |= (ffs(postdiv) - 1) << pll->data->pd_shift; > + writel(regval, pll->pd_addr); > +} > + > +static int fhctl_hopping(struct mtk_fh *fh, unsigned int new_dds, > + unsigned int postdiv) > +{ > + const struct fh_pll_data *data = &fh->pllfh_data->data; > + struct fh_pll_state *state = &fh->pllfh_data->state; > + struct fh_pll_regs *regs = &fh->regs; > + struct mtk_clk_pll *pll = &fh->clk_pll; > + spinlock_t *lock = fh->lock; > + unsigned int pll_postdiv; > + unsigned long flags = 0; > + int ret; > + > + if (postdiv) { > + pll_postdiv = __get_postdiv(pll); > + > + if (postdiv > pll_postdiv) > + __set_postdiv(pll, postdiv); > + } > + > + spin_lock_irqsave(lock, flags); > + > + ret = hopping_hw_flow(pll, regs, data, state, new_dds); > + > + spin_unlock_irqrestore(lock, flags); > + > + if (postdiv && postdiv < pll_postdiv) > + __set_postdiv(pll, postdiv); > + > + return ret; > +} > + > +static int fhctl_ssc_enable(struct mtk_fh *fh, u32 rate) > +{ > + const struct fh_pll_data *data = &fh->pllfh_data->data; > + struct fh_pll_state *state = &fh->pllfh_data->state; > + struct fh_pll_regs *regs = &fh->regs; > + struct mtk_clk_pll *pll = &fh->clk_pll; > + spinlock_t *lock = fh->lock; > + unsigned long flags = 0; > + > + spin_lock_irqsave(lock, flags); > + > + fhctl_set_ssc_regs(pll, regs, data, rate); > + state->ssc_rate = rate; > + > + spin_unlock_irqrestore(lock, flags); > + > + return 0; > +} > + > +static const struct fh_operation fhctl_ops = { > + .hopping = fhctl_hopping, > + .ssc_enable = fhctl_ssc_enable, > +}; > + > +const struct fh_operation *fhctl_get_ops(void) > +{ > + return &fhctl_ops; > +} > + > +void fhctl_hw_init(struct mtk_fh *fh) > +{ > + const struct fh_pll_data data = fh->pllfh_data->data; > + struct fh_pll_state state = fh->pllfh_data->state; > + struct fh_pll_regs regs = fh->regs; > + u32 val; > + > + /* initial hw register */ > + val = readl(regs.reg_clk_con) | BIT(data.fh_id); > + writel(val, regs.reg_clk_con); > + > + val = readl(regs.reg_rst_con) & ~BIT(data.fh_id); > + writel(val, regs.reg_rst_con); > + val = readl(regs.reg_rst_con) | BIT(data.fh_id); > + writel(val, regs.reg_rst_con); > + > + writel(0x0, regs.reg_cfg); > + writel(0x0, regs.reg_updnlmt); > + writel(0x0, regs.reg_dds); > + > + /* enable ssc if needed */ > + if (state.ssc_rate) > + fh->ops->ssc_enable(fh, state.ssc_rate); > +} > diff --git a/drivers/clk/mediatek/clk-fhctl.h b/drivers/clk/mediatek/clk-fhctl.h > new file mode 100644 > index 000000000000..51275febf086 > --- /dev/null > +++ b/drivers/clk/mediatek/clk-fhctl.h > @@ -0,0 +1,26 @@ > +/* SPDX-License-Identifier: GPL-2.0-only */ > +/* > + * Copyright (c) 2022 MediaTek Inc. > + * Author: Edward-JW Yang <edward-jw.yang@mediatek.com> > + */ > + > +#ifndef __CLK_FHCTL_H > +#define __CLK_FHCTL_H > + > +struct fhctl_offset { > + u32 offset_hp_en; > + u32 offset_clk_con; > + u32 offset_rst_con; > + u32 offset_slope0; > + u32 offset_slope1; > + u32 offset_cfg; > + u32 offset_updnlmt; > + u32 offset_dds; > + u32 offset_dvfs; > + u32 offset_mon; > +}; > +const struct fhctl_offset *fhctl_get_offset_table(void); > +const struct fh_operation *fhctl_get_ops(void); > +void fhctl_hw_init(struct mtk_fh *fh); > + > +#endif > diff --git a/drivers/clk/mediatek/clk-pllfh.c b/drivers/clk/mediatek/clk-pllfh.c > new file mode 100644 > index 000000000000..15e5781fecca > --- /dev/null > +++ b/drivers/clk/mediatek/clk-pllfh.c > @@ -0,0 +1,268 @@ > +// SPDX-License-Identifier: GPL-2.0-only > +/* > + * Copyright (c) 2022 MediaTek Inc. > + * Author: Edward-JW Yang <edward-jw.yang@mediatek.com> > + */ > + > +#include <linux/of.h> > +#include <linux/of_address.h> > +#include <linux/io.h> > +#include <linux/slab.h> > +#include <linux/clkdev.h> > +#include <linux/delay.h> > + > +#include "clk-mtk.h" > +#include "clk-pllfh.h" > +#include "clk-fhctl.h" > + > +static DEFINE_SPINLOCK(pllfh_lock); > + > +inline struct mtk_fh *to_mtk_fh(struct clk_hw *hw) > +{ > + struct mtk_clk_pll *pll = to_mtk_clk_pll(hw); > + > + return container_of(pll, struct mtk_fh, clk_pll); > +} > + > +static int mtk_fhctl_set_rate(struct clk_hw *hw, unsigned long rate, > + unsigned long parent_rate) > +{ > + struct mtk_clk_pll *pll = to_mtk_clk_pll(hw); > + struct mtk_fh *fh = to_mtk_fh(hw); > + u32 pcw = 0; > + u32 postdiv; > + > + mtk_pll_calc_values(pll, &pcw, &postdiv, rate, parent_rate); > + > + return fh->ops->hopping(fh, pcw, postdiv); > +} > + > +static const struct clk_ops mtk_pllfh_ops = { > + .is_prepared = mtk_pll_is_prepared, > + .prepare = mtk_pll_prepare, > + .unprepare = mtk_pll_unprepare, > + .recalc_rate = mtk_pll_recalc_rate, > + .round_rate = mtk_pll_round_rate, > + .set_rate = mtk_fhctl_set_rate, > +}; > + > +static struct mtk_pllfh_data *get_pllfh_by_id(struct mtk_pllfh_data *pllfhs, > + int num_fhs, int pll_id) > +{ > + int i; > + > + for (i = 0; i < num_fhs; i++) > + if (pllfhs[i].data.pll_id == pll_id) > + return &pllfhs[i]; > + > + return NULL; > +} > + > +void fhctl_parse_dt(const u8 *compatible_node, struct mtk_pllfh_data *pllfhs, > + int num_fhs) > +{ > + void __iomem *base; > + struct device_node *node; > + u32 num_clocks, pll_id, ssc_rate; > + int offset, i; > + > + node = of_find_compatible_node(NULL, NULL, compatible_node); > + if (!node) { > + pr_err("cannot find \"%s\"\n", compatible_node); > + return; > + } > + > + base = of_iomap(node, 0); > + if (!base) { > + pr_err("%s(): ioremap failed\n", __func__); > + return; > + } > + > + num_clocks = of_clk_get_parent_count(node); > + if (!num_clocks) { > + pr_err("%s(): failed to get clocks property\n", __func__); > + return; > + } > + > + for (i = 0; i < num_clocks; i++) { > + struct mtk_pllfh_data *pllfh; > + > + offset = i * 2; > + > + of_property_read_u32_index(node, "clocks", offset + 1, &pll_id); > + of_property_read_u32_index(node, > + "mediatek,hopping-ssc-percents", > + i, &ssc_rate); > + > + pllfh = get_pllfh_by_id(pllfhs, num_fhs, pll_id); > + if (!pllfh) > + continue; > + > + pllfh->state.fh_enable = 1; > + pllfh->state.ssc_rate = ssc_rate; > + pllfh->state.base = base; > + } > +} > + > +static void pllfh_init(struct mtk_fh *fh, struct mtk_pllfh_data *pllfh_data) > +{ > + struct fh_pll_regs *regs = &fh->regs; > + const struct fhctl_offset *offset; > + void __iomem *base = pllfh_data->state.base; > + void __iomem *fhx_base = base + pllfh_data->data.fhx_offset; > + > + offset = fhctl_get_offset_table(); > + > + regs->reg_hp_en = base + offset->offset_hp_en; > + regs->reg_clk_con = base + offset->offset_clk_con; > + regs->reg_rst_con = base + offset->offset_rst_con; > + regs->reg_slope0 = base + offset->offset_slope0; > + regs->reg_slope1 = base + offset->offset_slope1; > + > + regs->reg_cfg = fhx_base + offset->offset_cfg; > + regs->reg_updnlmt = fhx_base + offset->offset_updnlmt; > + regs->reg_dds = fhx_base + offset->offset_dds; > + regs->reg_dvfs = fhx_base + offset->offset_dvfs; > + regs->reg_mon = fhx_base + offset->offset_mon; > + > + fh->pllfh_data = pllfh_data; > + fh->lock = &pllfh_lock; > + > + fh->ops = fhctl_get_ops(); > +} > + > +static bool fhctl_is_supported_and_enabled(const struct mtk_pllfh_data *pllfh) > +{ > + return pllfh && (pllfh->state.fh_enable == 1); > +} > + > +static struct clk_hw * > +mtk_clk_register_pllfh(const struct mtk_pll_data *pll_data, > + struct mtk_pllfh_data *pllfh_data, void __iomem *base) > +{ > + struct clk_hw *hw; > + struct mtk_fh *fh; > + > + fh = kzalloc(sizeof(*fh), GFP_KERNEL); > + if (!fh) > + return ERR_PTR(-ENOMEM); > + > + pllfh_init(fh, pllfh_data); > + > + hw = mtk_clk_register_pll_ops(&fh->clk_pll, pll_data, base, > + &mtk_pllfh_ops); > + > + if (IS_ERR(hw)) > + kfree(fh); > + else > + fhctl_hw_init(fh); > + > + return hw; > +} > + > +static void mtk_clk_unregister_pllfh(struct clk_hw *hw) > +{ > + struct mtk_fh *fh; > + > + if (!hw) > + return; > + > + fh = to_mtk_fh(hw); > + > + clk_hw_unregister(hw); > + kfree(fh); > +} > + > +int mtk_clk_register_pllfhs(struct device_node *node, > + const struct mtk_pll_data *plls, int num_plls, > + struct mtk_pllfh_data *pllfhs, int num_fhs, > + struct clk_hw_onecell_data *clk_data) > +{ > + void __iomem *base; > + int i; > + struct clk_hw *hw; > + > + base = of_iomap(node, 0); > + if (!base) { > + pr_err("%s(): ioremap failed\n", __func__); > + return -EINVAL; > + } > + > + for (i = 0; i < num_plls; i++) { > + const struct mtk_pll_data *pll = &plls[i]; > + struct mtk_pllfh_data *pllfh; > + > + pllfh = get_pllfh_by_id(pllfhs, num_fhs, pll->id); > + > + if (fhctl_is_supported_and_enabled(pllfh)) > + hw = mtk_clk_register_pllfh(pll, pllfh, base); > + else > + hw = mtk_clk_register_pll(pll, base); > + > + if (IS_ERR(hw)) { > + pr_err("Failed to register clk %s: %pe\n", pll->name, > + hw); > + goto err; > + } > + > + clk_data->hws[pll->id] = hw; > + } > + > + return 0; > + > +err: > + while (--i >= 0) { > + const struct mtk_pll_data *pll = &plls[i]; > + struct mtk_pllfh_data *pllfh; > + > + pllfh = get_pllfh_by_id(pllfhs, num_fhs, pll->id); > + > + if (fhctl_is_supported_and_enabled(pllfh)) > + mtk_clk_unregister_pllfh(clk_data->hws[pll->id]); > + else > + mtk_clk_unregister_pll(clk_data->hws[pll->id]); > + > + clk_data->hws[pll->id] = ERR_PTR(-ENOENT); > + } > + > + iounmap(base); > + > + return PTR_ERR(hw); > +} > + > +void mtk_clk_unregister_pllfhs(const struct mtk_pll_data *plls, int num_plls, > + struct mtk_pllfh_data *pllfhs, int num_fhs, > + struct clk_hw_onecell_data *clk_data) > +{ > + void __iomem *base = NULL, *fhctl_base = NULL; > + int i; > + > + if (!clk_data) > + return; > + > + for (i = num_plls; i > 0; i--) { > + const struct mtk_pll_data *pll = &plls[i - 1]; > + struct mtk_pllfh_data *pllfh; > + > + if (IS_ERR_OR_NULL(clk_data->hws[pll->id])) > + continue; > + > + pllfh = get_pllfh_by_id(pllfhs, num_fhs, pll->id); > + > + if (fhctl_is_supported_and_enabled(pllfh)) { > + fhctl_base = pllfh->state.base; > + mtk_clk_unregister_pllfh(clk_data->hws[pll->id]); > + } else { > + base = mtk_clk_pll_get_base(clk_data->hws[pll->id], > + pll); > + mtk_clk_unregister_pll(clk_data->hws[pll->id]); > + } > + > + clk_data->hws[pll->id] = ERR_PTR(-ENOENT); > + } > + > + if (fhctl_base) > + iounmap(fhctl_base); > + > + iounmap(base); > +} > diff --git a/drivers/clk/mediatek/clk-pllfh.h b/drivers/clk/mediatek/clk-pllfh.h > new file mode 100644 > index 000000000000..effc7976c496 > --- /dev/null > +++ b/drivers/clk/mediatek/clk-pllfh.h > @@ -0,0 +1,82 @@ > +/* SPDX-License-Identifier: GPL-2.0-only */ > +/* > + * Copyright (c) 2022 MediaTek Inc. > + * Author: Edward-JW Yang <edward-jw.yang@mediatek.com> > + */ > + > +#ifndef __DRV_CLKFH_H > +#define __DRV_CLKFH_H > + > +#include "clk-pll.h" > + > +struct fh_pll_state { > + void __iomem *base; > + u32 fh_enable; > + u32 ssc_rate; > +}; > + > +struct fh_pll_data { > + int pll_id; > + int fh_id; > + u32 fhx_offset; > + u32 dds_mask; > + u32 slope0_value; > + u32 slope1_value; > + u32 sfstrx_en; > + u32 frddsx_en; > + u32 fhctlx_en; > + u32 tgl_org; > + u32 dvfs_tri; > + u32 pcwchg; > + u32 dt_val; > + u32 df_val; > + u32 updnlmt_shft; > + u32 msk_frddsx_dys; > + u32 msk_frddsx_dts; > +}; > + > +struct mtk_pllfh_data { > + struct fh_pll_state state; > + const struct fh_pll_data data; > +}; > + > +struct fh_pll_regs { > + void __iomem *reg_hp_en; > + void __iomem *reg_clk_con; > + void __iomem *reg_rst_con; > + void __iomem *reg_slope0; > + void __iomem *reg_slope1; > + void __iomem *reg_cfg; > + void __iomem *reg_updnlmt; > + void __iomem *reg_dds; > + void __iomem *reg_dvfs; > + void __iomem *reg_mon; > +}; > + > +struct mtk_fh { > + struct mtk_clk_pll clk_pll; > + struct fh_pll_regs regs; > + struct mtk_pllfh_data *pllfh_data; > + const struct fh_operation *ops; > + spinlock_t *lock; > +}; > + > +struct fh_operation { > + int (*hopping)(struct mtk_fh *fh, unsigned int new_dds, > + unsigned int postdiv); > + int (*ssc_enable)(struct mtk_fh *fh, u32 rate); > +}; > + > +int mtk_clk_register_pllfhs(struct device_node *node, > + const struct mtk_pll_data *plls, int num_plls, > + struct mtk_pllfh_data *pllfhs, int num_pllfhs, > + struct clk_hw_onecell_data *clk_data); > + > +void mtk_clk_unregister_pllfhs(const struct mtk_pll_data *plls, int num_plls, > + struct mtk_pllfh_data *pllfhs, int num_fhs, > + struct clk_hw_onecell_data *clk_data); > + > +void fhctl_parse_dt(const u8 *compatible_node, struct mtk_pllfh_data *pllfhs, > + int num_pllfhs); > + > +#endif /* __DRV_CLKFH_H */ > -- > 2.18.0 >
On Tue, 2022-09-27 at 18:56 +0800, Edward-JW Yang wrote: > On Wed, 2022-09-14 at 20:45 +0800, Johnson Wang wrote: > > To implement frequency hopping and spread spectrum clocking > > function, we introduce new clock type and APIs to handle > > FHCTL hardware. > > > > Co-developed-by: Edward-JW Yang <edward-jw.yang@mediatek.com> > > Signed-off-by: Edward-JW Yang <edward-jw.yang@mediatek.com> > > Signed-off-by: Johnson Wang <johnson.wang@mediatek.com> > > --- > > drivers/clk/mediatek/Makefile | 2 +- > > drivers/clk/mediatek/clk-fhctl.c | 244 > > ++++++++++++++++++++++++++++ > > drivers/clk/mediatek/clk-fhctl.h | 26 +++ > > drivers/clk/mediatek/clk-pllfh.c | 268 > > +++++++++++++++++++++++++++++++ > > drivers/clk/mediatek/clk-pllfh.h | 82 ++++++++++ > > 5 files changed, 621 insertions(+), 1 deletion(-) > > create mode 100644 drivers/clk/mediatek/clk-fhctl.c > > create mode 100644 drivers/clk/mediatek/clk-fhctl.h > > create mode 100644 drivers/clk/mediatek/clk-pllfh.c > > create mode 100644 drivers/clk/mediatek/clk-pllfh.h > > > > diff --git a/drivers/clk/mediatek/Makefile > > b/drivers/clk/mediatek/Makefile > > index caf2ce93d666..0e674a55e51e 100644 > > --- a/drivers/clk/mediatek/Makefile > > +++ b/drivers/clk/mediatek/Makefile > > @@ -1,5 +1,5 @@ > > # SPDX-License-Identifier: GPL-2.0 > > -obj-$(CONFIG_COMMON_CLK_MEDIATEK) += clk-mtk.o clk-pll.o clk- > > gate.o clk-apmixed.o clk-cpumux.o reset.o clk-mux.o > > +obj-$(CONFIG_COMMON_CLK_MEDIATEK) += clk-mtk.o clk-pll.o clk- > > gate.o clk-apmixed.o clk-cpumux.o reset.o clk-mux.o clk-fhctl.o > > clk-pllfh.o > > We need to add a config for clk-fhctl.o and clk-pllfh.o. It's only > used by specfic > project. Hi Edward, Thanks for your suggestion. Then I will add one config symbol and make MT8186 to select it. BRs, Johnson Wang > > > > > obj-$(CONFIG_COMMON_CLK_MT6765) += clk-mt6765.o > > obj-$(CONFIG_COMMON_CLK_MT6765_AUDIOSYS) += clk-mt6765-audio.o > > diff --git a/drivers/clk/mediatek/clk-fhctl.c > > b/drivers/clk/mediatek/clk-fhctl.c > > new file mode 100644 > > index 000000000000..4f271acef5fe > > --- /dev/null > > +++ b/drivers/clk/mediatek/clk-fhctl.c > > @@ -0,0 +1,244 @@ > > +// SPDX-License-Identifier: GPL-2.0-only > > +/* > > + * Copyright (c) 2022 MediaTek Inc. > > + * Author: Edward-JW Yang <edward-jw.yang@mediatek.com> > > + */ > > + > > +#include <linux/io.h> > > +#include <linux/iopoll.h> > > + > > +#include "clk-mtk.h" > > +#include "clk-pllfh.h" > > +#include "clk-fhctl.h" > > + > > +#define PERCENT_TO_DDSLMT(dds, percent_m10) \ > > + ((((dds) * (percent_m10)) >> 5) / 100) > > + > > +static const struct fhctl_offset fhctl_offset = { > > + .offset_hp_en = 0x0, > > + .offset_clk_con = 0x8, > > + .offset_rst_con = 0xc, > > + .offset_slope0 = 0x10, > > + .offset_slope1 = 0x14, > > + .offset_cfg = 0x0, > > + .offset_updnlmt = 0x4, > > + .offset_dds = 0x8, > > + .offset_dvfs = 0xc, > > + .offset_mon = 0x10, > > +}; > > + > > +const struct fhctl_offset *fhctl_get_offset_table(void) > > +{ > > + return &fhctl_offset; > > +} > > + > > +static void dump_hw(struct mtk_clk_pll *pll, struct fh_pll_regs > > *regs, > > + const struct fh_pll_data *data) > > +{ > > + pr_info("hp_en<%x>,clk_con<%x>,slope0<%x>,slope1<%x>\n", > > + readl(regs->reg_hp_en), readl(regs->reg_clk_con), > > + readl(regs->reg_slope0), readl(regs->reg_slope1)); > > + pr_info("cfg<%x>,lmt<%x>,dds<%x>,dvfs<%x>,mon<%x>\n", > > + readl(regs->reg_cfg), readl(regs->reg_updnlmt), > > + readl(regs->reg_dds), readl(regs->reg_dvfs), > > + readl(regs->reg_mon)); > > + pr_info("pcw<%x>\n", readl(pll->pcw_addr)); > > +} > > + > > +static int fhctl_set_ssc_regs(struct mtk_clk_pll *pll, struct > > fh_pll_regs *regs, > > + const struct fh_pll_data *data, u32 rate) > > +{ > > + u32 updnlmt_val, r; > > + > > + writel((readl(regs->reg_cfg) & ~(data->frddsx_en)), regs- > > >reg_cfg); > > + writel((readl(regs->reg_cfg) & ~(data->sfstrx_en)), regs- > > >reg_cfg); > > + writel((readl(regs->reg_cfg) & ~(data->fhctlx_en)), regs- > > >reg_cfg); > > + > > + if (rate > 0) { > > + /* Set the relative parameter registers > > (dt/df/upbnd/downbnd) */ > > + r = readl(regs->reg_cfg); > > + r &= ~(data->msk_frddsx_dys); > > + r |= (data->df_val << (ffs(data->msk_frddsx_dys) - 1)); > > + writel(r, regs->reg_cfg); > > + > > + r = readl(regs->reg_cfg); > > + r &= ~(data->msk_frddsx_dts); > > + r |= (data->dt_val << (ffs(data->msk_frddsx_dts) - 1)); > > + writel(r, regs->reg_cfg); > > + > > + writel((readl(pll->pcw_addr) & data->dds_mask) | data- > > >tgl_org, > > + regs->reg_dds); > > + > > + /* Calculate UPDNLMT */ > > + updnlmt_val = PERCENT_TO_DDSLMT((readl(regs->reg_dds) & > > + data->dds_mask), rate) > > << > > + data->updnlmt_shft; > > + > > + writel(updnlmt_val, regs->reg_updnlmt); > > + writel(readl(regs->reg_hp_en) | BIT(data->fh_id), > > + regs->reg_hp_en); > > + /* Enable SSC */ > > + writel(readl(regs->reg_cfg) | data->frddsx_en, regs- > > >reg_cfg); > > + /* Enable Hopping control */ > > + writel(readl(regs->reg_cfg) | data->fhctlx_en, regs- > > >reg_cfg); > > + > > + } else { > > + /* Switch to APMIXEDSYS control */ > > + writel(readl(regs->reg_hp_en) & ~BIT(data->fh_id), > > + regs->reg_hp_en); > > + /* Wait for DDS to be stable */ > > + udelay(30); > > + } > > + > > + return 0; > > +} > > + > > +static int hopping_hw_flow(struct mtk_clk_pll *pll, struct > > fh_pll_regs *regs, > > + const struct fh_pll_data *data, > > + struct fh_pll_state *state, unsigned int > > new_dds) > > +{ > > + u32 dds_mask = data->dds_mask; > > + u32 mon_dds = 0; > > + u32 con_pcw_tmp; > > + int ret; > > + > > + if (state->ssc_rate) > > + fhctl_set_ssc_regs(pll, regs, data, 0); > > + > > + writel((readl(pll->pcw_addr) & dds_mask) | data->tgl_org, > > + regs->reg_dds); > > + > > + writel(readl(regs->reg_cfg) | data->sfstrx_en, regs->reg_cfg); > > + writel(readl(regs->reg_cfg) | data->fhctlx_en, regs->reg_cfg); > > + writel(data->slope0_value, regs->reg_slope0); > > + writel(data->slope1_value, regs->reg_slope1); > > + > > + writel(readl(regs->reg_hp_en) | BIT(data->fh_id), regs- > > >reg_hp_en); > > + writel((new_dds) | (data->dvfs_tri), regs->reg_dvfs); > > + > > + /* Wait 1000 us until DDS stable */ > > + ret = readl_poll_timeout_atomic(regs->reg_mon, mon_dds, > > + (mon_dds & dds_mask) == new_dds, > > + 10, 1000); > > + if (ret) { > > + pr_warn("%s: FHCTL hopping timeout\n", pll->data- > > >name); > > + dump_hw(pll, regs, data); > > + } > > + > > + con_pcw_tmp = readl(pll->pcw_addr) & (~dds_mask); > > + con_pcw_tmp = (con_pcw_tmp | (readl(regs->reg_mon) & dds_mask) > > | > > + data->pcwchg); > > + > > + writel(con_pcw_tmp, pll->pcw_addr); > > + writel(readl(regs->reg_hp_en) & ~BIT(data->fh_id), regs- > > >reg_hp_en); > > + > > + if (state->ssc_rate) > > + fhctl_set_ssc_regs(pll, regs, data, state->ssc_rate); > > + > > + return ret; > > +} > > + > > +static unsigned int __get_postdiv(struct mtk_clk_pll *pll) > > +{ > > + unsigned int regval; > > + > > + regval = readl(pll->pd_addr) >> pll->data->pd_shift; > > + regval &= POSTDIV_MASK; > > + > > + return BIT(regval); > > +} > > + > > +static void __set_postdiv(struct mtk_clk_pll *pll, unsigned int > > postdiv) > > +{ > > + unsigned int regval; > > + > > + regval = readl(pll->pd_addr); > > + regval &= ~(POSTDIV_MASK << pll->data->pd_shift); > > + regval |= (ffs(postdiv) - 1) << pll->data->pd_shift; > > + writel(regval, pll->pd_addr); > > +} > > + > > +static int fhctl_hopping(struct mtk_fh *fh, unsigned int new_dds, > > + unsigned int postdiv) > > +{ > > + const struct fh_pll_data *data = &fh->pllfh_data->data; > > + struct fh_pll_state *state = &fh->pllfh_data->state; > > + struct fh_pll_regs *regs = &fh->regs; > > + struct mtk_clk_pll *pll = &fh->clk_pll; > > + spinlock_t *lock = fh->lock; > > + unsigned int pll_postdiv; > > + unsigned long flags = 0; > > + int ret; > > + > > + if (postdiv) { > > + pll_postdiv = __get_postdiv(pll); > > + > > + if (postdiv > pll_postdiv) > > + __set_postdiv(pll, postdiv); > > + } > > + > > + spin_lock_irqsave(lock, flags); > > + > > + ret = hopping_hw_flow(pll, regs, data, state, new_dds); > > + > > + spin_unlock_irqrestore(lock, flags); > > + > > + if (postdiv && postdiv < pll_postdiv) > > + __set_postdiv(pll, postdiv); > > + > > + return ret; > > +} > > + > > +static int fhctl_ssc_enable(struct mtk_fh *fh, u32 rate) > > +{ > > + const struct fh_pll_data *data = &fh->pllfh_data->data; > > + struct fh_pll_state *state = &fh->pllfh_data->state; > > + struct fh_pll_regs *regs = &fh->regs; > > + struct mtk_clk_pll *pll = &fh->clk_pll; > > + spinlock_t *lock = fh->lock; > > + unsigned long flags = 0; > > + > > + spin_lock_irqsave(lock, flags); > > + > > + fhctl_set_ssc_regs(pll, regs, data, rate); > > + state->ssc_rate = rate; > > + > > + spin_unlock_irqrestore(lock, flags); > > + > > + return 0; > > +} > > + > > +static const struct fh_operation fhctl_ops = { > > + .hopping = fhctl_hopping, > > + .ssc_enable = fhctl_ssc_enable, > > +}; > > + > > +const struct fh_operation *fhctl_get_ops(void) > > +{ > > + return &fhctl_ops; > > +} > > + > > +void fhctl_hw_init(struct mtk_fh *fh) > > +{ > > + const struct fh_pll_data data = fh->pllfh_data->data; > > + struct fh_pll_state state = fh->pllfh_data->state; > > + struct fh_pll_regs regs = fh->regs; > > + u32 val; > > + > > + /* initial hw register */ > > + val = readl(regs.reg_clk_con) | BIT(data.fh_id); > > + writel(val, regs.reg_clk_con); > > + > > + val = readl(regs.reg_rst_con) & ~BIT(data.fh_id); > > + writel(val, regs.reg_rst_con); > > + val = readl(regs.reg_rst_con) | BIT(data.fh_id); > > + writel(val, regs.reg_rst_con); > > + > > + writel(0x0, regs.reg_cfg); > > + writel(0x0, regs.reg_updnlmt); > > + writel(0x0, regs.reg_dds); > > + > > + /* enable ssc if needed */ > > + if (state.ssc_rate) > > + fh->ops->ssc_enable(fh, state.ssc_rate); > > +} > > diff --git a/drivers/clk/mediatek/clk-fhctl.h > > b/drivers/clk/mediatek/clk-fhctl.h > > new file mode 100644 > > index 000000000000..51275febf086 > > --- /dev/null > > +++ b/drivers/clk/mediatek/clk-fhctl.h > > @@ -0,0 +1,26 @@ > > +/* SPDX-License-Identifier: GPL-2.0-only */ > > +/* > > + * Copyright (c) 2022 MediaTek Inc. > > + * Author: Edward-JW Yang <edward-jw.yang@mediatek.com> > > + */ > > + > > +#ifndef __CLK_FHCTL_H > > +#define __CLK_FHCTL_H > > + > > +struct fhctl_offset { > > + u32 offset_hp_en; > > + u32 offset_clk_con; > > + u32 offset_rst_con; > > + u32 offset_slope0; > > + u32 offset_slope1; > > + u32 offset_cfg; > > + u32 offset_updnlmt; > > + u32 offset_dds; > > + u32 offset_dvfs; > > + u32 offset_mon; > > +}; > > +const struct fhctl_offset *fhctl_get_offset_table(void); > > +const struct fh_operation *fhctl_get_ops(void); > > +void fhctl_hw_init(struct mtk_fh *fh); > > + > > +#endif > > diff --git a/drivers/clk/mediatek/clk-pllfh.c > > b/drivers/clk/mediatek/clk-pllfh.c > > new file mode 100644 > > index 000000000000..15e5781fecca > > --- /dev/null > > +++ b/drivers/clk/mediatek/clk-pllfh.c > > @@ -0,0 +1,268 @@ > > +// SPDX-License-Identifier: GPL-2.0-only > > +/* > > + * Copyright (c) 2022 MediaTek Inc. > > + * Author: Edward-JW Yang <edward-jw.yang@mediatek.com> > > + */ > > + > > +#include <linux/of.h> > > +#include <linux/of_address.h> > > +#include <linux/io.h> > > +#include <linux/slab.h> > > +#include <linux/clkdev.h> > > +#include <linux/delay.h> > > + > > +#include "clk-mtk.h" > > +#include "clk-pllfh.h" > > +#include "clk-fhctl.h" > > + > > +static DEFINE_SPINLOCK(pllfh_lock); > > + > > +inline struct mtk_fh *to_mtk_fh(struct clk_hw *hw) > > +{ > > + struct mtk_clk_pll *pll = to_mtk_clk_pll(hw); > > + > > + return container_of(pll, struct mtk_fh, clk_pll); > > +} > > + > > +static int mtk_fhctl_set_rate(struct clk_hw *hw, unsigned long > > rate, > > + unsigned long parent_rate) > > +{ > > + struct mtk_clk_pll *pll = to_mtk_clk_pll(hw); > > + struct mtk_fh *fh = to_mtk_fh(hw); > > + u32 pcw = 0; > > + u32 postdiv; > > + > > + mtk_pll_calc_values(pll, &pcw, &postdiv, rate, parent_rate); > > + > > + return fh->ops->hopping(fh, pcw, postdiv); > > +} > > + > > +static const struct clk_ops mtk_pllfh_ops = { > > + .is_prepared = mtk_pll_is_prepared, > > + .prepare = mtk_pll_prepare, > > + .unprepare = mtk_pll_unprepare, > > + .recalc_rate = mtk_pll_recalc_rate, > > + .round_rate = mtk_pll_round_rate, > > + .set_rate = mtk_fhctl_set_rate, > > +}; > > + > > +static struct mtk_pllfh_data *get_pllfh_by_id(struct > > mtk_pllfh_data *pllfhs, > > + int num_fhs, int pll_id) > > +{ > > + int i; > > + > > + for (i = 0; i < num_fhs; i++) > > + if (pllfhs[i].data.pll_id == pll_id) > > + return &pllfhs[i]; > > + > > + return NULL; > > +} > > + > > +void fhctl_parse_dt(const u8 *compatible_node, struct > > mtk_pllfh_data *pllfhs, > > + int num_fhs) > > +{ > > + void __iomem *base; > > + struct device_node *node; > > + u32 num_clocks, pll_id, ssc_rate; > > + int offset, i; > > + > > + node = of_find_compatible_node(NULL, NULL, compatible_node); > > + if (!node) { > > + pr_err("cannot find \"%s\"\n", compatible_node); > > + return; > > + } > > + > > + base = of_iomap(node, 0); > > + if (!base) { > > + pr_err("%s(): ioremap failed\n", __func__); > > + return; > > + } > > + > > + num_clocks = of_clk_get_parent_count(node); > > + if (!num_clocks) { > > + pr_err("%s(): failed to get clocks property\n", > > __func__); > > + return; > > + } > > + > > + for (i = 0; i < num_clocks; i++) { > > + struct mtk_pllfh_data *pllfh; > > + > > + offset = i * 2; > > + > > + of_property_read_u32_index(node, "clocks", offset + 1, > > &pll_id); > > + of_property_read_u32_index(node, > > + "mediatek,hopping-ssc- > > percents", > > + i, &ssc_rate); > > + > > + pllfh = get_pllfh_by_id(pllfhs, num_fhs, pll_id); > > + if (!pllfh) > > + continue; > > + > > + pllfh->state.fh_enable = 1; > > + pllfh->state.ssc_rate = ssc_rate; > > + pllfh->state.base = base; > > + } > > +} > > + > > +static void pllfh_init(struct mtk_fh *fh, struct mtk_pllfh_data > > *pllfh_data) > > +{ > > + struct fh_pll_regs *regs = &fh->regs; > > + const struct fhctl_offset *offset; > > + void __iomem *base = pllfh_data->state.base; > > + void __iomem *fhx_base = base + pllfh_data->data.fhx_offset; > > + > > + offset = fhctl_get_offset_table(); > > + > > + regs->reg_hp_en = base + offset->offset_hp_en; > > + regs->reg_clk_con = base + offset->offset_clk_con; > > + regs->reg_rst_con = base + offset->offset_rst_con; > > + regs->reg_slope0 = base + offset->offset_slope0; > > + regs->reg_slope1 = base + offset->offset_slope1; > > + > > + regs->reg_cfg = fhx_base + offset->offset_cfg; > > + regs->reg_updnlmt = fhx_base + offset->offset_updnlmt; > > + regs->reg_dds = fhx_base + offset->offset_dds; > > + regs->reg_dvfs = fhx_base + offset->offset_dvfs; > > + regs->reg_mon = fhx_base + offset->offset_mon; > > + > > + fh->pllfh_data = pllfh_data; > > + fh->lock = &pllfh_lock; > > + > > + fh->ops = fhctl_get_ops(); > > +} > > + > > +static bool fhctl_is_supported_and_enabled(const struct > > mtk_pllfh_data *pllfh) > > +{ > > + return pllfh && (pllfh->state.fh_enable == 1); > > +} > > + > > +static struct clk_hw * > > +mtk_clk_register_pllfh(const struct mtk_pll_data *pll_data, > > + struct mtk_pllfh_data *pllfh_data, void __iomem > > *base) > > +{ > > + struct clk_hw *hw; > > + struct mtk_fh *fh; > > + > > + fh = kzalloc(sizeof(*fh), GFP_KERNEL); > > + if (!fh) > > + return ERR_PTR(-ENOMEM); > > + > > + pllfh_init(fh, pllfh_data); > > + > > + hw = mtk_clk_register_pll_ops(&fh->clk_pll, pll_data, base, > > + &mtk_pllfh_ops); > > + > > + if (IS_ERR(hw)) > > + kfree(fh); > > + else > > + fhctl_hw_init(fh); > > + > > + return hw; > > +} > > + > > +static void mtk_clk_unregister_pllfh(struct clk_hw *hw) > > +{ > > + struct mtk_fh *fh; > > + > > + if (!hw) > > + return; > > + > > + fh = to_mtk_fh(hw); > > + > > + clk_hw_unregister(hw); > > + kfree(fh); > > +} > > + > > +int mtk_clk_register_pllfhs(struct device_node *node, > > + const struct mtk_pll_data *plls, int > > num_plls, > > + struct mtk_pllfh_data *pllfhs, int num_fhs, > > + struct clk_hw_onecell_data *clk_data) > > +{ > > + void __iomem *base; > > + int i; > > + struct clk_hw *hw; > > + > > + base = of_iomap(node, 0); > > + if (!base) { > > + pr_err("%s(): ioremap failed\n", __func__); > > + return -EINVAL; > > + } > > + > > + for (i = 0; i < num_plls; i++) { > > + const struct mtk_pll_data *pll = &plls[i]; > > + struct mtk_pllfh_data *pllfh; > > + > > + pllfh = get_pllfh_by_id(pllfhs, num_fhs, pll->id); > > + > > + if (fhctl_is_supported_and_enabled(pllfh)) > > + hw = mtk_clk_register_pllfh(pll, pllfh, base); > > + else > > + hw = mtk_clk_register_pll(pll, base); > > + > > + if (IS_ERR(hw)) { > > + pr_err("Failed to register clk %s: %pe\n", pll- > > >name, > > + hw); > > + goto err; > > + } > > + > > + clk_data->hws[pll->id] = hw; > > + } > > + > > + return 0; > > + > > +err: > > + while (--i >= 0) { > > + const struct mtk_pll_data *pll = &plls[i]; > > + struct mtk_pllfh_data *pllfh; > > + > > + pllfh = get_pllfh_by_id(pllfhs, num_fhs, pll->id); > > + > > + if (fhctl_is_supported_and_enabled(pllfh)) > > + mtk_clk_unregister_pllfh(clk_data->hws[pll- > > >id]); > > + else > > + mtk_clk_unregister_pll(clk_data->hws[pll->id]); > > + > > + clk_data->hws[pll->id] = ERR_PTR(-ENOENT); > > + } > > + > > + iounmap(base); > > + > > + return PTR_ERR(hw); > > +} > > + > > +void mtk_clk_unregister_pllfhs(const struct mtk_pll_data *plls, > > int num_plls, > > + struct mtk_pllfh_data *pllfhs, int > > num_fhs, > > + struct clk_hw_onecell_data *clk_data) > > +{ > > + void __iomem *base = NULL, *fhctl_base = NULL; > > + int i; > > + > > + if (!clk_data) > > + return; > > + > > + for (i = num_plls; i > 0; i--) { > > + const struct mtk_pll_data *pll = &plls[i - 1]; > > + struct mtk_pllfh_data *pllfh; > > + > > + if (IS_ERR_OR_NULL(clk_data->hws[pll->id])) > > + continue; > > + > > + pllfh = get_pllfh_by_id(pllfhs, num_fhs, pll->id); > > + > > + if (fhctl_is_supported_and_enabled(pllfh)) { > > + fhctl_base = pllfh->state.base; > > + mtk_clk_unregister_pllfh(clk_data->hws[pll- > > >id]); > > + } else { > > + base = mtk_clk_pll_get_base(clk_data->hws[pll- > > >id], > > + pll); > > + mtk_clk_unregister_pll(clk_data->hws[pll->id]); > > + } > > + > > + clk_data->hws[pll->id] = ERR_PTR(-ENOENT); > > + } > > + > > + if (fhctl_base) > > + iounmap(fhctl_base); > > + > > + iounmap(base); > > +} > > diff --git a/drivers/clk/mediatek/clk-pllfh.h > > b/drivers/clk/mediatek/clk-pllfh.h > > new file mode 100644 > > index 000000000000..effc7976c496 > > --- /dev/null > > +++ b/drivers/clk/mediatek/clk-pllfh.h > > @@ -0,0 +1,82 @@ > > +/* SPDX-License-Identifier: GPL-2.0-only */ > > +/* > > + * Copyright (c) 2022 MediaTek Inc. > > + * Author: Edward-JW Yang <edward-jw.yang@mediatek.com> > > + */ > > + > > +#ifndef __DRV_CLKFH_H > > +#define __DRV_CLKFH_H > > + > > +#include "clk-pll.h" > > + > > +struct fh_pll_state { > > + void __iomem *base; > > + u32 fh_enable; > > + u32 ssc_rate; > > +}; > > + > > +struct fh_pll_data { > > + int pll_id; > > + int fh_id; > > + u32 fhx_offset; > > + u32 dds_mask; > > + u32 slope0_value; > > + u32 slope1_value; > > + u32 sfstrx_en; > > + u32 frddsx_en; > > + u32 fhctlx_en; > > + u32 tgl_org; > > + u32 dvfs_tri; > > + u32 pcwchg; > > + u32 dt_val; > > + u32 df_val; > > + u32 updnlmt_shft; > > + u32 msk_frddsx_dys; > > + u32 msk_frddsx_dts; > > +}; > > + > > +struct mtk_pllfh_data { > > + struct fh_pll_state state; > > + const struct fh_pll_data data; > > +}; > > + > > +struct fh_pll_regs { > > + void __iomem *reg_hp_en; > > + void __iomem *reg_clk_con; > > + void __iomem *reg_rst_con; > > + void __iomem *reg_slope0; > > + void __iomem *reg_slope1; > > + void __iomem *reg_cfg; > > + void __iomem *reg_updnlmt; > > + void __iomem *reg_dds; > > + void __iomem *reg_dvfs; > > + void __iomem *reg_mon; > > +}; > > + > > +struct mtk_fh { > > + struct mtk_clk_pll clk_pll; > > + struct fh_pll_regs regs; > > + struct mtk_pllfh_data *pllfh_data; > > + const struct fh_operation *ops; > > + spinlock_t *lock; > > +}; > > + > > +struct fh_operation { > > + int (*hopping)(struct mtk_fh *fh, unsigned int new_dds, > > + unsigned int postdiv); > > + int (*ssc_enable)(struct mtk_fh *fh, u32 rate); > > +}; > > + > > +int mtk_clk_register_pllfhs(struct device_node *node, > > + const struct mtk_pll_data *plls, int > > num_plls, > > + struct mtk_pllfh_data *pllfhs, int > > num_pllfhs, > > + struct clk_hw_onecell_data *clk_data); > > + > > +void mtk_clk_unregister_pllfhs(const struct mtk_pll_data *plls, > > int num_plls, > > + struct mtk_pllfh_data *pllfhs, int > > num_fhs, > > + struct clk_hw_onecell_data *clk_data); > > + > > +void fhctl_parse_dt(const u8 *compatible_node, struct > > mtk_pllfh_data *pllfhs, > > + int num_pllfhs); > > + > > +#endif /* __DRV_CLKFH_H */ > > -- > > 2.18.0 > > > >
© 2016 - 2024 Red Hat, Inc.