mirror of
https://github.com/torvalds/linux.git
synced 2026-05-29 17:43:52 +02:00
ASoC: mediatek: mt8189: support audio clock control
Add audio clock wrapper and audio tuner control. Signed-off-by: Cyril Chao <Cyril.Chao@mediatek.com> Link: https://patch.msgid.link/20251031073216.8662-3-Cyril.Chao@mediatek.com Signed-off-by: Mark Brown <broonie@kernel.org>
This commit is contained in:
parent
81f8f29a48
commit
dc637ffeed
750
sound/soc/mediatek/mt8189/mt8189-afe-clk.c
Normal file
750
sound/soc/mediatek/mt8189/mt8189-afe-clk.c
Normal file
|
|
@ -0,0 +1,750 @@
|
|||
// SPDX-License-Identifier: GPL-2.0
|
||||
/*
|
||||
* mt8189-afe-clk.c -- Mediatek 8189 afe clock ctrl
|
||||
*
|
||||
* Copyright (c) 2025 MediaTek Inc.
|
||||
* Author: Darren Ye <darren.ye@mediatek.com>
|
||||
*/
|
||||
|
||||
#include <linux/clk.h>
|
||||
#include <linux/regmap.h>
|
||||
#include <linux/mfd/syscon.h>
|
||||
|
||||
#include "mt8189-afe-common.h"
|
||||
#include "mt8189-afe-clk.h"
|
||||
|
||||
/* mck */
|
||||
struct mt8189_mck_div {
|
||||
int m_sel_id;
|
||||
int div_clk_id;
|
||||
};
|
||||
|
||||
static const struct mt8189_mck_div mck_div[MT8189_MCK_NUM] = {
|
||||
[MT8189_I2SIN0_MCK] = {
|
||||
.m_sel_id = MT8189_CLK_TOP_I2SIN0_M_SEL,
|
||||
.div_clk_id = MT8189_CLK_TOP_APLL12_DIV_I2SIN0,
|
||||
},
|
||||
[MT8189_I2SIN1_MCK] = {
|
||||
.m_sel_id = MT8189_CLK_TOP_I2SIN1_M_SEL,
|
||||
.div_clk_id = MT8189_CLK_TOP_APLL12_DIV_I2SIN1,
|
||||
},
|
||||
[MT8189_I2SOUT0_MCK] = {
|
||||
.m_sel_id = MT8189_CLK_TOP_I2SOUT0_M_SEL,
|
||||
.div_clk_id = MT8189_CLK_TOP_APLL12_DIV_I2SOUT0,
|
||||
},
|
||||
[MT8189_I2SOUT1_MCK] = {
|
||||
.m_sel_id = MT8189_CLK_TOP_I2SOUT1_M_SEL,
|
||||
.div_clk_id = MT8189_CLK_TOP_APLL12_DIV_I2SOUT1,
|
||||
},
|
||||
[MT8189_FMI2S_MCK] = {
|
||||
.m_sel_id = MT8189_CLK_TOP_FMI2S_M_SEL,
|
||||
.div_clk_id = MT8189_CLK_TOP_APLL12_DIV_FMI2S,
|
||||
},
|
||||
[MT8189_TDMOUT_MCK] = {
|
||||
.m_sel_id = MT8189_CLK_TOP_TDMOUT_M_SEL,
|
||||
.div_clk_id = MT8189_CLK_TOP_APLL12_DIV_TDMOUT_M,
|
||||
},
|
||||
[MT8189_TDMOUT_BCK] = {
|
||||
.m_sel_id = -1,
|
||||
.div_clk_id = MT8189_CLK_TOP_APLL12_DIV_TDMOUT_B,
|
||||
},
|
||||
};
|
||||
|
||||
static const char *aud_clks[MT8189_CLK_NUM] = {
|
||||
[MT8189_CLK_TOP_MUX_AUDIOINTBUS] = "top_aud_intbus",
|
||||
[MT8189_CLK_TOP_MUX_AUD_ENG1] = "top_aud_eng1",
|
||||
[MT8189_CLK_TOP_MUX_AUD_ENG2] = "top_aud_eng2",
|
||||
[MT8189_CLK_TOP_MUX_AUDIO_H] = "top_aud_h",
|
||||
/* pll */
|
||||
[MT8189_CLK_TOP_APLL1_CK] = "apll1",
|
||||
[MT8189_CLK_TOP_APLL2_CK] = "apll2",
|
||||
/* divider */
|
||||
[MT8189_CLK_TOP_APLL1_D4] = "apll1_d4",
|
||||
[MT8189_CLK_TOP_APLL2_D4] = "apll2_d4",
|
||||
[MT8189_CLK_TOP_APLL12_DIV_I2SIN0] = "apll12_div_i2sin0",
|
||||
[MT8189_CLK_TOP_APLL12_DIV_I2SIN1] = "apll12_div_i2sin1",
|
||||
[MT8189_CLK_TOP_APLL12_DIV_I2SOUT0] = "apll12_div_i2sout0",
|
||||
[MT8189_CLK_TOP_APLL12_DIV_I2SOUT1] = "apll12_div_i2sout1",
|
||||
[MT8189_CLK_TOP_APLL12_DIV_FMI2S] = "apll12_div_fmi2s",
|
||||
[MT8189_CLK_TOP_APLL12_DIV_TDMOUT_M] = "apll12_div_tdmout_m",
|
||||
[MT8189_CLK_TOP_APLL12_DIV_TDMOUT_B] = "apll12_div_tdmout_b",
|
||||
/* mux */
|
||||
[MT8189_CLK_TOP_MUX_AUD_1] = "top_apll1",
|
||||
[MT8189_CLK_TOP_MUX_AUD_2] = "top_apll2",
|
||||
[MT8189_CLK_TOP_I2SIN0_M_SEL] = "top_i2sin0",
|
||||
[MT8189_CLK_TOP_I2SIN1_M_SEL] = "top_i2sin1",
|
||||
[MT8189_CLK_TOP_I2SOUT0_M_SEL] = "top_i2sout0",
|
||||
[MT8189_CLK_TOP_I2SOUT1_M_SEL] = "top_i2sout1",
|
||||
[MT8189_CLK_TOP_FMI2S_M_SEL] = "top_fmi2s",
|
||||
[MT8189_CLK_TOP_TDMOUT_M_SEL] = "top_dptx",
|
||||
/* top 26m*/
|
||||
[MT8189_CLK_TOP_CLK26M] = "clk26m",
|
||||
/* peri */
|
||||
[MT8189_CLK_PERAO_AUDIO_SLV_CK_PERI] = "aud_slv_ck_peri",
|
||||
[MT8189_CLK_PERAO_AUDIO_MST_CK_PERI] = "aud_mst_ck_peri",
|
||||
[MT8189_CLK_PERAO_INTBUS_CK_PERI] = "aud_intbus_ck_peri",
|
||||
};
|
||||
|
||||
int mt8189_afe_enable_clk(struct mtk_base_afe *afe, struct clk *clk)
|
||||
{
|
||||
int ret;
|
||||
|
||||
ret = clk_prepare_enable(clk);
|
||||
if (ret) {
|
||||
dev_err(afe->dev, "failed to enable clk\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
EXPORT_SYMBOL_GPL(mt8189_afe_enable_clk);
|
||||
|
||||
void mt8189_afe_disable_clk(struct mtk_base_afe *afe, struct clk *clk)
|
||||
{
|
||||
if (clk)
|
||||
clk_disable_unprepare(clk);
|
||||
else
|
||||
dev_dbg(afe->dev, "NULL clk\n");
|
||||
}
|
||||
EXPORT_SYMBOL_GPL(mt8189_afe_disable_clk);
|
||||
|
||||
static int mt8189_afe_set_clk_rate(struct mtk_base_afe *afe, struct clk *clk,
|
||||
unsigned int rate)
|
||||
{
|
||||
int ret;
|
||||
|
||||
if (clk) {
|
||||
ret = clk_set_rate(clk, rate);
|
||||
if (ret) {
|
||||
dev_err(afe->dev, "failed to set clk rate\n");
|
||||
return ret;
|
||||
}
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int mt8189_afe_set_clk_parent(struct mtk_base_afe *afe, struct clk *clk,
|
||||
struct clk *parent)
|
||||
{
|
||||
int ret;
|
||||
|
||||
if (clk && parent) {
|
||||
ret = clk_set_parent(clk, parent);
|
||||
if (ret) {
|
||||
dev_dbg(afe->dev, "failed to set clk parent %d\n", ret);
|
||||
return ret;
|
||||
}
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static unsigned int get_top_cg_reg(unsigned int cg_type)
|
||||
{
|
||||
switch (cg_type) {
|
||||
case MT8189_AUDIO_26M_EN_ON:
|
||||
case MT8189_AUDIO_F3P25M_EN_ON:
|
||||
case MT8189_AUDIO_APLL1_EN_ON:
|
||||
case MT8189_AUDIO_APLL2_EN_ON:
|
||||
return AUDIO_ENGEN_CON0;
|
||||
case MT8189_CG_AUDIO_HOPPING_CK:
|
||||
case MT8189_CG_AUDIO_F26M_CK:
|
||||
case MT8189_CG_APLL1_CK:
|
||||
case MT8189_CG_APLL2_CK:
|
||||
case MT8189_PDN_APLL_TUNER2:
|
||||
case MT8189_PDN_APLL_TUNER1:
|
||||
return AUDIO_TOP_CON4;
|
||||
default:
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
static unsigned int get_top_cg_mask(unsigned int cg_type)
|
||||
{
|
||||
switch (cg_type) {
|
||||
case MT8189_AUDIO_26M_EN_ON:
|
||||
return AUDIO_26M_EN_ON_MASK_SFT;
|
||||
case MT8189_AUDIO_F3P25M_EN_ON:
|
||||
return AUDIO_F3P25M_EN_ON_MASK_SFT;
|
||||
case MT8189_AUDIO_APLL1_EN_ON:
|
||||
return AUDIO_APLL1_EN_ON_MASK_SFT;
|
||||
case MT8189_AUDIO_APLL2_EN_ON:
|
||||
return AUDIO_APLL2_EN_ON_MASK_SFT;
|
||||
case MT8189_CG_AUDIO_HOPPING_CK:
|
||||
return CG_AUDIO_HOPPING_CK_MASK_SFT;
|
||||
case MT8189_CG_AUDIO_F26M_CK:
|
||||
return CG_AUDIO_F26M_CK_MASK_SFT;
|
||||
case MT8189_CG_APLL1_CK:
|
||||
return CG_APLL1_CK_MASK_SFT;
|
||||
case MT8189_CG_APLL2_CK:
|
||||
return CG_APLL2_CK_MASK_SFT;
|
||||
case MT8189_PDN_APLL_TUNER2:
|
||||
return PDN_APLL_TUNER2_MASK_SFT;
|
||||
case MT8189_PDN_APLL_TUNER1:
|
||||
return PDN_APLL_TUNER1_MASK_SFT;
|
||||
default:
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
static unsigned int get_top_cg_on_val(unsigned int cg_type)
|
||||
{
|
||||
switch (cg_type) {
|
||||
case MT8189_AUDIO_26M_EN_ON:
|
||||
case MT8189_AUDIO_F3P25M_EN_ON:
|
||||
case MT8189_AUDIO_APLL1_EN_ON:
|
||||
case MT8189_AUDIO_APLL2_EN_ON:
|
||||
return get_top_cg_mask(cg_type);
|
||||
case MT8189_CG_AUDIO_HOPPING_CK:
|
||||
case MT8189_CG_AUDIO_F26M_CK:
|
||||
case MT8189_CG_APLL1_CK:
|
||||
case MT8189_CG_APLL2_CK:
|
||||
case MT8189_PDN_APLL_TUNER2:
|
||||
case MT8189_PDN_APLL_TUNER1:
|
||||
return 0;
|
||||
default:
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
static unsigned int get_top_cg_off_val(unsigned int cg_type)
|
||||
{
|
||||
switch (cg_type) {
|
||||
case MT8189_AUDIO_26M_EN_ON:
|
||||
case MT8189_AUDIO_F3P25M_EN_ON:
|
||||
case MT8189_AUDIO_APLL1_EN_ON:
|
||||
case MT8189_AUDIO_APLL2_EN_ON:
|
||||
return 0;
|
||||
case MT8189_CG_AUDIO_HOPPING_CK:
|
||||
case MT8189_CG_AUDIO_F26M_CK:
|
||||
case MT8189_CG_APLL1_CK:
|
||||
case MT8189_CG_APLL2_CK:
|
||||
case MT8189_PDN_APLL_TUNER2:
|
||||
case MT8189_PDN_APLL_TUNER1:
|
||||
return get_top_cg_mask(cg_type);
|
||||
default:
|
||||
return get_top_cg_mask(cg_type);
|
||||
}
|
||||
}
|
||||
|
||||
static int mt8189_afe_enable_top_cg(struct mtk_base_afe *afe, unsigned int cg_type)
|
||||
{
|
||||
unsigned int reg = get_top_cg_reg(cg_type);
|
||||
unsigned int mask = get_top_cg_mask(cg_type);
|
||||
unsigned int val = get_top_cg_on_val(cg_type);
|
||||
|
||||
if (!afe->regmap) {
|
||||
dev_err(afe->dev, "afe regmap is null !!!\n");
|
||||
return 0;
|
||||
}
|
||||
|
||||
dev_dbg(afe->dev, "reg: 0x%x, mask: 0x%x, val: 0x%x\n", reg, mask, val);
|
||||
|
||||
return regmap_update_bits(afe->regmap, reg, mask, val);
|
||||
}
|
||||
|
||||
static void mt8189_afe_disable_top_cg(struct mtk_base_afe *afe, unsigned int cg_type)
|
||||
{
|
||||
unsigned int reg = get_top_cg_reg(cg_type);
|
||||
unsigned int mask = get_top_cg_mask(cg_type);
|
||||
unsigned int val = get_top_cg_off_val(cg_type);
|
||||
|
||||
if (!afe->regmap) {
|
||||
dev_warn(afe->dev, "skip regmap\n");
|
||||
return;
|
||||
}
|
||||
|
||||
dev_dbg(afe->dev, "reg: 0x%x, mask: 0x%x, val: 0x%x\n", reg, mask, val);
|
||||
regmap_update_bits(afe->regmap, reg, mask, val);
|
||||
}
|
||||
|
||||
static int apll1_mux_setting(struct mtk_base_afe *afe, bool enable)
|
||||
{
|
||||
struct mt8189_afe_private *afe_priv = afe->platform_priv;
|
||||
int ret;
|
||||
|
||||
dev_dbg(afe->dev, "enable: %d\n", enable);
|
||||
|
||||
if (enable) {
|
||||
ret = mt8189_afe_enable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_1]);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
ret = mt8189_afe_set_clk_parent(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_1],
|
||||
afe_priv->clk[MT8189_CLK_TOP_APLL1_CK]);
|
||||
if (ret)
|
||||
goto clk_ck_mux_aud1_parent_err;
|
||||
|
||||
/* 180.6336 / 4 = 45.1584MHz */
|
||||
ret = mt8189_afe_enable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_ENG1]);
|
||||
if (ret)
|
||||
goto clk_ck_mux_eng1_err;
|
||||
|
||||
ret = mt8189_afe_set_clk_parent(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_ENG1],
|
||||
afe_priv->clk[MT8189_CLK_TOP_APLL1_D4]);
|
||||
if (ret)
|
||||
goto clk_ck_mux_eng1_parent_err;
|
||||
|
||||
ret = mt8189_afe_enable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUDIO_H]);
|
||||
if (ret)
|
||||
goto clk_ck_mux_audio_h_err;
|
||||
|
||||
ret = mt8189_afe_set_clk_parent(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUDIO_H],
|
||||
afe_priv->clk[MT8189_CLK_TOP_APLL1_CK]);
|
||||
if (ret)
|
||||
goto clk_ck_mux_audio_h_parent_err;
|
||||
} else {
|
||||
mt8189_afe_set_clk_parent(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_ENG1],
|
||||
afe_priv->clk[MT8189_CLK_TOP_CLK26M]);
|
||||
|
||||
mt8189_afe_disable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_ENG1]);
|
||||
|
||||
mt8189_afe_set_clk_parent(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_1],
|
||||
afe_priv->clk[MT8189_CLK_TOP_CLK26M]);
|
||||
|
||||
mt8189_afe_disable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_1]);
|
||||
mt8189_afe_set_clk_parent(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUDIO_H],
|
||||
afe_priv->clk[MT8189_CLK_TOP_CLK26M]);
|
||||
mt8189_afe_disable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUDIO_H]);
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
||||
clk_ck_mux_audio_h_parent_err:
|
||||
mt8189_afe_disable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUDIO_H]);
|
||||
clk_ck_mux_audio_h_err:
|
||||
mt8189_afe_set_clk_parent(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_ENG1],
|
||||
afe_priv->clk[MT8189_CLK_TOP_CLK26M]);
|
||||
clk_ck_mux_eng1_parent_err:
|
||||
mt8189_afe_disable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_ENG1]);
|
||||
clk_ck_mux_eng1_err:
|
||||
mt8189_afe_set_clk_parent(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_1],
|
||||
afe_priv->clk[MT8189_CLK_TOP_CLK26M]);
|
||||
clk_ck_mux_aud1_parent_err:
|
||||
mt8189_afe_disable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_1]);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int apll2_mux_setting(struct mtk_base_afe *afe, bool enable)
|
||||
{
|
||||
struct mt8189_afe_private *afe_priv = afe->platform_priv;
|
||||
int ret;
|
||||
|
||||
dev_dbg(afe->dev, "enable: %d\n", enable);
|
||||
|
||||
if (enable) {
|
||||
ret = mt8189_afe_enable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_2]);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
ret = mt8189_afe_set_clk_parent(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_2],
|
||||
afe_priv->clk[MT8189_CLK_TOP_APLL2_CK]);
|
||||
if (ret)
|
||||
goto clk_ck_mux_aud2_parent_err;
|
||||
|
||||
/* 196.608 / 4 = 49.152MHz */
|
||||
ret = mt8189_afe_enable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_ENG2]);
|
||||
if (ret)
|
||||
goto clk_ck_mux_eng2_err;
|
||||
|
||||
ret = mt8189_afe_set_clk_parent(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_ENG2],
|
||||
afe_priv->clk[MT8189_CLK_TOP_APLL2_D4]);
|
||||
if (ret)
|
||||
goto clk_ck_mux_eng2_parent_err;
|
||||
|
||||
ret = mt8189_afe_enable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUDIO_H]);
|
||||
if (ret)
|
||||
goto clk_ck_mux_audio_h_err;
|
||||
|
||||
ret = mt8189_afe_set_clk_parent(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUDIO_H],
|
||||
afe_priv->clk[MT8189_CLK_TOP_APLL2_CK]);
|
||||
if (ret)
|
||||
goto clk_ck_mux_audio_h_parent_err;
|
||||
} else {
|
||||
mt8189_afe_set_clk_parent(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_ENG2],
|
||||
afe_priv->clk[MT8189_CLK_TOP_CLK26M]);
|
||||
|
||||
mt8189_afe_disable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_ENG2]);
|
||||
|
||||
mt8189_afe_set_clk_parent(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_2],
|
||||
afe_priv->clk[MT8189_CLK_TOP_CLK26M]);
|
||||
|
||||
mt8189_afe_disable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_2]);
|
||||
mt8189_afe_set_clk_parent(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUDIO_H],
|
||||
afe_priv->clk[MT8189_CLK_TOP_CLK26M]);
|
||||
mt8189_afe_disable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUDIO_H]);
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
||||
clk_ck_mux_audio_h_parent_err:
|
||||
mt8189_afe_disable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUDIO_H]);
|
||||
clk_ck_mux_audio_h_err:
|
||||
mt8189_afe_set_clk_parent(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_ENG2],
|
||||
afe_priv->clk[MT8189_CLK_TOP_CLK26M]);
|
||||
clk_ck_mux_eng2_parent_err:
|
||||
mt8189_afe_disable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_ENG2]);
|
||||
clk_ck_mux_eng2_err:
|
||||
mt8189_afe_set_clk_parent(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_2],
|
||||
afe_priv->clk[MT8189_CLK_TOP_CLK26M]);
|
||||
clk_ck_mux_aud2_parent_err:
|
||||
mt8189_afe_disable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_2]);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int mt8189_afe_disable_apll(struct mtk_base_afe *afe)
|
||||
{
|
||||
struct mt8189_afe_private *afe_priv = afe->platform_priv;
|
||||
int ret;
|
||||
|
||||
ret = mt8189_afe_enable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUDIO_H]);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
ret = mt8189_afe_enable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_1]);
|
||||
if (ret)
|
||||
goto clk_ck_mux_aud1_err;
|
||||
|
||||
ret = mt8189_afe_set_clk_parent(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_1],
|
||||
afe_priv->clk[MT8189_CLK_TOP_CLK26M]);
|
||||
if (ret)
|
||||
goto clk_ck_mux_aud1_parent_err;
|
||||
|
||||
ret = mt8189_afe_enable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_2]);
|
||||
if (ret)
|
||||
goto clk_ck_mux_aud2_err;
|
||||
|
||||
ret = mt8189_afe_set_clk_parent(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_2],
|
||||
afe_priv->clk[MT8189_CLK_TOP_CLK26M]);
|
||||
if (ret)
|
||||
goto clk_ck_mux_aud2_parent_err;
|
||||
|
||||
mt8189_afe_disable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_1]);
|
||||
mt8189_afe_disable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_2]);
|
||||
mt8189_afe_set_clk_parent(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUDIO_H],
|
||||
afe_priv->clk[MT8189_CLK_TOP_CLK26M]);
|
||||
mt8189_afe_disable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUDIO_H]);
|
||||
|
||||
return 0;
|
||||
|
||||
clk_ck_mux_aud2_parent_err:
|
||||
mt8189_afe_disable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_2]);
|
||||
clk_ck_mux_aud2_err:
|
||||
mt8189_afe_set_clk_parent(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_1],
|
||||
afe_priv->clk[MT8189_CLK_TOP_APLL1_CK]);
|
||||
clk_ck_mux_aud1_parent_err:
|
||||
mt8189_afe_disable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUD_1]);
|
||||
clk_ck_mux_aud1_err:
|
||||
mt8189_afe_disable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUDIO_H]);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
int mt8189_apll1_enable(struct mtk_base_afe *afe)
|
||||
{
|
||||
int ret;
|
||||
|
||||
/* setting for APLL */
|
||||
ret = apll1_mux_setting(afe, true);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
ret = mt8189_afe_enable_top_cg(afe, MT8189_CG_APLL1_CK);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
ret = mt8189_afe_enable_top_cg(afe, MT8189_PDN_APLL_TUNER1);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
/* sel 44.1kHz:1, apll_div:7, upper bound:3 */
|
||||
regmap_update_bits(afe->regmap, AFE_APLL1_TUNER_CFG,
|
||||
XTAL_EN_128FS_SEL_MASK_SFT | APLL_DIV_MASK_SFT |
|
||||
UPPER_BOUND_MASK_SFT,
|
||||
(0x1 << XTAL_EN_128FS_SEL_SFT) | (7 << APLL_DIV_SFT) |
|
||||
(3 << UPPER_BOUND_SFT));
|
||||
|
||||
/* apll1 freq tuner enable */
|
||||
regmap_update_bits(afe->regmap, AFE_APLL1_TUNER_CFG,
|
||||
FREQ_TUNER_EN_MASK_SFT,
|
||||
0x1 << FREQ_TUNER_EN_SFT);
|
||||
|
||||
/* audio apll1 on */
|
||||
ret = mt8189_afe_enable_top_cg(afe, MT8189_AUDIO_APLL1_EN_ON);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
void mt8189_apll1_disable(struct mtk_base_afe *afe)
|
||||
{
|
||||
/* audio apll1 off */
|
||||
mt8189_afe_disable_top_cg(afe, MT8189_AUDIO_APLL1_EN_ON);
|
||||
|
||||
/* apll1 freq tuner disable */
|
||||
regmap_update_bits(afe->regmap, AFE_APLL1_TUNER_CFG,
|
||||
FREQ_TUNER_EN_MASK_SFT,
|
||||
0x0);
|
||||
|
||||
mt8189_afe_disable_top_cg(afe, MT8189_PDN_APLL_TUNER1);
|
||||
mt8189_afe_disable_top_cg(afe, MT8189_CG_APLL1_CK);
|
||||
apll1_mux_setting(afe, false);
|
||||
}
|
||||
|
||||
int mt8189_apll2_enable(struct mtk_base_afe *afe)
|
||||
{
|
||||
int ret;
|
||||
|
||||
/* setting for APLL */
|
||||
ret = apll2_mux_setting(afe, true);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
ret = mt8189_afe_enable_top_cg(afe, MT8189_CG_APLL2_CK);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
ret = mt8189_afe_enable_top_cg(afe, MT8189_PDN_APLL_TUNER2);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
/* sel 48kHz: 2, apll_div: 7, upper bound: 3*/
|
||||
regmap_update_bits(afe->regmap, AFE_APLL2_TUNER_CFG,
|
||||
XTAL_EN_128FS_SEL_MASK_SFT | APLL_DIV_MASK_SFT |
|
||||
UPPER_BOUND_MASK_SFT,
|
||||
(0x2 << XTAL_EN_128FS_SEL_SFT) | (7 << APLL_DIV_SFT) |
|
||||
(3 << UPPER_BOUND_SFT));
|
||||
|
||||
/* apll2 freq tuner enable */
|
||||
regmap_update_bits(afe->regmap, AFE_APLL2_TUNER_CFG,
|
||||
FREQ_TUNER_EN_MASK_SFT,
|
||||
0x1 << FREQ_TUNER_EN_SFT);
|
||||
|
||||
/* audio apll2 on */
|
||||
ret = mt8189_afe_enable_top_cg(afe, MT8189_AUDIO_APLL2_EN_ON);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
void mt8189_apll2_disable(struct mtk_base_afe *afe)
|
||||
{
|
||||
/* audio apll2 off */
|
||||
mt8189_afe_disable_top_cg(afe, MT8189_AUDIO_APLL2_EN_ON);
|
||||
|
||||
/* apll2 freq tuner disable */
|
||||
regmap_update_bits(afe->regmap, AFE_APLL2_TUNER_CFG,
|
||||
FREQ_TUNER_EN_MASK_SFT,
|
||||
0x0);
|
||||
|
||||
mt8189_afe_disable_top_cg(afe, MT8189_PDN_APLL_TUNER2);
|
||||
mt8189_afe_disable_top_cg(afe, MT8189_CG_APLL2_CK);
|
||||
apll2_mux_setting(afe, false);
|
||||
}
|
||||
|
||||
int mt8189_get_apll_rate(struct mtk_base_afe *afe, int apll)
|
||||
{
|
||||
struct mt8189_afe_private *afe_priv = afe->platform_priv;
|
||||
int clk_id;
|
||||
|
||||
if (apll < MT8189_APLL1 || apll > MT8189_APLL2) {
|
||||
dev_warn(afe->dev, "invalid clk id %d\n", apll);
|
||||
return 0;
|
||||
}
|
||||
|
||||
if (apll == MT8189_APLL1)
|
||||
clk_id = MT8189_CLK_TOP_APLL1_CK;
|
||||
else
|
||||
clk_id = MT8189_CLK_TOP_APLL2_CK;
|
||||
|
||||
return clk_get_rate(afe_priv->clk[clk_id]);
|
||||
}
|
||||
|
||||
int mt8189_get_apll_by_rate(struct mtk_base_afe *afe, int rate)
|
||||
{
|
||||
return (rate % 8000) ? MT8189_APLL1 : MT8189_APLL2;
|
||||
}
|
||||
|
||||
int mt8189_get_apll_by_name(struct mtk_base_afe *afe, const char *name)
|
||||
{
|
||||
if (strcmp(name, APLL1_W_NAME) == 0)
|
||||
return MT8189_APLL1;
|
||||
|
||||
return MT8189_APLL2;
|
||||
}
|
||||
|
||||
int mt8189_mck_enable(struct mtk_base_afe *afe, int mck_id, int rate)
|
||||
{
|
||||
struct mt8189_afe_private *afe_priv = afe->platform_priv;
|
||||
int apll = mt8189_get_apll_by_rate(afe, rate);
|
||||
int apll_clk_id = apll == MT8189_APLL1 ?
|
||||
MT8189_CLK_TOP_MUX_AUD_1 : MT8189_CLK_TOP_MUX_AUD_2;
|
||||
int m_sel_id;
|
||||
int div_clk_id;
|
||||
int ret;
|
||||
|
||||
dev_dbg(afe->dev, "mck_id: %d, rate: %d\n", mck_id, rate);
|
||||
|
||||
if (mck_id >= MT8189_MCK_NUM || mck_id < 0)
|
||||
return -EINVAL;
|
||||
|
||||
m_sel_id = mck_div[mck_id].m_sel_id;
|
||||
div_clk_id = mck_div[mck_id].div_clk_id;
|
||||
|
||||
/* select apll */
|
||||
if (m_sel_id >= 0) {
|
||||
ret = mt8189_afe_enable_clk(afe, afe_priv->clk[m_sel_id]);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
ret = mt8189_afe_set_clk_parent(afe, afe_priv->clk[m_sel_id],
|
||||
afe_priv->clk[apll_clk_id]);
|
||||
if (ret)
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* enable div, set rate */
|
||||
if (div_clk_id < 0) {
|
||||
dev_err(afe->dev, "invalid div_clk_id %d\n", div_clk_id);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
ret = mt8189_afe_enable_clk(afe, afe_priv->clk[div_clk_id]);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
ret = mt8189_afe_set_clk_rate(afe, afe_priv->clk[div_clk_id], rate);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int mt8189_mck_disable(struct mtk_base_afe *afe, int mck_id)
|
||||
{
|
||||
struct mt8189_afe_private *afe_priv = afe->platform_priv;
|
||||
int m_sel_id;
|
||||
int div_clk_id;
|
||||
|
||||
dev_dbg(afe->dev, "mck_id: %d.\n", mck_id);
|
||||
|
||||
if (mck_id < 0) {
|
||||
dev_err(afe->dev, "mck_id = %d < 0\n", mck_id);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
m_sel_id = mck_div[mck_id].m_sel_id;
|
||||
div_clk_id = mck_div[mck_id].div_clk_id;
|
||||
|
||||
if (div_clk_id < 0) {
|
||||
dev_err(afe->dev, "div_clk_id = %d < 0\n",
|
||||
div_clk_id);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
mt8189_afe_disable_clk(afe, afe_priv->clk[div_clk_id]);
|
||||
|
||||
if (m_sel_id >= 0)
|
||||
mt8189_afe_disable_clk(afe, afe_priv->clk[m_sel_id]);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int mt8189_afe_enable_reg_rw_clk(struct mtk_base_afe *afe)
|
||||
{
|
||||
struct mt8189_afe_private *afe_priv = afe->platform_priv;
|
||||
|
||||
/* bus clock for AFE internal access, like AFE SRAM */
|
||||
mt8189_afe_enable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUDIOINTBUS]);
|
||||
mt8189_afe_set_clk_parent(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUDIOINTBUS],
|
||||
afe_priv->clk[MT8189_CLK_TOP_CLK26M]);
|
||||
/* enable audio clock source */
|
||||
mt8189_afe_enable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUDIO_H]);
|
||||
mt8189_afe_set_clk_parent(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUDIO_H],
|
||||
afe_priv->clk[MT8189_CLK_TOP_CLK26M]);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int mt8189_afe_disable_reg_rw_clk(struct mtk_base_afe *afe)
|
||||
{
|
||||
struct mt8189_afe_private *afe_priv = afe->platform_priv;
|
||||
|
||||
mt8189_afe_disable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUDIO_H]);
|
||||
mt8189_afe_disable_clk(afe, afe_priv->clk[MT8189_CLK_TOP_MUX_AUDIOINTBUS]);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int mt8189_afe_enable_main_clock(struct mtk_base_afe *afe)
|
||||
{
|
||||
return mt8189_afe_enable_top_cg(afe, MT8189_AUDIO_26M_EN_ON);
|
||||
}
|
||||
|
||||
void mt8189_afe_disable_main_clock(struct mtk_base_afe *afe)
|
||||
{
|
||||
mt8189_afe_disable_top_cg(afe, MT8189_AUDIO_26M_EN_ON);
|
||||
}
|
||||
|
||||
static int mt8189_afe_enable_ao_clock(struct mtk_base_afe *afe)
|
||||
{
|
||||
struct mt8189_afe_private *afe_priv = afe->platform_priv;
|
||||
int ret;
|
||||
|
||||
/* Peri clock AO enable */
|
||||
ret = mt8189_afe_enable_clk(afe, afe_priv->clk[MT8189_CLK_PERAO_INTBUS_CK_PERI]);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
ret = mt8189_afe_enable_clk(afe, afe_priv->clk[MT8189_CLK_PERAO_AUDIO_SLV_CK_PERI]);
|
||||
if (ret)
|
||||
goto err_clk_perao_slv;
|
||||
|
||||
ret = mt8189_afe_enable_clk(afe, afe_priv->clk[MT8189_CLK_PERAO_AUDIO_MST_CK_PERI]);
|
||||
if (ret)
|
||||
goto err_clk_perao_mst;
|
||||
|
||||
return 0;
|
||||
|
||||
err_clk_perao_mst:
|
||||
mt8189_afe_disable_clk(afe, afe_priv->clk[MT8189_CLK_PERAO_AUDIO_SLV_CK_PERI]);
|
||||
err_clk_perao_slv:
|
||||
mt8189_afe_disable_clk(afe, afe_priv->clk[MT8189_CLK_PERAO_INTBUS_CK_PERI]);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
int mt8189_init_clock(struct mtk_base_afe *afe)
|
||||
{
|
||||
struct mt8189_afe_private *afe_priv = afe->platform_priv;
|
||||
int ret;
|
||||
int i;
|
||||
|
||||
afe_priv->clk = devm_kcalloc(afe->dev, MT8189_CLK_NUM, sizeof(*afe_priv->clk),
|
||||
GFP_KERNEL);
|
||||
if (!afe_priv->clk)
|
||||
return -ENOMEM;
|
||||
|
||||
for (i = 0; i < MT8189_CLK_NUM; i++) {
|
||||
afe_priv->clk[i] = devm_clk_get(afe->dev, aud_clks[i]);
|
||||
if (IS_ERR(afe_priv->clk[i])) {
|
||||
dev_err(afe->dev, "devm_clk_get %s fail\n", aud_clks[i]);
|
||||
return PTR_ERR(afe_priv->clk[i]);
|
||||
}
|
||||
}
|
||||
|
||||
ret = mt8189_afe_disable_apll(afe);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
ret = mt8189_afe_enable_ao_clock(afe);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
return 0;
|
||||
}
|
||||
76
sound/soc/mediatek/mt8189/mt8189-afe-clk.h
Normal file
76
sound/soc/mediatek/mt8189/mt8189-afe-clk.h
Normal file
|
|
@ -0,0 +1,76 @@
|
|||
/* SPDX-License-Identifier: GPL-2.0 */
|
||||
/*
|
||||
* mt8189-afe-clk.h -- Mediatek 8189 afe clock ctrl definition
|
||||
*
|
||||
* Copyright (c) 2025 MediaTek Inc.
|
||||
* Author: Darren Ye <darren.ye@mediatek.com>
|
||||
*/
|
||||
|
||||
#ifndef _MT8189_AFE_CLOCK_CTRL_H_
|
||||
#define _MT8189_AFE_CLOCK_CTRL_H_
|
||||
|
||||
/* APLL */
|
||||
#define APLL1_W_NAME "APLL1"
|
||||
#define APLL2_W_NAME "APLL2"
|
||||
|
||||
enum {
|
||||
MT8189_APLL1,
|
||||
MT8189_APLL2,
|
||||
};
|
||||
|
||||
enum {
|
||||
MT8189_CLK_TOP_MUX_AUDIOINTBUS,
|
||||
MT8189_CLK_TOP_MUX_AUD_ENG1,
|
||||
MT8189_CLK_TOP_MUX_AUD_ENG2,
|
||||
MT8189_CLK_TOP_MUX_AUDIO_H,
|
||||
/* pll */
|
||||
MT8189_CLK_TOP_APLL1_CK,
|
||||
MT8189_CLK_TOP_APLL2_CK,
|
||||
/* divider */
|
||||
MT8189_CLK_TOP_APLL1_D4,
|
||||
MT8189_CLK_TOP_APLL2_D4,
|
||||
MT8189_CLK_TOP_APLL12_DIV_I2SIN0,
|
||||
MT8189_CLK_TOP_APLL12_DIV_I2SIN1,
|
||||
MT8189_CLK_TOP_APLL12_DIV_I2SOUT0,
|
||||
MT8189_CLK_TOP_APLL12_DIV_I2SOUT1,
|
||||
MT8189_CLK_TOP_APLL12_DIV_FMI2S,
|
||||
MT8189_CLK_TOP_APLL12_DIV_TDMOUT_M,
|
||||
MT8189_CLK_TOP_APLL12_DIV_TDMOUT_B,
|
||||
/* mux */
|
||||
MT8189_CLK_TOP_MUX_AUD_1,
|
||||
MT8189_CLK_TOP_MUX_AUD_2,
|
||||
MT8189_CLK_TOP_I2SIN0_M_SEL,
|
||||
MT8189_CLK_TOP_I2SIN1_M_SEL,
|
||||
MT8189_CLK_TOP_I2SOUT0_M_SEL,
|
||||
MT8189_CLK_TOP_I2SOUT1_M_SEL,
|
||||
MT8189_CLK_TOP_FMI2S_M_SEL,
|
||||
MT8189_CLK_TOP_TDMOUT_M_SEL,
|
||||
/* top 26m */
|
||||
MT8189_CLK_TOP_CLK26M,
|
||||
/* peri */
|
||||
MT8189_CLK_PERAO_AUDIO_SLV_CK_PERI,
|
||||
MT8189_CLK_PERAO_AUDIO_MST_CK_PERI,
|
||||
MT8189_CLK_PERAO_INTBUS_CK_PERI,
|
||||
MT8189_CLK_NUM,
|
||||
};
|
||||
|
||||
struct mtk_base_afe;
|
||||
|
||||
int mt8189_mck_enable(struct mtk_base_afe *afe, int mck_id, int rate);
|
||||
int mt8189_mck_disable(struct mtk_base_afe *afe, int mck_id);
|
||||
int mt8189_get_apll_rate(struct mtk_base_afe *afe, int apll);
|
||||
int mt8189_get_apll_by_rate(struct mtk_base_afe *afe, int rate);
|
||||
int mt8189_get_apll_by_name(struct mtk_base_afe *afe, const char *name);
|
||||
int mt8189_init_clock(struct mtk_base_afe *afe);
|
||||
int mt8189_afe_enable_clk(struct mtk_base_afe *afe, struct clk *clk);
|
||||
void mt8189_afe_disable_clk(struct mtk_base_afe *afe, struct clk *clk);
|
||||
int mt8189_apll1_enable(struct mtk_base_afe *afe);
|
||||
void mt8189_apll1_disable(struct mtk_base_afe *afe);
|
||||
int mt8189_apll2_enable(struct mtk_base_afe *afe);
|
||||
void mt8189_apll2_disable(struct mtk_base_afe *afe);
|
||||
int mt8189_afe_enable_main_clock(struct mtk_base_afe *afe);
|
||||
void mt8189_afe_disable_main_clock(struct mtk_base_afe *afe);
|
||||
int mt8189_afe_enable_reg_rw_clk(struct mtk_base_afe *afe);
|
||||
int mt8189_afe_disable_reg_rw_clk(struct mtk_base_afe *afe);
|
||||
|
||||
#endif
|
||||
Loading…
Reference in New Issue
Block a user