Commit cf375e69 authored by Aidan MacDonald's avatar Aidan MacDonald Committed by Mark Brown

ASoC: jz4740-i2s: Convert to regmap API

Using regmap for accessing the AIC registers makes the driver a
little easier to read, and later refactors can take advantage of
regmap APIs to further simplify the driver.
Reviewed-by: default avatarPaul Cercueil <paul@crapouillou.net>
Signed-off-by: default avatarAidan MacDonald <aidanmacdonald.0x0@gmail.com>
Link: https://lore.kernel.org/r/20221023143328.160866-3-aidanmacdonald.0x0@gmail.comSigned-off-by: default avatarMark Brown <broonie@kernel.org>
parent 8b3a9ad8
...@@ -3,6 +3,7 @@ config SND_JZ4740_SOC_I2S ...@@ -3,6 +3,7 @@ config SND_JZ4740_SOC_I2S
tristate "SoC Audio (I2S protocol) for Ingenic JZ4740 SoC" tristate "SoC Audio (I2S protocol) for Ingenic JZ4740 SoC"
depends on MIPS || COMPILE_TEST depends on MIPS || COMPILE_TEST
depends on HAS_IOMEM depends on HAS_IOMEM
select REGMAP_MMIO
select SND_SOC_GENERIC_DMAENGINE_PCM select SND_SOC_GENERIC_DMAENGINE_PCM
help help
Say Y if you want to use I2S protocol and I2S codec on Ingenic JZ4740 Say Y if you want to use I2S protocol and I2S codec on Ingenic JZ4740
......
...@@ -9,6 +9,7 @@ ...@@ -9,6 +9,7 @@
#include <linux/module.h> #include <linux/module.h>
#include <linux/mod_devicetable.h> #include <linux/mod_devicetable.h>
#include <linux/platform_device.h> #include <linux/platform_device.h>
#include <linux/regmap.h>
#include <linux/slab.h> #include <linux/slab.h>
#include <linux/clk.h> #include <linux/clk.h>
...@@ -96,7 +97,7 @@ struct i2s_soc_info { ...@@ -96,7 +97,7 @@ struct i2s_soc_info {
}; };
struct jz4740_i2s { struct jz4740_i2s {
void __iomem *base; struct regmap *regmap;
struct clk *clk_aic; struct clk *clk_aic;
struct clk *clk_i2s; struct clk *clk_i2s;
...@@ -107,31 +108,10 @@ struct jz4740_i2s { ...@@ -107,31 +108,10 @@ struct jz4740_i2s {
const struct i2s_soc_info *soc_info; const struct i2s_soc_info *soc_info;
}; };
static inline uint32_t jz4740_i2s_read(const struct jz4740_i2s *i2s,
unsigned int reg)
{
return readl(i2s->base + reg);
}
static inline void jz4740_i2s_write(const struct jz4740_i2s *i2s,
unsigned int reg, uint32_t value)
{
writel(value, i2s->base + reg);
}
static inline void jz4740_i2s_set_bits(const struct jz4740_i2s *i2s,
unsigned int reg, uint32_t bits)
{
uint32_t value = jz4740_i2s_read(i2s, reg);
value |= bits;
jz4740_i2s_write(i2s, reg, value);
}
static int jz4740_i2s_startup(struct snd_pcm_substream *substream, static int jz4740_i2s_startup(struct snd_pcm_substream *substream,
struct snd_soc_dai *dai) struct snd_soc_dai *dai)
{ {
struct jz4740_i2s *i2s = snd_soc_dai_get_drvdata(dai); struct jz4740_i2s *i2s = snd_soc_dai_get_drvdata(dai);
uint32_t conf;
int ret; int ret;
/* /*
...@@ -141,9 +121,9 @@ static int jz4740_i2s_startup(struct snd_pcm_substream *substream, ...@@ -141,9 +121,9 @@ static int jz4740_i2s_startup(struct snd_pcm_substream *substream,
*/ */
if (!i2s->soc_info->shared_fifo_flush) { if (!i2s->soc_info->shared_fifo_flush) {
if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
jz4740_i2s_set_bits(i2s, JZ_REG_AIC_CTRL, JZ_AIC_CTRL_TFLUSH); regmap_set_bits(i2s->regmap, JZ_REG_AIC_CTRL, JZ_AIC_CTRL_TFLUSH);
else else
jz4740_i2s_set_bits(i2s, JZ_REG_AIC_CTRL, JZ_AIC_CTRL_RFLUSH); regmap_set_bits(i2s->regmap, JZ_REG_AIC_CTRL, JZ_AIC_CTRL_RFLUSH);
} }
if (snd_soc_dai_active(dai)) if (snd_soc_dai_active(dai))
...@@ -156,16 +136,13 @@ static int jz4740_i2s_startup(struct snd_pcm_substream *substream, ...@@ -156,16 +136,13 @@ static int jz4740_i2s_startup(struct snd_pcm_substream *substream,
* guard this behind the snd_soc_dai_active() check. * guard this behind the snd_soc_dai_active() check.
*/ */
if (i2s->soc_info->shared_fifo_flush) if (i2s->soc_info->shared_fifo_flush)
jz4740_i2s_set_bits(i2s, JZ_REG_AIC_CTRL, JZ_AIC_CTRL_TFLUSH); regmap_set_bits(i2s->regmap, JZ_REG_AIC_CTRL, JZ_AIC_CTRL_TFLUSH);
ret = clk_prepare_enable(i2s->clk_i2s); ret = clk_prepare_enable(i2s->clk_i2s);
if (ret) if (ret)
return ret; return ret;
conf = jz4740_i2s_read(i2s, JZ_REG_AIC_CONF); regmap_set_bits(i2s->regmap, JZ_REG_AIC_CONF, JZ_AIC_CONF_ENABLE);
conf |= JZ_AIC_CONF_ENABLE;
jz4740_i2s_write(i2s, JZ_REG_AIC_CONF, conf);
return 0; return 0;
} }
...@@ -173,14 +150,11 @@ static void jz4740_i2s_shutdown(struct snd_pcm_substream *substream, ...@@ -173,14 +150,11 @@ static void jz4740_i2s_shutdown(struct snd_pcm_substream *substream,
struct snd_soc_dai *dai) struct snd_soc_dai *dai)
{ {
struct jz4740_i2s *i2s = snd_soc_dai_get_drvdata(dai); struct jz4740_i2s *i2s = snd_soc_dai_get_drvdata(dai);
uint32_t conf;
if (snd_soc_dai_active(dai)) if (snd_soc_dai_active(dai))
return; return;
conf = jz4740_i2s_read(i2s, JZ_REG_AIC_CONF); regmap_clear_bits(i2s->regmap, JZ_REG_AIC_CONF, JZ_AIC_CONF_ENABLE);
conf &= ~JZ_AIC_CONF_ENABLE;
jz4740_i2s_write(i2s, JZ_REG_AIC_CONF, conf);
clk_disable_unprepare(i2s->clk_i2s); clk_disable_unprepare(i2s->clk_i2s);
} }
...@@ -189,8 +163,6 @@ static int jz4740_i2s_trigger(struct snd_pcm_substream *substream, int cmd, ...@@ -189,8 +163,6 @@ static int jz4740_i2s_trigger(struct snd_pcm_substream *substream, int cmd,
struct snd_soc_dai *dai) struct snd_soc_dai *dai)
{ {
struct jz4740_i2s *i2s = snd_soc_dai_get_drvdata(dai); struct jz4740_i2s *i2s = snd_soc_dai_get_drvdata(dai);
uint32_t ctrl;
uint32_t mask; uint32_t mask;
if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
...@@ -198,38 +170,30 @@ static int jz4740_i2s_trigger(struct snd_pcm_substream *substream, int cmd, ...@@ -198,38 +170,30 @@ static int jz4740_i2s_trigger(struct snd_pcm_substream *substream, int cmd,
else else
mask = JZ_AIC_CTRL_ENABLE_CAPTURE | JZ_AIC_CTRL_ENABLE_RX_DMA; mask = JZ_AIC_CTRL_ENABLE_CAPTURE | JZ_AIC_CTRL_ENABLE_RX_DMA;
ctrl = jz4740_i2s_read(i2s, JZ_REG_AIC_CTRL);
switch (cmd) { switch (cmd) {
case SNDRV_PCM_TRIGGER_START: case SNDRV_PCM_TRIGGER_START:
case SNDRV_PCM_TRIGGER_RESUME: case SNDRV_PCM_TRIGGER_RESUME:
case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
ctrl |= mask; regmap_set_bits(i2s->regmap, JZ_REG_AIC_CTRL, mask);
break; break;
case SNDRV_PCM_TRIGGER_STOP: case SNDRV_PCM_TRIGGER_STOP:
case SNDRV_PCM_TRIGGER_SUSPEND: case SNDRV_PCM_TRIGGER_SUSPEND:
case SNDRV_PCM_TRIGGER_PAUSE_PUSH: case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
ctrl &= ~mask; regmap_clear_bits(i2s->regmap, JZ_REG_AIC_CTRL, mask);
break; break;
default: default:
return -EINVAL; return -EINVAL;
} }
jz4740_i2s_write(i2s, JZ_REG_AIC_CTRL, ctrl);
return 0; return 0;
} }
static int jz4740_i2s_set_fmt(struct snd_soc_dai *dai, unsigned int fmt) static int jz4740_i2s_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
{ {
struct jz4740_i2s *i2s = snd_soc_dai_get_drvdata(dai); struct jz4740_i2s *i2s = snd_soc_dai_get_drvdata(dai);
const unsigned int conf_mask = JZ_AIC_CONF_BIT_CLK_MASTER |
uint32_t format = 0; JZ_AIC_CONF_SYNC_CLK_MASTER;
uint32_t conf; unsigned int conf = 0, format = 0;
conf = jz4740_i2s_read(i2s, JZ_REG_AIC_CONF);
conf &= ~(JZ_AIC_CONF_BIT_CLK_MASTER | JZ_AIC_CONF_SYNC_CLK_MASTER);
switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) { switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) {
case SND_SOC_DAIFMT_BP_FP: case SND_SOC_DAIFMT_BP_FP:
...@@ -265,8 +229,8 @@ static int jz4740_i2s_set_fmt(struct snd_soc_dai *dai, unsigned int fmt) ...@@ -265,8 +229,8 @@ static int jz4740_i2s_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
return -EINVAL; return -EINVAL;
} }
jz4740_i2s_write(i2s, JZ_REG_AIC_CONF, conf); regmap_update_bits(i2s->regmap, JZ_REG_AIC_CONF, conf_mask, conf);
jz4740_i2s_write(i2s, JZ_REG_AIC_I2S_FMT, format); regmap_write(i2s->regmap, JZ_REG_AIC_I2S_FMT, format);
return 0; return 0;
} }
...@@ -279,9 +243,9 @@ static int jz4740_i2s_hw_params(struct snd_pcm_substream *substream, ...@@ -279,9 +243,9 @@ static int jz4740_i2s_hw_params(struct snd_pcm_substream *substream,
uint32_t ctrl, div_reg; uint32_t ctrl, div_reg;
int div; int div;
ctrl = jz4740_i2s_read(i2s, JZ_REG_AIC_CTRL); regmap_read(i2s->regmap, JZ_REG_AIC_CTRL, &ctrl);
regmap_read(i2s->regmap, JZ_REG_AIC_CLK_DIV, &div_reg);
div_reg = jz4740_i2s_read(i2s, JZ_REG_AIC_CLK_DIV);
div = clk_get_rate(i2s->clk_i2s) / (64 * params_rate(params)); div = clk_get_rate(i2s->clk_i2s) / (64 * params_rate(params));
switch (params_format(params)) { switch (params_format(params)) {
...@@ -318,8 +282,8 @@ static int jz4740_i2s_hw_params(struct snd_pcm_substream *substream, ...@@ -318,8 +282,8 @@ static int jz4740_i2s_hw_params(struct snd_pcm_substream *substream,
} }
} }
jz4740_i2s_write(i2s, JZ_REG_AIC_CTRL, ctrl); regmap_write(i2s->regmap, JZ_REG_AIC_CTRL, ctrl);
jz4740_i2s_write(i2s, JZ_REG_AIC_CLK_DIV, div_reg); regmap_write(i2s->regmap, JZ_REG_AIC_CLK_DIV, div_reg);
return 0; return 0;
} }
...@@ -356,13 +320,9 @@ static int jz4740_i2s_set_sysclk(struct snd_soc_dai *dai, int clk_id, ...@@ -356,13 +320,9 @@ static int jz4740_i2s_set_sysclk(struct snd_soc_dai *dai, int clk_id,
static int jz4740_i2s_suspend(struct snd_soc_component *component) static int jz4740_i2s_suspend(struct snd_soc_component *component)
{ {
struct jz4740_i2s *i2s = snd_soc_component_get_drvdata(component); struct jz4740_i2s *i2s = snd_soc_component_get_drvdata(component);
uint32_t conf;
if (snd_soc_component_active(component)) { if (snd_soc_component_active(component)) {
conf = jz4740_i2s_read(i2s, JZ_REG_AIC_CONF); regmap_clear_bits(i2s->regmap, JZ_REG_AIC_CONF, JZ_AIC_CONF_ENABLE);
conf &= ~JZ_AIC_CONF_ENABLE;
jz4740_i2s_write(i2s, JZ_REG_AIC_CONF, conf);
clk_disable_unprepare(i2s->clk_i2s); clk_disable_unprepare(i2s->clk_i2s);
} }
...@@ -374,7 +334,6 @@ static int jz4740_i2s_suspend(struct snd_soc_component *component) ...@@ -374,7 +334,6 @@ static int jz4740_i2s_suspend(struct snd_soc_component *component)
static int jz4740_i2s_resume(struct snd_soc_component *component) static int jz4740_i2s_resume(struct snd_soc_component *component)
{ {
struct jz4740_i2s *i2s = snd_soc_component_get_drvdata(component); struct jz4740_i2s *i2s = snd_soc_component_get_drvdata(component);
uint32_t conf;
int ret; int ret;
ret = clk_prepare_enable(i2s->clk_aic); ret = clk_prepare_enable(i2s->clk_aic);
...@@ -388,9 +347,7 @@ static int jz4740_i2s_resume(struct snd_soc_component *component) ...@@ -388,9 +347,7 @@ static int jz4740_i2s_resume(struct snd_soc_component *component)
return ret; return ret;
} }
conf = jz4740_i2s_read(i2s, JZ_REG_AIC_CONF); regmap_set_bits(i2s->regmap, JZ_REG_AIC_CONF, JZ_AIC_CONF_ENABLE);
conf |= JZ_AIC_CONF_ENABLE;
jz4740_i2s_write(i2s, JZ_REG_AIC_CONF, conf);
} }
return 0; return 0;
...@@ -423,8 +380,8 @@ static int jz4740_i2s_dai_probe(struct snd_soc_dai *dai) ...@@ -423,8 +380,8 @@ static int jz4740_i2s_dai_probe(struct snd_soc_dai *dai)
JZ_AIC_CONF_INTERNAL_CODEC; JZ_AIC_CONF_INTERNAL_CODEC;
} }
jz4740_i2s_write(i2s, JZ_REG_AIC_CONF, JZ_AIC_CONF_RESET); regmap_write(i2s->regmap, JZ_REG_AIC_CONF, JZ_AIC_CONF_RESET);
jz4740_i2s_write(i2s, JZ_REG_AIC_CONF, conf); regmap_write(i2s->regmap, JZ_REG_AIC_CONF, conf);
return 0; return 0;
} }
...@@ -523,11 +480,19 @@ static const struct of_device_id jz4740_of_matches[] = { ...@@ -523,11 +480,19 @@ static const struct of_device_id jz4740_of_matches[] = {
}; };
MODULE_DEVICE_TABLE(of, jz4740_of_matches); MODULE_DEVICE_TABLE(of, jz4740_of_matches);
static const struct regmap_config jz4740_i2s_regmap_config = {
.reg_bits = 32,
.reg_stride = 4,
.val_bits = 32,
.max_register = JZ_REG_AIC_FIFO,
};
static int jz4740_i2s_dev_probe(struct platform_device *pdev) static int jz4740_i2s_dev_probe(struct platform_device *pdev)
{ {
struct device *dev = &pdev->dev; struct device *dev = &pdev->dev;
struct jz4740_i2s *i2s; struct jz4740_i2s *i2s;
struct resource *mem; struct resource *mem;
void __iomem *regs;
int ret; int ret;
i2s = devm_kzalloc(dev, sizeof(*i2s), GFP_KERNEL); i2s = devm_kzalloc(dev, sizeof(*i2s), GFP_KERNEL);
...@@ -536,9 +501,9 @@ static int jz4740_i2s_dev_probe(struct platform_device *pdev) ...@@ -536,9 +501,9 @@ static int jz4740_i2s_dev_probe(struct platform_device *pdev)
i2s->soc_info = device_get_match_data(dev); i2s->soc_info = device_get_match_data(dev);
i2s->base = devm_platform_get_and_ioremap_resource(pdev, 0, &mem); regs = devm_platform_get_and_ioremap_resource(pdev, 0, &mem);
if (IS_ERR(i2s->base)) if (IS_ERR(regs))
return PTR_ERR(i2s->base); return PTR_ERR(regs);
i2s->playback_dma_data.maxburst = 16; i2s->playback_dma_data.maxburst = 16;
i2s->playback_dma_data.addr = mem->start + JZ_REG_AIC_FIFO; i2s->playback_dma_data.addr = mem->start + JZ_REG_AIC_FIFO;
...@@ -554,6 +519,11 @@ static int jz4740_i2s_dev_probe(struct platform_device *pdev) ...@@ -554,6 +519,11 @@ static int jz4740_i2s_dev_probe(struct platform_device *pdev)
if (IS_ERR(i2s->clk_i2s)) if (IS_ERR(i2s->clk_i2s))
return PTR_ERR(i2s->clk_i2s); return PTR_ERR(i2s->clk_i2s);
i2s->regmap = devm_regmap_init_mmio(&pdev->dev, regs,
&jz4740_i2s_regmap_config);
if (IS_ERR(i2s->regmap))
return PTR_ERR(i2s->regmap);
platform_set_drvdata(pdev, i2s); platform_set_drvdata(pdev, i2s);
ret = devm_snd_soc_register_component(dev, &jz4740_i2s_component, ret = devm_snd_soc_register_component(dev, &jz4740_i2s_component,
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment