clk: mediatek: Add new clock driver to handle FHCTL hardware
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> Reviewed-by: AngeloGioacchino Del Regno <angelogioacchino.delregno@collabora.com> Link: https://lore.kernel.org/r/20221121122957.21611-4-johnson.wang@mediatek.com Signed-off-by: Chen-Yu Tsai <wenst@chromium.org>
This commit is contained in:
parent
cfcefe36bf
commit
d7964de8a8
@ -11,6 +11,13 @@ config COMMON_CLK_MEDIATEK
|
||||
help
|
||||
MediaTek SoCs' clock support.
|
||||
|
||||
config COMMON_CLK_MEDIATEK_FHCTL
|
||||
bool "clock driver for MediaTek FHCTL hardware control"
|
||||
select COMMON_CLK_MEDIATEK
|
||||
help
|
||||
This driver supports MediaTek frequency hopping and
|
||||
spread spectrum clocking features.
|
||||
|
||||
config COMMON_CLK_MT2701
|
||||
bool "Clock driver for MediaTek MT2701"
|
||||
depends on (ARCH_MEDIATEK && ARM) || COMPILE_TEST
|
||||
|
@ -1,5 +1,6 @@
|
||||
# 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_FHCTL) += clk-fhctl.o clk-pllfh.o
|
||||
|
||||
obj-$(CONFIG_COMMON_CLK_MT6765) += clk-mt6765.o
|
||||
obj-$(CONFIG_COMMON_CLK_MT6765_AUDIOSYS) += clk-mt6765-audio.o
|
||||
|
244
drivers/clk/mediatek/clk-fhctl.c
Normal file
244
drivers/clk/mediatek/clk-fhctl.c
Normal file
@ -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);
|
||||
}
|
26
drivers/clk/mediatek/clk-fhctl.h
Normal file
26
drivers/clk/mediatek/clk-fhctl.h
Normal file
@ -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
|
275
drivers/clk/mediatek/clk-pllfh.c
Normal file
275
drivers/clk/mediatek/clk-pllfh.c
Normal file
@ -0,0 +1,275 @@
|
||||
// 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-percent",
|
||||
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;
|
||||
bool use_fhctl;
|
||||
|
||||
pllfh = get_pllfh_by_id(pllfhs, num_fhs, pll->id);
|
||||
use_fhctl = fhctl_is_supported_and_enabled(pllfh);
|
||||
|
||||
if (use_fhctl)
|
||||
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 %s clk %s: %ld\n",
|
||||
use_fhctl ? "fhpll" : "pll", pll->name,
|
||||
PTR_ERR(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;
|
||||
bool use_fhctl;
|
||||
|
||||
pllfh = get_pllfh_by_id(pllfhs, num_fhs, pll->id);
|
||||
use_fhctl = fhctl_is_supported_and_enabled(pllfh);
|
||||
|
||||
if (use_fhctl)
|
||||
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;
|
||||
bool use_fhctl;
|
||||
|
||||
if (IS_ERR_OR_NULL(clk_data->hws[pll->id]))
|
||||
continue;
|
||||
|
||||
pllfh = get_pllfh_by_id(pllfhs, num_fhs, pll->id);
|
||||
use_fhctl = fhctl_is_supported_and_enabled(pllfh);
|
||||
|
||||
if (use_fhctl) {
|
||||
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);
|
||||
}
|
82
drivers/clk/mediatek/clk-pllfh.h
Normal file
82
drivers/clk/mediatek/clk-pllfh.h
Normal file
@ -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 __CLK_PLLFH_H
|
||||
#define __CLK_PLLFH_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 /* __CLK_PLLFH_H */
|
Loading…
x
Reference in New Issue
Block a user