mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-10-04 16:15:11 +00:00
ASoC: fsl_ssi: Clean up _fsl_ssi_set_dai_fmt()
The _fsl_ssi_set_dai_fmt() is a helper function being called from fsl_ssi_set_dai_fmt() as an ASoC operation and fsl_ssi_hw_init() mainly for AC97 format initialization. This patch cleans the _fsl_ssi_set_dai_fmt() in following ways: * Removing *dev pointer in the parameters as it's included in the *ssi pointer of struct fsl_ssi. * Using regmap_update_bits() instead of regmap_read() with masking the value manually. * Moving baudclk check to the switch-case routine to skip the I2S master check. And moving SxCCR.DC settings after baudclk check. * Adding format settings for SND_SOC_DAIFMT_AC97 like others. Signed-off-by: Nicolin Chen <nicoleotsuka@gmail.com> Tested-by: Caleb Crome <caleb@crome.org> Tested-by: Maciej S. Szmigiero <mail@maciej.szmigiero.name> Reviewed-by: Maciej S. Szmigiero <mail@maciej.szmigiero.name> Signed-off-by: Mark Brown <broonie@kernel.org>
This commit is contained in:
parent
37ac30a4bd
commit
26b31f4f7d
1 changed files with 35 additions and 39 deletions
|
@ -860,42 +860,31 @@ static int fsl_ssi_hw_free(struct snd_pcm_substream *substream,
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int _fsl_ssi_set_dai_fmt(struct device *dev,
|
static int _fsl_ssi_set_dai_fmt(struct fsl_ssi *ssi, unsigned int fmt)
|
||||||
struct fsl_ssi *ssi, unsigned int fmt)
|
|
||||||
{
|
{
|
||||||
struct regmap *regs = ssi->regs;
|
u32 strcr = 0, scr = 0, stcr, srcr, mask;
|
||||||
u32 strcr = 0, stcr, srcr, scr, mask;
|
|
||||||
|
|
||||||
ssi->dai_fmt = fmt;
|
ssi->dai_fmt = fmt;
|
||||||
|
|
||||||
if (fsl_ssi_is_i2s_master(ssi) && IS_ERR(ssi->baudclk)) {
|
|
||||||
dev_err(dev, "missing baudclk for master mode\n");
|
|
||||||
return -EINVAL;
|
|
||||||
}
|
|
||||||
|
|
||||||
regmap_read(regs, REG_SSI_SCR, &scr);
|
|
||||||
scr &= ~(SSI_SCR_SYN | SSI_SCR_I2S_MODE_MASK);
|
|
||||||
/* Synchronize frame sync clock for TE to avoid data slipping */
|
/* Synchronize frame sync clock for TE to avoid data slipping */
|
||||||
scr |= SSI_SCR_SYNC_TX_FS;
|
scr |= SSI_SCR_SYNC_TX_FS;
|
||||||
|
|
||||||
mask = SSI_STCR_TXBIT0 | SSI_STCR_TFDIR | SSI_STCR_TXDIR |
|
/* Set to default shifting settings: LSB_ALIGNED */
|
||||||
SSI_STCR_TSCKP | SSI_STCR_TFSI | SSI_STCR_TFSL | SSI_STCR_TEFS;
|
strcr |= SSI_STCR_TXBIT0;
|
||||||
regmap_read(regs, REG_SSI_STCR, &stcr);
|
|
||||||
regmap_read(regs, REG_SSI_SRCR, &srcr);
|
|
||||||
stcr &= ~mask;
|
|
||||||
srcr &= ~mask;
|
|
||||||
|
|
||||||
/* Use Network mode as default */
|
/* Use Network mode as default */
|
||||||
ssi->i2s_net = SSI_SCR_NET;
|
ssi->i2s_net = SSI_SCR_NET;
|
||||||
switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
|
switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
|
||||||
case SND_SOC_DAIFMT_I2S:
|
case SND_SOC_DAIFMT_I2S:
|
||||||
regmap_update_bits(regs, REG_SSI_STCCR,
|
|
||||||
SSI_SxCCR_DC_MASK, SSI_SxCCR_DC(2));
|
|
||||||
regmap_update_bits(regs, REG_SSI_SRCCR,
|
|
||||||
SSI_SxCCR_DC_MASK, SSI_SxCCR_DC(2));
|
|
||||||
switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
|
switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
|
||||||
case SND_SOC_DAIFMT_CBM_CFS:
|
|
||||||
case SND_SOC_DAIFMT_CBS_CFS:
|
case SND_SOC_DAIFMT_CBS_CFS:
|
||||||
|
if (IS_ERR(ssi->baudclk)) {
|
||||||
|
dev_err(ssi->dev,
|
||||||
|
"missing baudclk for master mode\n");
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
/* fall through */
|
||||||
|
case SND_SOC_DAIFMT_CBM_CFS:
|
||||||
ssi->i2s_net |= SSI_SCR_I2S_MODE_MASTER;
|
ssi->i2s_net |= SSI_SCR_I2S_MODE_MASTER;
|
||||||
break;
|
break;
|
||||||
case SND_SOC_DAIFMT_CBM_CFM:
|
case SND_SOC_DAIFMT_CBM_CFM:
|
||||||
|
@ -905,30 +894,34 @@ static int _fsl_ssi_set_dai_fmt(struct device *dev,
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
regmap_update_bits(ssi->regs, REG_SSI_STCCR,
|
||||||
|
SSI_SxCCR_DC_MASK, SSI_SxCCR_DC(2));
|
||||||
|
regmap_update_bits(ssi->regs, REG_SSI_SRCCR,
|
||||||
|
SSI_SxCCR_DC_MASK, SSI_SxCCR_DC(2));
|
||||||
|
|
||||||
/* Data on rising edge of bclk, frame low, 1clk before data */
|
/* Data on rising edge of bclk, frame low, 1clk before data */
|
||||||
strcr |= SSI_STCR_TFSI | SSI_STCR_TSCKP |
|
strcr |= SSI_STCR_TFSI | SSI_STCR_TSCKP | SSI_STCR_TEFS;
|
||||||
SSI_STCR_TXBIT0 | SSI_STCR_TEFS;
|
|
||||||
break;
|
break;
|
||||||
case SND_SOC_DAIFMT_LEFT_J:
|
case SND_SOC_DAIFMT_LEFT_J:
|
||||||
/* Data on rising edge of bclk, frame high */
|
/* Data on rising edge of bclk, frame high */
|
||||||
strcr |= SSI_STCR_TXBIT0 | SSI_STCR_TSCKP;
|
strcr |= SSI_STCR_TSCKP;
|
||||||
break;
|
break;
|
||||||
case SND_SOC_DAIFMT_DSP_A:
|
case SND_SOC_DAIFMT_DSP_A:
|
||||||
/* Data on rising edge of bclk, frame high, 1clk before data */
|
/* Data on rising edge of bclk, frame high, 1clk before data */
|
||||||
strcr |= SSI_STCR_TFSL | SSI_STCR_TSCKP |
|
strcr |= SSI_STCR_TFSL | SSI_STCR_TSCKP | SSI_STCR_TEFS;
|
||||||
SSI_STCR_TXBIT0 | SSI_STCR_TEFS;
|
|
||||||
break;
|
break;
|
||||||
case SND_SOC_DAIFMT_DSP_B:
|
case SND_SOC_DAIFMT_DSP_B:
|
||||||
/* Data on rising edge of bclk, frame high */
|
/* Data on rising edge of bclk, frame high */
|
||||||
strcr |= SSI_STCR_TFSL | SSI_STCR_TSCKP | SSI_STCR_TXBIT0;
|
strcr |= SSI_STCR_TFSL | SSI_STCR_TSCKP;
|
||||||
break;
|
break;
|
||||||
case SND_SOC_DAIFMT_AC97:
|
case SND_SOC_DAIFMT_AC97:
|
||||||
/* Data on falling edge of bclk, frame high, 1clk before data */
|
/* Data on falling edge of bclk, frame high, 1clk before data */
|
||||||
ssi->i2s_net |= SSI_SCR_I2S_MODE_NORMAL;
|
strcr |= SSI_STCR_TEFS;
|
||||||
break;
|
break;
|
||||||
default:
|
default:
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
}
|
}
|
||||||
|
|
||||||
scr |= ssi->i2s_net;
|
scr |= ssi->i2s_net;
|
||||||
|
|
||||||
/* DAI clock inversion */
|
/* DAI clock inversion */
|
||||||
|
@ -962,20 +955,17 @@ static int _fsl_ssi_set_dai_fmt(struct device *dev,
|
||||||
break;
|
break;
|
||||||
case SND_SOC_DAIFMT_CBM_CFM:
|
case SND_SOC_DAIFMT_CBM_CFM:
|
||||||
/* Input bit or frame sync clocks */
|
/* Input bit or frame sync clocks */
|
||||||
scr &= ~SSI_SCR_SYS_CLK_EN;
|
|
||||||
break;
|
break;
|
||||||
case SND_SOC_DAIFMT_CBM_CFS:
|
case SND_SOC_DAIFMT_CBM_CFS:
|
||||||
/* Input bit clock but output frame sync clock */
|
/* Input bit clock but output frame sync clock */
|
||||||
strcr &= ~SSI_STCR_TXDIR;
|
|
||||||
strcr |= SSI_STCR_TFDIR;
|
strcr |= SSI_STCR_TFDIR;
|
||||||
scr &= ~SSI_SCR_SYS_CLK_EN;
|
|
||||||
break;
|
break;
|
||||||
default:
|
default:
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
}
|
}
|
||||||
|
|
||||||
stcr |= strcr;
|
stcr = strcr;
|
||||||
srcr |= strcr;
|
srcr = strcr;
|
||||||
|
|
||||||
/* Set SYN mode and clear RXDIR bit when using SYN or AC97 mode */
|
/* Set SYN mode and clear RXDIR bit when using SYN or AC97 mode */
|
||||||
if (ssi->cpu_dai_drv.symmetric_rates || fsl_ssi_is_ac97(ssi)) {
|
if (ssi->cpu_dai_drv.symmetric_rates || fsl_ssi_is_ac97(ssi)) {
|
||||||
|
@ -983,9 +973,15 @@ static int _fsl_ssi_set_dai_fmt(struct device *dev,
|
||||||
scr |= SSI_SCR_SYN;
|
scr |= SSI_SCR_SYN;
|
||||||
}
|
}
|
||||||
|
|
||||||
regmap_write(regs, REG_SSI_STCR, stcr);
|
mask = SSI_STCR_TFDIR | SSI_STCR_TXDIR | SSI_STCR_TSCKP |
|
||||||
regmap_write(regs, REG_SSI_SRCR, srcr);
|
SSI_STCR_TFSL | SSI_STCR_TFSI | SSI_STCR_TEFS | SSI_STCR_TXBIT0;
|
||||||
regmap_write(regs, REG_SSI_SCR, scr);
|
|
||||||
|
regmap_update_bits(ssi->regs, REG_SSI_STCR, mask, stcr);
|
||||||
|
regmap_update_bits(ssi->regs, REG_SSI_SRCR, mask, srcr);
|
||||||
|
|
||||||
|
mask = SSI_SCR_SYNC_TX_FS | SSI_SCR_I2S_MODE_MASK |
|
||||||
|
SSI_SCR_SYS_CLK_EN | SSI_SCR_SYN;
|
||||||
|
regmap_update_bits(ssi->regs, REG_SSI_SCR, mask, scr);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
@ -1001,7 +997,7 @@ static int fsl_ssi_set_dai_fmt(struct snd_soc_dai *dai, unsigned int fmt)
|
||||||
if (fsl_ssi_is_ac97(ssi))
|
if (fsl_ssi_is_ac97(ssi))
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
return _fsl_ssi_set_dai_fmt(dai->dev, ssi, fmt);
|
return _fsl_ssi_set_dai_fmt(ssi, fmt);
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
|
@ -1254,7 +1250,7 @@ static int fsl_ssi_hw_init(struct fsl_ssi *ssi)
|
||||||
|
|
||||||
/* AC97 should start earlier to communicate with CODECs */
|
/* AC97 should start earlier to communicate with CODECs */
|
||||||
if (fsl_ssi_is_ac97(ssi)) {
|
if (fsl_ssi_is_ac97(ssi)) {
|
||||||
_fsl_ssi_set_dai_fmt(ssi->dev, ssi, ssi->dai_fmt);
|
_fsl_ssi_set_dai_fmt(ssi, ssi->dai_fmt);
|
||||||
fsl_ssi_setup_ac97(ssi);
|
fsl_ssi_setup_ac97(ssi);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
Loading…
Reference in a new issue