ASoC: Add function "rl6231_get_pre_div" to correct the dmic clock calculation
Signed-off-by: Bard Liao <bardliao@realtek.com> Signed-off-by: Oder Chiou <oder_chiou@realtek.com> Signed-off-by: Mark Brown <broonie@kernel.org>
This commit is contained in:
parent
213213d9d6
commit
00a6d6e50f
|
@ -11,9 +11,56 @@
|
|||
*/
|
||||
|
||||
#include <linux/module.h>
|
||||
#include <linux/regmap.h>
|
||||
|
||||
#include "rl6231.h"
|
||||
|
||||
/**
|
||||
* rl6231_get_pre_div - Return the value of pre divider.
|
||||
*
|
||||
* @map: map for setting.
|
||||
* @reg: register.
|
||||
* @sft: shift.
|
||||
*
|
||||
* Return the value of pre divider from given register value.
|
||||
* Return negative error code for unexpected register value.
|
||||
*/
|
||||
int rl6231_get_pre_div(struct regmap *map, unsigned int reg, int sft)
|
||||
{
|
||||
int pd, val;
|
||||
|
||||
regmap_read(map, reg, &val);
|
||||
|
||||
val = (val >> sft) & 0x7;
|
||||
|
||||
switch (val) {
|
||||
case 0:
|
||||
case 1:
|
||||
case 2:
|
||||
case 3:
|
||||
pd = val + 1;
|
||||
break;
|
||||
case 4:
|
||||
pd = 6;
|
||||
break;
|
||||
case 5:
|
||||
pd = 8;
|
||||
break;
|
||||
case 6:
|
||||
pd = 12;
|
||||
break;
|
||||
case 7:
|
||||
pd = 16;
|
||||
break;
|
||||
default:
|
||||
pd = -EINVAL;
|
||||
break;
|
||||
}
|
||||
|
||||
return pd;
|
||||
}
|
||||
EXPORT_SYMBOL_GPL(rl6231_get_pre_div);
|
||||
|
||||
/**
|
||||
* rl6231_calc_dmic_clk - Calculate the parameter of dmic.
|
||||
*
|
||||
|
|
|
@ -30,5 +30,6 @@ int rl6231_calc_dmic_clk(int rate);
|
|||
int rl6231_pll_calc(const unsigned int freq_in,
|
||||
const unsigned int freq_out, struct rl6231_pll_code *pll_code);
|
||||
int rl6231_get_clk_info(int sclk, int rate);
|
||||
int rl6231_get_pre_div(struct regmap *map, unsigned int reg, int sft);
|
||||
|
||||
#endif /* __RL6231_H__ */
|
||||
|
|
|
@ -459,10 +459,11 @@ static int set_dmic_clk(struct snd_soc_dapm_widget *w,
|
|||
{
|
||||
struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
|
||||
struct rt5640_priv *rt5640 = snd_soc_codec_get_drvdata(codec);
|
||||
int idx = -EINVAL;
|
||||
|
||||
idx = rl6231_calc_dmic_clk(rt5640->sysclk);
|
||||
int idx, rate;
|
||||
|
||||
rate = rt5640->sysclk / rl6231_get_pre_div(rt5640->regmap,
|
||||
RT5640_ADDA_CLK1, RT5640_I2S_PD1_SFT);
|
||||
idx = rl6231_calc_dmic_clk(rate);
|
||||
if (idx < 0)
|
||||
dev_err(codec->dev, "Failed to set DMIC clock\n");
|
||||
else
|
||||
|
|
|
@ -510,10 +510,11 @@ static int set_dmic_clk(struct snd_soc_dapm_widget *w,
|
|||
{
|
||||
struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
|
||||
struct rt5645_priv *rt5645 = snd_soc_codec_get_drvdata(codec);
|
||||
int idx = -EINVAL;
|
||||
|
||||
idx = rl6231_calc_dmic_clk(rt5645->sysclk);
|
||||
int idx, rate;
|
||||
|
||||
rate = rt5645->sysclk / rl6231_get_pre_div(rt5645->regmap,
|
||||
RT5645_ADDA_CLK1, RT5645_I2S_PD1_SFT);
|
||||
idx = rl6231_calc_dmic_clk(rate);
|
||||
if (idx < 0)
|
||||
dev_err(codec->dev, "Failed to set DMIC clock\n");
|
||||
else
|
||||
|
|
|
@ -378,10 +378,11 @@ static int set_dmic_clk(struct snd_soc_dapm_widget *w,
|
|||
{
|
||||
struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
|
||||
struct rt5651_priv *rt5651 = snd_soc_codec_get_drvdata(codec);
|
||||
int idx = -EINVAL;
|
||||
|
||||
idx = rl6231_calc_dmic_clk(rt5651->sysclk);
|
||||
int idx, rate;
|
||||
|
||||
rate = rt5651->sysclk / rl6231_get_pre_div(rt5651->regmap,
|
||||
RT5651_ADDA_CLK1, RT5651_I2S_PD1_SFT);
|
||||
idx = rl6231_calc_dmic_clk(rate);
|
||||
if (idx < 0)
|
||||
dev_err(codec->dev, "Failed to set DMIC clock\n");
|
||||
else
|
||||
|
|
|
@ -683,10 +683,11 @@ static int set_dmic_clk(struct snd_soc_dapm_widget *w,
|
|||
{
|
||||
struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
|
||||
struct rt5670_priv *rt5670 = snd_soc_codec_get_drvdata(codec);
|
||||
int idx = -EINVAL;
|
||||
|
||||
idx = rl6231_calc_dmic_clk(rt5670->sysclk);
|
||||
int idx, rate;
|
||||
|
||||
rate = rt5670->sysclk / rl6231_get_pre_div(rt5670->regmap,
|
||||
RT5670_ADDA_CLK1, RT5670_I2S_PD1_SFT);
|
||||
idx = rl6231_calc_dmic_clk(rate);
|
||||
if (idx < 0)
|
||||
dev_err(codec->dev, "Failed to set DMIC clock\n");
|
||||
else
|
||||
|
|
|
@ -917,8 +917,11 @@ static int set_dmic_clk(struct snd_soc_dapm_widget *w,
|
|||
{
|
||||
struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
|
||||
struct rt5677_priv *rt5677 = snd_soc_codec_get_drvdata(codec);
|
||||
int idx = rl6231_calc_dmic_clk(rt5677->lrck[RT5677_AIF1] << 8);
|
||||
int idx, rate;
|
||||
|
||||
rate = rt5677->sysclk / rl6231_get_pre_div(rt5677->regmap,
|
||||
RT5677_CLK_TREE_CTRL1, RT5677_I2S_PD1_SFT);
|
||||
idx = rl6231_calc_dmic_clk(rate);
|
||||
if (idx < 0)
|
||||
dev_err(codec->dev, "Failed to set DMIC clock\n");
|
||||
else
|
||||
|
|
Loading…
Reference in New Issue