| Message ID | 20230506090116.9206-3-walker.chen@starfivetech.com (mailing list archive) |
|---|---|
| State | Superseded |
| Headers | show |
| Series | Add TDM audio on StarFive JH7110 | expand |
Hi, > Add tdm driver support for the StarFive JH7110 SoC. > > Signed-off-by: Walker Chen <walker.chen@starfivetech.com> > --- > MAINTAINERS | 6 + > sound/soc/Kconfig | 1 + > sound/soc/Makefile | 1 + > sound/soc/starfive/Kconfig | 15 + > sound/soc/starfive/Makefile | 2 + > sound/soc/starfive/jh7110_tdm.c | 573 ++++++++++++++++++++++++++++++++ > sound/soc/starfive/jh7110_tdm.h | 147 ++++++++ > 7 files changed, 745 insertions(+) > create mode 100644 sound/soc/starfive/Kconfig > create mode 100644 sound/soc/starfive/Makefile > create mode 100644 sound/soc/starfive/jh7110_tdm.c > create mode 100644 sound/soc/starfive/jh7110_tdm.h > > diff --git a/MAINTAINERS b/MAINTAINERS > index 5f9c544bc189..add89615d327 100644 > --- a/MAINTAINERS > +++ b/MAINTAINERS > @@ -19945,6 +19945,12 @@ F: Documentation/devicetree/bindings/power/starfive* > F: drivers/soc/starfive/jh71xx_pmu.c > F: include/dt-bindings/power/starfive,jh7110-pmu.h > > +STARFIVE JH7110 TDM DRIVERS > +M: Walker Chen <walker.chen@starfivetech.com> > +S: Maintained > +F: Documentation/devicetree/bindings/sound/starfive,jh7110-tdm.yaml > +F: sound/soc/starfive/jh7110-tdm.* > + > STARFIVE SOC DRIVERS > M: Conor Dooley <conor@kernel.org> > S: Maintained > diff --git a/sound/soc/Kconfig b/sound/soc/Kconfig > index 848fbae26c3b..8d1d9401ecf2 100644 > --- a/sound/soc/Kconfig > +++ b/sound/soc/Kconfig > @@ -91,6 +91,7 @@ source "sound/soc/sh/Kconfig" > source "sound/soc/sof/Kconfig" > source "sound/soc/spear/Kconfig" > source "sound/soc/sprd/Kconfig" > +source "sound/soc/starfive/Kconfig" > source "sound/soc/sti/Kconfig" > source "sound/soc/stm/Kconfig" > source "sound/soc/sunxi/Kconfig" > diff --git a/sound/soc/Makefile b/sound/soc/Makefile > index 507eaed1d6a1..65aeb4ef4068 100644 > --- a/sound/soc/Makefile > +++ b/sound/soc/Makefile > @@ -59,6 +59,7 @@ obj-$(CONFIG_SND_SOC) += sh/ > obj-$(CONFIG_SND_SOC) += sof/ > obj-$(CONFIG_SND_SOC) += spear/ > obj-$(CONFIG_SND_SOC) += sprd/ > +obj-$(CONFIG_SND_SOC) += starfive/ > obj-$(CONFIG_SND_SOC) += sti/ > obj-$(CONFIG_SND_SOC) += stm/ > obj-$(CONFIG_SND_SOC) += sunxi/ > diff --git a/sound/soc/starfive/Kconfig b/sound/soc/starfive/Kconfig > new file mode 100644 > index 000000000000..737c956f7b93 > --- /dev/null > +++ b/sound/soc/starfive/Kconfig > @@ -0,0 +1,15 @@ > +# SPDX-License-Identifier: GPL-2.0-only > +config SND_SOC_STARFIVE > + tristate "Audio support for StarFive SoC" > + depends on COMPILE_TEST || SOC_STARFIVE > + help > + Say Y or M if you want to add support for codecs attached to > + the Starfive SoCs' Audio interfaces. You will also need to > + select the audio interfaces to support below. > + > +config SND_SOC_JH7110_TDM > + tristate "JH7110 TDM device driver" > + depends on HAVE_CLK && SND_SOC_STARFIVE > + select SND_SOC_GENERIC_DMAENGINE_PCM > + help > + Say Y or M if you want to add support for StarFive TDM driver. > diff --git a/sound/soc/starfive/Makefile b/sound/soc/starfive/Makefile > new file mode 100644 > index 000000000000..f7d960211d72 > --- /dev/null > +++ b/sound/soc/starfive/Makefile > @@ -0,0 +1,2 @@ > +# StarFive Platform Support > +obj-$(CONFIG_SND_SOC_JH7110_TDM) += jh7110_tdm.o > diff --git a/sound/soc/starfive/jh7110_tdm.c b/sound/soc/starfive/jh7110_tdm.c > new file mode 100644 > index 000000000000..33f7cf43e4bd > --- /dev/null > +++ b/sound/soc/starfive/jh7110_tdm.c > @@ -0,0 +1,573 @@ > +// SPDX-License-Identifier: GPL-2.0 > +/* > + * jh7110_tdm.c -- StarFive JH7110 TDM driver > + * > + * Copyright (C) 2022-2023 StarFive Technology Co., Ltd. > + * > + * Author: Walker Chen <walker.chen@starfivetech.com> > + */ > + > +#include <linux/clk.h> > +#include <linux/device.h> > +#include <linux/module.h> > +#include <linux/of_irq.h> > +#include <linux/of_platform.h> > +#include <linux/pm_runtime.h> > +#include <linux/regmap.h> > +#include <linux/reset.h> > +#include <sound/initval.h> > +#include <sound/pcm_params.h> > +#include <sound/soc.h> > +#include <sound/soc-dai.h> > +#include "jh7110_tdm.h" > + > +static inline u32 jh7110_tdm_readl(struct jh7110_tdm_dev *tdm, u16 reg) > +{ > + return readl_relaxed(tdm->tdm_base + reg); > +} > + > +static inline void jh7110_tdm_writel(struct jh7110_tdm_dev *tdm, u16 reg, u32 val) > +{ > + writel_relaxed(val, tdm->tdm_base + reg); > +} > + > +static void jh7110_tdm_save_context(struct jh7110_tdm_dev *tdm, > + struct snd_pcm_substream *substream) > +{ > + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) > + tdm->saved_pcmtxcr = jh7110_tdm_readl(tdm, TDM_PCMTXCR); > + else > + tdm->saved_pcmrxcr = jh7110_tdm_readl(tdm, TDM_PCMRXCR); > +} > + > +static void jh7110_tdm_start(struct jh7110_tdm_dev *tdm, > + struct snd_pcm_substream *substream) > +{ > + u32 data; > + > + data = jh7110_tdm_readl(tdm, TDM_PCMGBCR); > + jh7110_tdm_writel(tdm, TDM_PCMGBCR, data | PCMGBCR_ENABLE); > + > + /* restore context */ > + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) > + jh7110_tdm_writel(tdm, TDM_PCMTXCR, tdm->saved_pcmtxcr | PCMTXCR_TXEN); > + else > + jh7110_tdm_writel(tdm, TDM_PCMRXCR, tdm->saved_pcmrxcr | PCMRXCR_RXEN); > +} > + > +static void jh7110_tdm_stop(struct jh7110_tdm_dev *tdm, > + struct snd_pcm_substream *substream) > +{ > + unsigned int val; > + > + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { > + val = jh7110_tdm_readl(tdm, TDM_PCMTXCR); > + val &= ~PCMTXCR_TXEN; > + jh7110_tdm_writel(tdm, TDM_PCMTXCR, val); > + } else { > + val = jh7110_tdm_readl(tdm, TDM_PCMRXCR); > + val &= ~PCMRXCR_RXEN; > + jh7110_tdm_writel(tdm, TDM_PCMRXCR, val); > + } > +} > + > +static int jh7110_tdm_syncdiv(struct jh7110_tdm_dev *tdm) > +{ > + u32 sl, sscale, syncdiv; > + > + if (tdm->rx.sl >= tdm->tx.sl) > + sl = tdm->rx.sl; > + else > + sl = tdm->tx.sl; > + > + if (tdm->rx.sscale >= tdm->tx.sscale) > + sscale = tdm->rx.sscale; > + else > + sscale = tdm->tx.sscale; > + > + syncdiv = tdm->pcmclk / tdm->samplerate - 1; > + > + if ((syncdiv + 1) < (sl * sscale)) { > + dev_err(tdm->dev, "Failed to set syncdiv!\n"); > + return -EINVAL; > + } > + > + if (tdm->syncm == TDM_SYNCM_LONG && > + (tdm->rx.sscale <= 1 || tdm->tx.sscale <= 1)) { > + if ((syncdiv + 1) <= sl) { > + dev_err(tdm->dev, "Wrong syncdiv! It must be (syncdiv+1) > max[tx.sl, rx.sl]\n"); > + return -EINVAL; > + } > + } > + > + jh7110_tdm_writel(tdm, TDM_PCMDIV, syncdiv); > + return 0; > +} > + > +static int jh7110_tdm_config(struct jh7110_tdm_dev *tdm, > + struct snd_pcm_substream *substream) > +{ > + u32 datarx, datatx; > + int ret; > + > + ret = jh7110_tdm_syncdiv(tdm); > + if (ret) > + return ret; > + > + datarx = (tdm->rx.ifl << IFL_BIT) | > + (tdm->rx.wl << WL_BIT) | > + (tdm->rx.sscale << SSCALE_BIT) | > + (tdm->rx.sl << SL_BIT) | > + (tdm->rx.lrj << LRJ_BIT); > + > + datatx = (tdm->tx.ifl << IFL_BIT) | > + (tdm->tx.wl << WL_BIT) | > + (tdm->tx.sscale << SSCALE_BIT) | > + (tdm->tx.sl << SL_BIT) | > + (tdm->tx.lrj << LRJ_BIT); > + > + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) > + jh7110_tdm_writel(tdm, TDM_PCMTXCR, datatx); > + else > + jh7110_tdm_writel(tdm, TDM_PCMRXCR, datarx); > + > + return 0; > +} > + > +static void jh7110_tdm_clk_disable(struct jh7110_tdm_dev *tdm) > +{ > + int i; > + > + for (i = tdm->num_clks - 1; i >= 0; i--) > + clk_disable_unprepare(tdm->clks[i]); > +} > + > +static int jh7110_tdm_clk_enable(struct jh7110_tdm_dev *tdm) > +{ > + int i, ret; > + > + for (i = 0; i < tdm->num_clks; i++) { > + ret = clk_prepare_enable(tdm->clks[i]); > + if (ret) { > + while (i-- > 0) > + clk_disable_unprepare(tdm->clks[i]); > + return ret; > + } > + } > + > + ret = reset_control_deassert(tdm->resets); > + if (ret) { > + dev_err(tdm->dev, "Failed to deassert tdm resets\n"); > + goto dis_tdm_clk; > + } > + > + /* select tdm_ext clock as the clock source for tdm */ > + ret = clk_set_parent(tdm->clks[5], tdm->clks[4]); > + if (ret) { > + dev_err(tdm->dev, "Can't set clock source for clk_tdm: %d\n", ret); > + goto dis_tdm_clk; > + } > + return 0; > + > +dis_tdm_clk: > + for (i = tdm->num_clks - 1; i >= 0; i--) > + clk_disable_unprepare(tdm->clks[i]); > + > + return ret; > +} > + > +#ifdef CONFIG_PM > +static int jh7110_tdm_runtime_suspend(struct device *dev) > +{ > + struct jh7110_tdm_dev *tdm = dev_get_drvdata(dev); > + > + jh7110_tdm_clk_disable(tdm); > + return 0; > +} > + > +static int jh7110_tdm_runtime_resume(struct device *dev) > +{ > + struct jh7110_tdm_dev *tdm = dev_get_drvdata(dev); > + > + return jh7110_tdm_clk_enable(tdm); > +} > +#endif > + > +#ifdef CONFIG_PM_SLEEP > +static int jh7110_tdm_suspend(struct snd_soc_component *component) > +{ > + /* save context */ > + tdm->saved_pcmgbcr = jh7110_tdm_readl(tdm, TDM_PCMGBCR); > + tdm->saved_pcmdiv = jh7110_tdm_readl(tdm, TDM_PCMDIV); tdm isn't declared here. Is that same with resume function? Best regards, Shengyu > + > + return pm_runtime_force_suspend(component->dev); > +} > + > +static int jh7110_tdm_resume(struct snd_soc_component *component) > +{ > + struct jh7110_tdm_dev *tdm = snd_soc_component_get_drvdata(component); > + > + /* restore context */ > + jh7110_tdm_writel(tdm, TDM_PCMGBCR, tdm->saved_pcmgbcr); > + jh7110_tdm_writel(tdm, TDM_PCMDIV, tdm->saved_pcmdiv); > + > + return pm_runtime_force_resume(component->dev); > +} > + > +#else > +#define jh7110_tdm_suspend NULL > +#define jh7110_tdm_resume NULL > +#endif > + > +static const struct snd_soc_component_driver jh7110_tdm_component = { > + .name = "jh7110-tdm", > + .suspend = jh7110_tdm_suspend, > + .resume = jh7110_tdm_resume, > +}; > + > +static int jh7110_tdm_startup(struct snd_pcm_substream *substream, > + struct snd_soc_dai *cpu_dai) > +{ > + struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); > + struct snd_soc_dai_link *dai_link = rtd->dai_link; > + > + dai_link->stop_dma_first = 1; > + > + return 0; > +} > + > +static int jh7110_tdm_hw_params(struct snd_pcm_substream *substream, > + struct snd_pcm_hw_params *params, > + struct snd_soc_dai *dai) > +{ > + struct jh7110_tdm_dev *tdm = snd_soc_dai_get_drvdata(dai); > + int chan_wl, chan_sl, chan_nr; > + unsigned int data_width; > + unsigned int dma_bus_width; > + struct snd_dmaengine_dai_dma_data *dma_data = NULL; > + int ret = 0; > + > + data_width = params_width(params); > + > + tdm->samplerate = params_rate(params); > + tdm->pcmclk = params_channels(params) * tdm->samplerate * data_width; > + > + switch (params_format(params)) { > + case SNDRV_PCM_FORMAT_S16_LE: > + chan_wl = TDM_16BIT_WORD_LEN; > + chan_sl = TDM_16BIT_SLOT_LEN; > + dma_bus_width = DMA_SLAVE_BUSWIDTH_2_BYTES; > + break; > + > + case SNDRV_PCM_FORMAT_S32_LE: > + chan_wl = TDM_32BIT_WORD_LEN; > + chan_sl = TDM_32BIT_SLOT_LEN; > + dma_bus_width = DMA_SLAVE_BUSWIDTH_4_BYTES; > + break; > + > + default: > + dev_err(tdm->dev, "tdm: unsupported PCM fmt"); > + return -EINVAL; > + } > + > + chan_nr = params_channels(params); > + switch (chan_nr) { > + case 1: > + case 2: > + case 4: > + case 6: > + case 8: > + break; > + default: > + dev_err(tdm->dev, "channel not supported\n"); > + return -EINVAL; > + } > + > + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { > + tdm->tx.wl = chan_wl; > + tdm->tx.sl = chan_sl; > + tdm->tx.sscale = chan_nr; > + tdm->play_dma_data.addr_width = dma_bus_width; > + dma_data = &tdm->play_dma_data; > + } else { > + tdm->rx.wl = chan_wl; > + tdm->rx.sl = chan_sl; > + tdm->rx.sscale = chan_nr; > + tdm->capture_dma_data.addr_width = dma_bus_width; > + dma_data = &tdm->capture_dma_data; > + } > + > + snd_soc_dai_set_dma_data(dai, substream, dma_data); > + > + ret = jh7110_tdm_config(tdm, substream); > + if (ret) > + return ret; > + > + jh7110_tdm_save_context(tdm, substream); > + return 0; > +} > + > +static int jh7110_tdm_trigger(struct snd_pcm_substream *substream, > + int cmd, struct snd_soc_dai *dai) > +{ > + struct jh7110_tdm_dev *tdm = snd_soc_dai_get_drvdata(dai); > + int ret = 0; > + > + switch (cmd) { > + case SNDRV_PCM_TRIGGER_START: > + case SNDRV_PCM_TRIGGER_RESUME: > + case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: > + jh7110_tdm_start(tdm, substream); > + break; > + > + case SNDRV_PCM_TRIGGER_STOP: > + case SNDRV_PCM_TRIGGER_SUSPEND: > + case SNDRV_PCM_TRIGGER_PAUSE_PUSH: > + jh7110_tdm_stop(tdm, substream); > + break; > + default: > + ret = -EINVAL; > + break; > + } > + return ret; > +} > + > +static int jh7110_tdm_set_dai_fmt(struct snd_soc_dai *cpu_dai, > + unsigned int fmt) > +{ > + struct jh7110_tdm_dev *tdm = snd_soc_dai_get_drvdata(cpu_dai); > + unsigned int gbcr; > + int ret = 0; > + > + /* set master/slave audio interface */ > + switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) { > + case SND_SOC_DAIFMT_BP_FP: > + /* cpu is master */ > + tdm->ms_mode = TDM_AS_MASTER; > + break; > + case SND_SOC_DAIFMT_BC_FC: > + /* codec is master */ > + tdm->ms_mode = TDM_AS_SLAVE; > + break; > + case SND_SOC_DAIFMT_BC_FP: > + case SND_SOC_DAIFMT_BP_FC: > + ret = -EINVAL; > + break; > + default: > + dev_dbg(tdm->dev, "dwc : Invalid clock provider format\n"); > + ret = -EINVAL; > + break; > + } > + > + gbcr = (tdm->clkpolity << CLKPOL_BIT) | > + (tdm->elm << ELM_BIT) | > + (tdm->syncm << SYNCM_BIT) | > + (tdm->ms_mode << MS_BIT); > + jh7110_tdm_writel(tdm, TDM_PCMGBCR, gbcr); > + > + return ret; > +} > + > +static const struct snd_soc_dai_ops jh7110_tdm_dai_ops = { > + .startup = jh7110_tdm_startup, > + .hw_params = jh7110_tdm_hw_params, > + .trigger = jh7110_tdm_trigger, > + .set_fmt = jh7110_tdm_set_dai_fmt, > +}; > + > +static int jh7110_tdm_dai_probe(struct snd_soc_dai *dai) > +{ > + struct jh7110_tdm_dev *tdm = snd_soc_dai_get_drvdata(dai); > + > + snd_soc_dai_init_dma_data(dai, &tdm->play_dma_data, &tdm->capture_dma_data); > + snd_soc_dai_set_drvdata(dai, tdm); > + return 0; > +} > + > +#define JH7110_TDM_RATES SNDRV_PCM_RATE_8000_48000 > + > +#define JH7110_TDM_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | \ > + SNDRV_PCM_FMTBIT_S32_LE) > + > +static struct snd_soc_dai_driver jh7110_tdm_dai = { > + .name = "sf_tdm", > + .id = 0, > + .playback = { > + .stream_name = "Playback", > + .channels_min = 1, > + .channels_max = 8, > + .rates = JH7110_TDM_RATES, > + .formats = JH7110_TDM_FORMATS, > + }, > + .capture = { > + .stream_name = "Capture", > + .channels_min = 1, > + .channels_max = 8, > + .rates = JH7110_TDM_RATES, > + .formats = JH7110_TDM_FORMATS, > + }, > + .ops = &jh7110_tdm_dai_ops, > + .probe = jh7110_tdm_dai_probe, > + .symmetric_rate = 1, > +}; > + > +static const struct snd_pcm_hardware jh7110_pcm_hardware = { > + .info = (SNDRV_PCM_INFO_MMAP | > + SNDRV_PCM_INFO_MMAP_VALID | > + SNDRV_PCM_INFO_PAUSE | > + SNDRV_PCM_INFO_RESUME | > + SNDRV_PCM_INFO_INTERLEAVED | > + SNDRV_PCM_INFO_BLOCK_TRANSFER), > + .buffer_bytes_max = 192512, > + .period_bytes_min = 4096, > + .period_bytes_max = 32768, > + .periods_min = 1, > + .periods_max = 48, > + .fifo_size = 16, > +}; > + > +static const struct snd_dmaengine_pcm_config jh7110_dmaengine_pcm_config = { > + .pcm_hardware = &jh7110_pcm_hardware, > + .prepare_slave_config = snd_dmaengine_pcm_prepare_slave_config, > + .prealloc_buffer_size = 192512, > +}; > + > +static void jh7110_tdm_init_params(struct jh7110_tdm_dev *tdm) > +{ > + tdm->clkpolity = TDM_TX_RASING_RX_FALLING; > + tdm->elm = TDM_ELM_LATE; > + tdm->syncm = TDM_SYNCM_SHORT; > + > + tdm->rx.ifl = TDM_FIFO_HALF; > + tdm->tx.ifl = TDM_FIFO_HALF; > + tdm->rx.wl = TDM_16BIT_WORD_LEN; > + tdm->tx.wl = TDM_16BIT_WORD_LEN; > + tdm->rx.sscale = 2; > + tdm->tx.sscale = 2; > + tdm->rx.lrj = TDM_LEFT_JUSTIFT; > + tdm->tx.lrj = TDM_LEFT_JUSTIFT; > + > + tdm->play_dma_data.addr = JH7110_TDM_FIFO; > + tdm->play_dma_data.addr_width = DMA_SLAVE_BUSWIDTH_2_BYTES; > + tdm->play_dma_data.fifo_size = JH7110_TDM_FIFO_DEPTH / 2; > + tdm->play_dma_data.maxburst = 16; > + > + tdm->capture_dma_data.addr = JH7110_TDM_FIFO; > + tdm->capture_dma_data.addr_width = DMA_SLAVE_BUSWIDTH_2_BYTES; > + tdm->capture_dma_data.fifo_size = JH7110_TDM_FIFO_DEPTH / 2; > + tdm->capture_dma_data.maxburst = 8; > +} > + > +static int jh7110_tdm_clk_reset_init(struct platform_device *pdev, > + struct jh7110_tdm_dev *tdm) > +{ > + int i, ret; > + > + for (i = 0; i < tdm->num_clks; i++) { > + tdm->clks[i] = devm_clk_get(&pdev->dev, tdm->clk_names[i]); > + if (IS_ERR(tdm->clks[i])) { > + dev_err(&pdev->dev, "Failed to get clock: %s\n", > + tdm->clk_names[i]); > + return PTR_ERR(tdm->clks[i]); > + } > + } > + > + tdm->resets = devm_reset_control_array_get_exclusive(&pdev->dev); > + if (IS_ERR(tdm->resets)) { > + ret = PTR_ERR(tdm->resets); > + dev_err(&pdev->dev, "Failed to get tdm resets"); > + return ret; > + } > + > + return jh7110_tdm_clk_enable(tdm); > +} > + > +static int jh7110_tdm_probe(struct platform_device *pdev) > +{ > + struct jh7110_tdm_dev *tdm; > + const struct starfive_tdm_driverdata *driver_data; > + int ret; > + > + tdm = devm_kzalloc(&pdev->dev, sizeof(*tdm), GFP_KERNEL); > + if (!tdm) > + return -ENOMEM; > + > + driver_data = of_device_get_match_data(&pdev->dev); > + tdm->clk_names = (const char **)driver_data->clk_names; > + tdm->num_clks = driver_data->num_clks; > + > + tdm->tdm_base = devm_platform_ioremap_resource(pdev, 0); > + if (IS_ERR(tdm->tdm_base)) > + return PTR_ERR(tdm->tdm_base); > + > + tdm->dev = &pdev->dev; > + > + ret = jh7110_tdm_clk_reset_init(pdev, tdm); > + if (ret) { > + dev_err(&pdev->dev, "Failed to enable audio-tdm clock\n"); > + return ret; > + } > + > + jh7110_tdm_init_params(tdm); > + > + dev_set_drvdata(&pdev->dev, tdm); > + ret = devm_snd_soc_register_component(&pdev->dev, &jh7110_tdm_component, > + &jh7110_tdm_dai, 1); > + if (ret != 0) { > + dev_err(&pdev->dev, "Failed to register dai\n"); > + return ret; > + } > + > + ret = devm_snd_dmaengine_pcm_register(&pdev->dev, > + &jh7110_dmaengine_pcm_config, > + SND_DMAENGINE_PCM_FLAG_COMPAT); > + if (ret) { > + dev_err(&pdev->dev, "Could not register pcm: %d\n", ret); > + return ret; > + } > + > + pm_runtime_enable(&pdev->dev); > +#ifdef CONFIG_PM > + jh7110_tdm_clk_disable(tdm); > +#endif > + > + return 0; > +} > + > +static int jh7110_tdm_dev_remove(struct platform_device *pdev) > +{ > + pm_runtime_disable(&pdev->dev); > + return 0; > +} > + > +static const struct starfive_tdm_driverdata jh7110_drvdata = { > + .clk_names = {"mclk_inner", "tdm_ahb", "tdm_apb", "tdm_internal", "tdm_ext", "tdm"}, > + .num_clks = 6, > +}; > + > +static const struct of_device_id jh7110_tdm_of_match[] = { > + { .compatible = "starfive,jh7110-tdm", .data = &jh7110_drvdata }, > + {} > +}; > + > +MODULE_DEVICE_TABLE(of, jh7110_tdm_of_match); > + > +static const struct dev_pm_ops jh7110_tdm_pm_ops = { > + SET_RUNTIME_PM_OPS(jh7110_tdm_runtime_suspend, > + jh7110_tdm_runtime_resume, NULL) > +}; > + > +static struct platform_driver jh7110_tdm_driver = { > + .driver = { > + .name = "jh7110-tdm", > + .of_match_table = jh7110_tdm_of_match, > + .pm = &jh7110_tdm_pm_ops, > + }, > + .probe = jh7110_tdm_probe, > + .remove = jh7110_tdm_dev_remove, > +}; > +module_platform_driver(jh7110_tdm_driver); > + > +MODULE_DESCRIPTION("StarFive JH7110 TDM ASoC Driver"); > +MODULE_AUTHOR("Walker Chen <walker.chen@starfivetech.com>"); > +MODULE_LICENSE("GPL"); > diff --git a/sound/soc/starfive/jh7110_tdm.h b/sound/soc/starfive/jh7110_tdm.h > new file mode 100644 > index 000000000000..80f17946a45d > --- /dev/null > +++ b/sound/soc/starfive/jh7110_tdm.h > @@ -0,0 +1,147 @@ > +/* SPDX-License-Identifier: GPL-2.0 > + * > + * TDM driver for the StarFive JH7110 SoC > + * > + * Copyright (C) 2022-2023 StarFive Technology Co., Ltd. > + * > + * Author: Walker Chen <walker.chen@starfivetech.com> > + */ > + > +#ifndef __SND_SOC_STARFIVE_TDM_H > +#define __SND_SOC_STARFIVE_TDM_H > + > +#include <linux/clk.h> > +#include <linux/device.h> > +#include <linux/types.h> > +#include <sound/dmaengine_pcm.h> > +#include <sound/pcm.h> > +#include <linux/dmaengine.h> > +#include <linux/types.h> > + > +#define TDM_PCMGBCR 0x00 > + #define PCMGBCR_MASK 0x1e > + #define PCMGBCR_ENABLE BIT(0) > + #define PCMGBCR_TRITXEN BIT(4) > + #define CLKPOL_BIT 5 > + #define TRITXEN_BIT 4 > + #define ELM_BIT 3 > + #define SYNCM_BIT 2 > + #define MS_BIT 1 > +#define TDM_PCMTXCR 0x04 > + #define PCMTXCR_TXEN BIT(0) > + #define IFL_BIT 11 > + #define WL_BIT 8 > + #define SSCALE_BIT 4 > + #define SL_BIT 2 > + #define LRJ_BIT 1 > +#define TDM_PCMRXCR 0x08 > + #define PCMRXCR_RXEN BIT(0) > + #define PCMRXCR_RXSL_MASK 0xc > + #define PCMRXCR_RXSL_16BIT 0x4 > + #define PCMRXCR_RXSL_32BIT 0x8 > + #define PCMRXCR_SCALE_MASK 0xf0 > + #define PCMRXCR_SCALE_1CH 0x10 > +#define TDM_PCMDIV 0x0c > + > +/* DMA registers */ > +#define JH7110_TDM_FIFO 0x170c0000 > +#define JH7110_TDM_FIFO_DEPTH 32 > +#define JH7110_TDM_MAX_CLOCKS 6 > + > +enum TDM_MASTER_SLAVE_MODE { > + TDM_AS_MASTER = 0, > + TDM_AS_SLAVE, > +}; > + > +enum TDM_CLKPOL { > + /* tx raising and rx falling */ > + TDM_TX_RASING_RX_FALLING = 0, > + /* tx falling and rx raising */ > + TDM_TX_FALLING_RX_RASING, > +}; > + > +enum TDM_ELM { > + /* only work while SYNCM=0 */ > + TDM_ELM_LATE = 0, > + TDM_ELM_EARLY, > +}; > + > +enum TDM_SYNCM { > + /* short frame sync */ > + TDM_SYNCM_SHORT = 0, > + /* long frame sync */ > + TDM_SYNCM_LONG, > +}; > + > +enum TDM_IFL { > + /* FIFO to send or received : half-1/2, Quarter-1/4 */ > + TDM_FIFO_HALF = 0, > + TDM_FIFO_QUARTER, > +}; > + > +enum TDM_WL { > + /* send or received word length */ > + TDM_8BIT_WORD_LEN = 0, > + TDM_16BIT_WORD_LEN, > + TDM_20BIT_WORD_LEN, > + TDM_24BIT_WORD_LEN, > + TDM_32BIT_WORD_LEN, > +}; > + > +enum TDM_SL { > + /* send or received slot length */ > + TDM_8BIT_SLOT_LEN = 0, > + TDM_16BIT_SLOT_LEN, > + TDM_32BIT_SLOT_LEN, > +}; > + > +enum TDM_LRJ { > + /* left-justify or right-justify */ > + TDM_RIGHT_JUSTIFY = 0, > + TDM_LEFT_JUSTIFT, > +}; > + > +struct tdm_chan_cfg { > + enum TDM_IFL ifl; > + enum TDM_WL wl; > + unsigned char sscale; > + enum TDM_SL sl; > + enum TDM_LRJ lrj; > + unsigned char enable; > +}; > + > +struct starfive_tdm_driverdata { > + const char *clk_names[JH7110_TDM_MAX_CLOCKS]; > + int num_clks; > +}; > + > +struct jh7110_tdm_dev { > + void __iomem *tdm_base; > + struct device *dev; > + const char **clk_names; > + struct clk *clks[JH7110_TDM_MAX_CLOCKS]; > + int num_clks; > + struct reset_control *resets; > + > + enum TDM_CLKPOL clkpolity; > + enum TDM_ELM elm; > + enum TDM_SYNCM syncm; > + enum TDM_MASTER_SLAVE_MODE ms_mode; > + > + struct tdm_chan_cfg tx; > + struct tdm_chan_cfg rx; > + > + u16 syncdiv; > + u32 samplerate; > + u32 pcmclk; > + > + /* data related to DMA transfers b/w tdm and DMAC */ > + struct snd_dmaengine_dai_dma_data play_dma_data; > + struct snd_dmaengine_dai_dma_data capture_dma_data; > + u32 saved_pcmgbcr; > + u32 saved_pcmtxcr; > + u32 saved_pcmrxcr; > + u32 saved_pcmdiv; > +}; > + > +#endif /* __SND_SOC_STARFIVE_TDM_H */
On 2023/5/6 21:47, Shengyu Qu wrote: > Hi, > >> Add tdm driver support for the StarFive JH7110 SoC. >> >> Signed-off-by: Walker Chen <walker.chen@starfivetech.com> >> --- >> MAINTAINERS | 6 + >> sound/soc/Kconfig | 1 + >> sound/soc/Makefile | 1 + >> sound/soc/starfive/Kconfig | 15 + >> sound/soc/starfive/Makefile | 2 + >> sound/soc/starfive/jh7110_tdm.c | 573 ++++++++++++++++++++++++++++++++ >> sound/soc/starfive/jh7110_tdm.h | 147 ++++++++ >> 7 files changed, 745 insertions(+) >> create mode 100644 sound/soc/starfive/Kconfig >> create mode 100644 sound/soc/starfive/Makefile >> create mode 100644 sound/soc/starfive/jh7110_tdm.c >> create mode 100644 sound/soc/starfive/jh7110_tdm.h >> >> diff --git a/MAINTAINERS b/MAINTAINERS >> index 5f9c544bc189..add89615d327 100644 >> --- a/MAINTAINERS >> +++ b/MAINTAINERS >> @@ -19945,6 +19945,12 @@ F: Documentation/devicetree/bindings/power/starfive* >> F: drivers/soc/starfive/jh71xx_pmu.c >> F: include/dt-bindings/power/starfive,jh7110-pmu.h >> +STARFIVE JH7110 TDM DRIVERS >> +M: Walker Chen <walker.chen@starfivetech.com> >> +S: Maintained >> +F: Documentation/devicetree/bindings/sound/starfive,jh7110-tdm.yaml >> +F: sound/soc/starfive/jh7110-tdm.* >> + >> STARFIVE SOC DRIVERS >> M: Conor Dooley <conor@kernel.org> >> S: Maintained >> diff --git a/sound/soc/Kconfig b/sound/soc/Kconfig >> index 848fbae26c3b..8d1d9401ecf2 100644 >> --- a/sound/soc/Kconfig >> +++ b/sound/soc/Kconfig >> @@ -91,6 +91,7 @@ source "sound/soc/sh/Kconfig" >> source "sound/soc/sof/Kconfig" >> source "sound/soc/spear/Kconfig" >> source "sound/soc/sprd/Kconfig" >> +source "sound/soc/starfive/Kconfig" >> source "sound/soc/sti/Kconfig" >> source "sound/soc/stm/Kconfig" >> source "sound/soc/sunxi/Kconfig" >> diff --git a/sound/soc/Makefile b/sound/soc/Makefile >> index 507eaed1d6a1..65aeb4ef4068 100644 >> --- a/sound/soc/Makefile >> +++ b/sound/soc/Makefile >> @@ -59,6 +59,7 @@ obj-$(CONFIG_SND_SOC) += sh/ >> obj-$(CONFIG_SND_SOC) += sof/ >> obj-$(CONFIG_SND_SOC) += spear/ >> obj-$(CONFIG_SND_SOC) += sprd/ >> +obj-$(CONFIG_SND_SOC) += starfive/ >> obj-$(CONFIG_SND_SOC) += sti/ >> obj-$(CONFIG_SND_SOC) += stm/ >> obj-$(CONFIG_SND_SOC) += sunxi/ >> diff --git a/sound/soc/starfive/Kconfig b/sound/soc/starfive/Kconfig >> new file mode 100644 >> index 000000000000..737c956f7b93 >> --- /dev/null >> +++ b/sound/soc/starfive/Kconfig >> @@ -0,0 +1,15 @@ >> +# SPDX-License-Identifier: GPL-2.0-only >> +config SND_SOC_STARFIVE >> + tristate "Audio support for StarFive SoC" >> + depends on COMPILE_TEST || SOC_STARFIVE >> + help >> + Say Y or M if you want to add support for codecs attached to >> + the Starfive SoCs' Audio interfaces. You will also need to >> + select the audio interfaces to support below. >> + >> +config SND_SOC_JH7110_TDM >> + tristate "JH7110 TDM device driver" >> + depends on HAVE_CLK && SND_SOC_STARFIVE >> + select SND_SOC_GENERIC_DMAENGINE_PCM >> + help >> + Say Y or M if you want to add support for StarFive TDM driver. >> diff --git a/sound/soc/starfive/Makefile b/sound/soc/starfive/Makefile >> new file mode 100644 >> index 000000000000..f7d960211d72 >> --- /dev/null >> +++ b/sound/soc/starfive/Makefile >> @@ -0,0 +1,2 @@ >> +# StarFive Platform Support >> +obj-$(CONFIG_SND_SOC_JH7110_TDM) += jh7110_tdm.o >> diff --git a/sound/soc/starfive/jh7110_tdm.c b/sound/soc/starfive/jh7110_tdm.c >> new file mode 100644 >> index 000000000000..33f7cf43e4bd >> --- /dev/null >> +++ b/sound/soc/starfive/jh7110_tdm.c >> @@ -0,0 +1,573 @@ >> +// SPDX-License-Identifier: GPL-2.0 >> +/* >> + * jh7110_tdm.c -- StarFive JH7110 TDM driver >> + * >> + * Copyright (C) 2022-2023 StarFive Technology Co., Ltd. >> + * >> + * Author: Walker Chen <walker.chen@starfivetech.com> >> + */ >> + >> +#include <linux/clk.h> >> +#include <linux/device.h> >> +#include <linux/module.h> >> +#include <linux/of_irq.h> >> +#include <linux/of_platform.h> >> +#include <linux/pm_runtime.h> >> +#include <linux/regmap.h> >> +#include <linux/reset.h> >> +#include <sound/initval.h> >> +#include <sound/pcm_params.h> >> +#include <sound/soc.h> >> +#include <sound/soc-dai.h> >> +#include "jh7110_tdm.h" >> + >> +static inline u32 jh7110_tdm_readl(struct jh7110_tdm_dev *tdm, u16 reg) >> +{ >> + return readl_relaxed(tdm->tdm_base + reg); >> +} >> + >> +static inline void jh7110_tdm_writel(struct jh7110_tdm_dev *tdm, u16 reg, u32 val) >> +{ >> + writel_relaxed(val, tdm->tdm_base + reg); >> +} >> + >> +static void jh7110_tdm_save_context(struct jh7110_tdm_dev *tdm, >> + struct snd_pcm_substream *substream) >> +{ >> + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) >> + tdm->saved_pcmtxcr = jh7110_tdm_readl(tdm, TDM_PCMTXCR); >> + else >> + tdm->saved_pcmrxcr = jh7110_tdm_readl(tdm, TDM_PCMRXCR); >> +} >> + >> +static void jh7110_tdm_start(struct jh7110_tdm_dev *tdm, >> + struct snd_pcm_substream *substream) >> +{ >> + u32 data; >> + >> + data = jh7110_tdm_readl(tdm, TDM_PCMGBCR); >> + jh7110_tdm_writel(tdm, TDM_PCMGBCR, data | PCMGBCR_ENABLE); >> + >> + /* restore context */ >> + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) >> + jh7110_tdm_writel(tdm, TDM_PCMTXCR, tdm->saved_pcmtxcr | PCMTXCR_TXEN); >> + else >> + jh7110_tdm_writel(tdm, TDM_PCMRXCR, tdm->saved_pcmrxcr | PCMRXCR_RXEN); >> +} >> + >> +static void jh7110_tdm_stop(struct jh7110_tdm_dev *tdm, >> + struct snd_pcm_substream *substream) >> +{ >> + unsigned int val; >> + >> + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { >> + val = jh7110_tdm_readl(tdm, TDM_PCMTXCR); >> + val &= ~PCMTXCR_TXEN; >> + jh7110_tdm_writel(tdm, TDM_PCMTXCR, val); >> + } else { >> + val = jh7110_tdm_readl(tdm, TDM_PCMRXCR); >> + val &= ~PCMRXCR_RXEN; >> + jh7110_tdm_writel(tdm, TDM_PCMRXCR, val); >> + } >> +} >> + >> +static int jh7110_tdm_syncdiv(struct jh7110_tdm_dev *tdm) >> +{ >> + u32 sl, sscale, syncdiv; >> + >> + if (tdm->rx.sl >= tdm->tx.sl) >> + sl = tdm->rx.sl; >> + else >> + sl = tdm->tx.sl; >> + >> + if (tdm->rx.sscale >= tdm->tx.sscale) >> + sscale = tdm->rx.sscale; >> + else >> + sscale = tdm->tx.sscale; >> + >> + syncdiv = tdm->pcmclk / tdm->samplerate - 1; >> + >> + if ((syncdiv + 1) < (sl * sscale)) { >> + dev_err(tdm->dev, "Failed to set syncdiv!\n"); >> + return -EINVAL; >> + } >> + >> + if (tdm->syncm == TDM_SYNCM_LONG && >> + (tdm->rx.sscale <= 1 || tdm->tx.sscale <= 1)) { >> + if ((syncdiv + 1) <= sl) { >> + dev_err(tdm->dev, "Wrong syncdiv! It must be (syncdiv+1) > max[tx.sl, rx.sl]\n"); >> + return -EINVAL; >> + } >> + } >> + >> + jh7110_tdm_writel(tdm, TDM_PCMDIV, syncdiv); >> + return 0; >> +} >> + >> +static int jh7110_tdm_config(struct jh7110_tdm_dev *tdm, >> + struct snd_pcm_substream *substream) >> +{ >> + u32 datarx, datatx; >> + int ret; >> + >> + ret = jh7110_tdm_syncdiv(tdm); >> + if (ret) >> + return ret; >> + >> + datarx = (tdm->rx.ifl << IFL_BIT) | >> + (tdm->rx.wl << WL_BIT) | >> + (tdm->rx.sscale << SSCALE_BIT) | >> + (tdm->rx.sl << SL_BIT) | >> + (tdm->rx.lrj << LRJ_BIT); >> + >> + datatx = (tdm->tx.ifl << IFL_BIT) | >> + (tdm->tx.wl << WL_BIT) | >> + (tdm->tx.sscale << SSCALE_BIT) | >> + (tdm->tx.sl << SL_BIT) | >> + (tdm->tx.lrj << LRJ_BIT); >> + >> + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) >> + jh7110_tdm_writel(tdm, TDM_PCMTXCR, datatx); >> + else >> + jh7110_tdm_writel(tdm, TDM_PCMRXCR, datarx); >> + >> + return 0; >> +} >> + >> +static void jh7110_tdm_clk_disable(struct jh7110_tdm_dev *tdm) >> +{ >> + int i; >> + >> + for (i = tdm->num_clks - 1; i >= 0; i--) >> + clk_disable_unprepare(tdm->clks[i]); >> +} >> + >> +static int jh7110_tdm_clk_enable(struct jh7110_tdm_dev *tdm) >> +{ >> + int i, ret; >> + >> + for (i = 0; i < tdm->num_clks; i++) { >> + ret = clk_prepare_enable(tdm->clks[i]); >> + if (ret) { >> + while (i-- > 0) >> + clk_disable_unprepare(tdm->clks[i]); >> + return ret; >> + } >> + } >> + >> + ret = reset_control_deassert(tdm->resets); >> + if (ret) { >> + dev_err(tdm->dev, "Failed to deassert tdm resets\n"); >> + goto dis_tdm_clk; >> + } >> + >> + /* select tdm_ext clock as the clock source for tdm */ >> + ret = clk_set_parent(tdm->clks[5], tdm->clks[4]); >> + if (ret) { >> + dev_err(tdm->dev, "Can't set clock source for clk_tdm: %d\n", ret); >> + goto dis_tdm_clk; >> + } >> + return 0; >> + >> +dis_tdm_clk: >> + for (i = tdm->num_clks - 1; i >= 0; i--) >> + clk_disable_unprepare(tdm->clks[i]); >> + >> + return ret; >> +} >> + >> +#ifdef CONFIG_PM >> +static int jh7110_tdm_runtime_suspend(struct device *dev) >> +{ >> + struct jh7110_tdm_dev *tdm = dev_get_drvdata(dev); >> + >> + jh7110_tdm_clk_disable(tdm); >> + return 0; >> +} >> + >> +static int jh7110_tdm_runtime_resume(struct device *dev) >> +{ >> + struct jh7110_tdm_dev *tdm = dev_get_drvdata(dev); >> + >> + return jh7110_tdm_clk_enable(tdm); >> +} >> +#endif >> + >> +#ifdef CONFIG_PM_SLEEP >> +static int jh7110_tdm_suspend(struct snd_soc_component *component) >> +{ >> + /* save context */ >> + tdm->saved_pcmgbcr = jh7110_tdm_readl(tdm, TDM_PCMGBCR); >> + tdm->saved_pcmdiv = jh7110_tdm_readl(tdm, TDM_PCMDIV); > > tdm isn't declared here. Is that same with resume function? OMG! Maybe I accidentally deleted the declaration of tdm while deleting some debugging statement. Yes, it is same with resume function. Best regards, Walker
On 06.05.2023 12:01, Walker Chen wrote: > EXTERNAL EMAIL: Do not click links or open attachments unless you know the content is safe > > Add tdm driver support for the StarFive JH7110 SoC. > > Signed-off-by: Walker Chen <walker.chen@starfivetech.com> > --- > MAINTAINERS | 6 + > sound/soc/Kconfig | 1 + > sound/soc/Makefile | 1 + > sound/soc/starfive/Kconfig | 15 + > sound/soc/starfive/Makefile | 2 + > sound/soc/starfive/jh7110_tdm.c | 573 ++++++++++++++++++++++++++++++++ > sound/soc/starfive/jh7110_tdm.h | 147 ++++++++ > 7 files changed, 745 insertions(+) > create mode 100644 sound/soc/starfive/Kconfig > create mode 100644 sound/soc/starfive/Makefile > create mode 100644 sound/soc/starfive/jh7110_tdm.c > create mode 100644 sound/soc/starfive/jh7110_tdm.h > > diff --git a/MAINTAINERS b/MAINTAINERS > index 5f9c544bc189..add89615d327 100644 > --- a/MAINTAINERS > +++ b/MAINTAINERS > @@ -19945,6 +19945,12 @@ F: Documentation/devicetree/bindings/power/starfive* > F: drivers/soc/starfive/jh71xx_pmu.c > F: include/dt-bindings/power/starfive,jh7110-pmu.h > > +STARFIVE JH7110 TDM DRIVERS > +M: Walker Chen <walker.chen@starfivetech.com> > +S: Maintained > +F: Documentation/devicetree/bindings/sound/starfive,jh7110-tdm.yaml > +F: sound/soc/starfive/jh7110-tdm.* > + > STARFIVE SOC DRIVERS > M: Conor Dooley <conor@kernel.org> > S: Maintained > diff --git a/sound/soc/Kconfig b/sound/soc/Kconfig > index 848fbae26c3b..8d1d9401ecf2 100644 > --- a/sound/soc/Kconfig > +++ b/sound/soc/Kconfig > @@ -91,6 +91,7 @@ source "sound/soc/sh/Kconfig" > source "sound/soc/sof/Kconfig" > source "sound/soc/spear/Kconfig" > source "sound/soc/sprd/Kconfig" > +source "sound/soc/starfive/Kconfig" > source "sound/soc/sti/Kconfig" > source "sound/soc/stm/Kconfig" > source "sound/soc/sunxi/Kconfig" > diff --git a/sound/soc/Makefile b/sound/soc/Makefile > index 507eaed1d6a1..65aeb4ef4068 100644 > --- a/sound/soc/Makefile > +++ b/sound/soc/Makefile > @@ -59,6 +59,7 @@ obj-$(CONFIG_SND_SOC) += sh/ > obj-$(CONFIG_SND_SOC) += sof/ > obj-$(CONFIG_SND_SOC) += spear/ > obj-$(CONFIG_SND_SOC) += sprd/ > +obj-$(CONFIG_SND_SOC) += starfive/ > obj-$(CONFIG_SND_SOC) += sti/ > obj-$(CONFIG_SND_SOC) += stm/ > obj-$(CONFIG_SND_SOC) += sunxi/ > diff --git a/sound/soc/starfive/Kconfig b/sound/soc/starfive/Kconfig > new file mode 100644 > index 000000000000..737c956f7b93 > --- /dev/null > +++ b/sound/soc/starfive/Kconfig > @@ -0,0 +1,15 @@ > +# SPDX-License-Identifier: GPL-2.0-only > +config SND_SOC_STARFIVE > + tristate "Audio support for StarFive SoC" > + depends on COMPILE_TEST || SOC_STARFIVE > + help > + Say Y or M if you want to add support for codecs attached to > + the Starfive SoCs' Audio interfaces. You will also need to > + select the audio interfaces to support below. > + > +config SND_SOC_JH7110_TDM > + tristate "JH7110 TDM device driver" > + depends on HAVE_CLK && SND_SOC_STARFIVE > + select SND_SOC_GENERIC_DMAENGINE_PCM > + help > + Say Y or M if you want to add support for StarFive TDM driver. > diff --git a/sound/soc/starfive/Makefile b/sound/soc/starfive/Makefile > new file mode 100644 > index 000000000000..f7d960211d72 > --- /dev/null > +++ b/sound/soc/starfive/Makefile > @@ -0,0 +1,2 @@ > +# StarFive Platform Support > +obj-$(CONFIG_SND_SOC_JH7110_TDM) += jh7110_tdm.o > diff --git a/sound/soc/starfive/jh7110_tdm.c b/sound/soc/starfive/jh7110_tdm.c > new file mode 100644 > index 000000000000..33f7cf43e4bd > --- /dev/null > +++ b/sound/soc/starfive/jh7110_tdm.c > @@ -0,0 +1,573 @@ > +// SPDX-License-Identifier: GPL-2.0 > +/* > + * jh7110_tdm.c -- StarFive JH7110 TDM driver > + * > + * Copyright (C) 2022-2023 StarFive Technology Co., Ltd. > + * > + * Author: Walker Chen <walker.chen@starfivetech.com> > + */ > + > +#include <linux/clk.h> > +#include <linux/device.h> > +#include <linux/module.h> > +#include <linux/of_irq.h> > +#include <linux/of_platform.h> > +#include <linux/pm_runtime.h> > +#include <linux/regmap.h> > +#include <linux/reset.h> > +#include <sound/initval.h> > +#include <sound/pcm_params.h> > +#include <sound/soc.h> > +#include <sound/soc-dai.h> > +#include "jh7110_tdm.h" > + > +static inline u32 jh7110_tdm_readl(struct jh7110_tdm_dev *tdm, u16 reg) > +{ > + return readl_relaxed(tdm->tdm_base + reg); > +} > + > +static inline void jh7110_tdm_writel(struct jh7110_tdm_dev *tdm, u16 reg, u32 val) > +{ > + writel_relaxed(val, tdm->tdm_base + reg); > +} > + > +static void jh7110_tdm_save_context(struct jh7110_tdm_dev *tdm, > + struct snd_pcm_substream *substream) > +{ > + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) > + tdm->saved_pcmtxcr = jh7110_tdm_readl(tdm, TDM_PCMTXCR); > + else > + tdm->saved_pcmrxcr = jh7110_tdm_readl(tdm, TDM_PCMRXCR); > +} > + > +static void jh7110_tdm_start(struct jh7110_tdm_dev *tdm, > + struct snd_pcm_substream *substream) > +{ > + u32 data; > + > + data = jh7110_tdm_readl(tdm, TDM_PCMGBCR); > + jh7110_tdm_writel(tdm, TDM_PCMGBCR, data | PCMGBCR_ENABLE); > + > + /* restore context */ > + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) > + jh7110_tdm_writel(tdm, TDM_PCMTXCR, tdm->saved_pcmtxcr | PCMTXCR_TXEN); > + else > + jh7110_tdm_writel(tdm, TDM_PCMRXCR, tdm->saved_pcmrxcr | PCMRXCR_RXEN); > +} > + > +static void jh7110_tdm_stop(struct jh7110_tdm_dev *tdm, > + struct snd_pcm_substream *substream) > +{ > + unsigned int val; > + > + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { > + val = jh7110_tdm_readl(tdm, TDM_PCMTXCR); > + val &= ~PCMTXCR_TXEN; > + jh7110_tdm_writel(tdm, TDM_PCMTXCR, val); > + } else { > + val = jh7110_tdm_readl(tdm, TDM_PCMRXCR); > + val &= ~PCMRXCR_RXEN; > + jh7110_tdm_writel(tdm, TDM_PCMRXCR, val); > + } > +} > + > +static int jh7110_tdm_syncdiv(struct jh7110_tdm_dev *tdm) > +{ > + u32 sl, sscale, syncdiv; > + > + if (tdm->rx.sl >= tdm->tx.sl) > + sl = tdm->rx.sl; > + else > + sl = tdm->tx.sl; > + > + if (tdm->rx.sscale >= tdm->tx.sscale) > + sscale = tdm->rx.sscale; > + else > + sscale = tdm->tx.sscale; > + > + syncdiv = tdm->pcmclk / tdm->samplerate - 1; > + > + if ((syncdiv + 1) < (sl * sscale)) { > + dev_err(tdm->dev, "Failed to set syncdiv!\n"); > + return -EINVAL; > + } > + > + if (tdm->syncm == TDM_SYNCM_LONG && > + (tdm->rx.sscale <= 1 || tdm->tx.sscale <= 1)) { > + if ((syncdiv + 1) <= sl) { > + dev_err(tdm->dev, "Wrong syncdiv! It must be (syncdiv+1) > max[tx.sl, rx.sl]\n"); > + return -EINVAL; > + } > + } > + > + jh7110_tdm_writel(tdm, TDM_PCMDIV, syncdiv); > + return 0; > +} > + > +static int jh7110_tdm_config(struct jh7110_tdm_dev *tdm, > + struct snd_pcm_substream *substream) > +{ > + u32 datarx, datatx; > + int ret; > + > + ret = jh7110_tdm_syncdiv(tdm); > + if (ret) > + return ret; > + > + datarx = (tdm->rx.ifl << IFL_BIT) | > + (tdm->rx.wl << WL_BIT) | > + (tdm->rx.sscale << SSCALE_BIT) | > + (tdm->rx.sl << SL_BIT) | > + (tdm->rx.lrj << LRJ_BIT); > + > + datatx = (tdm->tx.ifl << IFL_BIT) | > + (tdm->tx.wl << WL_BIT) | > + (tdm->tx.sscale << SSCALE_BIT) | > + (tdm->tx.sl << SL_BIT) | > + (tdm->tx.lrj << LRJ_BIT); > + > + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) > + jh7110_tdm_writel(tdm, TDM_PCMTXCR, datatx); > + else > + jh7110_tdm_writel(tdm, TDM_PCMRXCR, datarx); > + > + return 0; > +} > + > +static void jh7110_tdm_clk_disable(struct jh7110_tdm_dev *tdm) > +{ > + int i; > + > + for (i = tdm->num_clks - 1; i >= 0; i--) > + clk_disable_unprepare(tdm->clks[i]); > +} This could be replaced by clk_bulk_disable_unprepare(). > + > +static int jh7110_tdm_clk_enable(struct jh7110_tdm_dev *tdm) > +{ > + int i, ret; > + > + for (i = 0; i < tdm->num_clks; i++) { > + ret = clk_prepare_enable(tdm->clks[i]); > + if (ret) { > + while (i-- > 0) > + clk_disable_unprepare(tdm->clks[i]); > + return ret; > + } > + } And this could be replaced by clk_bulk_prepare_enable(). > + > + ret = reset_control_deassert(tdm->resets); > + if (ret) { > + dev_err(tdm->dev, "Failed to deassert tdm resets\n"); > + goto dis_tdm_clk; > + } > + > + /* select tdm_ext clock as the clock source for tdm */ > + ret = clk_set_parent(tdm->clks[5], tdm->clks[4]); > + if (ret) { > + dev_err(tdm->dev, "Can't set clock source for clk_tdm: %d\n", ret); > + goto dis_tdm_clk; > + } > + return 0; > + > +dis_tdm_clk: > + for (i = tdm->num_clks - 1; i >= 0; i--) > + clk_disable_unprepare(tdm->clks[i]); clk_bulk_disable_unprepare() > + > + return ret; > +} > + > +#ifdef CONFIG_PM > +static int jh7110_tdm_runtime_suspend(struct device *dev) > +{ > + struct jh7110_tdm_dev *tdm = dev_get_drvdata(dev); > + > + jh7110_tdm_clk_disable(tdm); > + return 0; > +} > + > +static int jh7110_tdm_runtime_resume(struct device *dev) > +{ > + struct jh7110_tdm_dev *tdm = dev_get_drvdata(dev); > + > + return jh7110_tdm_clk_enable(tdm); > +} > +#endif > + > +#ifdef CONFIG_PM_SLEEP > +static int jh7110_tdm_suspend(struct snd_soc_component *component) > +{ > + /* save context */ > + tdm->saved_pcmgbcr = jh7110_tdm_readl(tdm, TDM_PCMGBCR); > + tdm->saved_pcmdiv = jh7110_tdm_readl(tdm, TDM_PCMDIV); > + > + return pm_runtime_force_suspend(component->dev); > +} > + > +static int jh7110_tdm_resume(struct snd_soc_component *component) > +{ > + struct jh7110_tdm_dev *tdm = snd_soc_component_get_drvdata(component); > + > + /* restore context */ > + jh7110_tdm_writel(tdm, TDM_PCMGBCR, tdm->saved_pcmgbcr); > + jh7110_tdm_writel(tdm, TDM_PCMDIV, tdm->saved_pcmdiv); > + > + return pm_runtime_force_resume(component->dev); > +} > + > +#else > +#define jh7110_tdm_suspend NULL > +#define jh7110_tdm_resume NULL > +#endif you may use pm_sleep_ptr() to avoid these. > + > +static const struct snd_soc_component_driver jh7110_tdm_component = { > + .name = "jh7110-tdm", > + .suspend = jh7110_tdm_suspend, > + .resume = jh7110_tdm_resume, > +}; > + > +static int jh7110_tdm_startup(struct snd_pcm_substream *substream, > + struct snd_soc_dai *cpu_dai) > +{ > + struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); > + struct snd_soc_dai_link *dai_link = rtd->dai_link; > + > + dai_link->stop_dma_first = 1; > + > + return 0; > +} > + > +static int jh7110_tdm_hw_params(struct snd_pcm_substream *substream, > + struct snd_pcm_hw_params *params, > + struct snd_soc_dai *dai) > +{ > + struct jh7110_tdm_dev *tdm = snd_soc_dai_get_drvdata(dai); > + int chan_wl, chan_sl, chan_nr; > + unsigned int data_width; > + unsigned int dma_bus_width; > + struct snd_dmaengine_dai_dma_data *dma_data = NULL; > + int ret = 0; > + > + data_width = params_width(params); > + > + tdm->samplerate = params_rate(params); > + tdm->pcmclk = params_channels(params) * tdm->samplerate * data_width; > + > + switch (params_format(params)) { > + case SNDRV_PCM_FORMAT_S16_LE: > + chan_wl = TDM_16BIT_WORD_LEN; > + chan_sl = TDM_16BIT_SLOT_LEN; > + dma_bus_width = DMA_SLAVE_BUSWIDTH_2_BYTES; > + break; > + > + case SNDRV_PCM_FORMAT_S32_LE: > + chan_wl = TDM_32BIT_WORD_LEN; > + chan_sl = TDM_32BIT_SLOT_LEN; > + dma_bus_width = DMA_SLAVE_BUSWIDTH_4_BYTES; > + break; > + > + default: > + dev_err(tdm->dev, "tdm: unsupported PCM fmt"); > + return -EINVAL; > + } > + > + chan_nr = params_channels(params); > + switch (chan_nr) { > + case 1: > + case 2: > + case 4: > + case 6: > + case 8: > + break; > + default: > + dev_err(tdm->dev, "channel not supported\n"); > + return -EINVAL; > + } > + > + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { > + tdm->tx.wl = chan_wl; > + tdm->tx.sl = chan_sl; > + tdm->tx.sscale = chan_nr; > + tdm->play_dma_data.addr_width = dma_bus_width; > + dma_data = &tdm->play_dma_data; > + } else { > + tdm->rx.wl = chan_wl; > + tdm->rx.sl = chan_sl; > + tdm->rx.sscale = chan_nr; > + tdm->capture_dma_data.addr_width = dma_bus_width; > + dma_data = &tdm->capture_dma_data; > + } > + > + snd_soc_dai_set_dma_data(dai, substream, dma_data); > + > + ret = jh7110_tdm_config(tdm, substream); > + if (ret) > + return ret; > + > + jh7110_tdm_save_context(tdm, substream); > + return 0; > +} > + > +static int jh7110_tdm_trigger(struct snd_pcm_substream *substream, > + int cmd, struct snd_soc_dai *dai) > +{ > + struct jh7110_tdm_dev *tdm = snd_soc_dai_get_drvdata(dai); > + int ret = 0; > + > + switch (cmd) { > + case SNDRV_PCM_TRIGGER_START: > + case SNDRV_PCM_TRIGGER_RESUME: > + case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: > + jh7110_tdm_start(tdm, substream); > + break; > + > + case SNDRV_PCM_TRIGGER_STOP: > + case SNDRV_PCM_TRIGGER_SUSPEND: > + case SNDRV_PCM_TRIGGER_PAUSE_PUSH: > + jh7110_tdm_stop(tdm, substream); > + break; > + default: > + ret = -EINVAL; > + break; > + } > + return ret; > +} > + > +static int jh7110_tdm_set_dai_fmt(struct snd_soc_dai *cpu_dai, > + unsigned int fmt) > +{ > + struct jh7110_tdm_dev *tdm = snd_soc_dai_get_drvdata(cpu_dai); > + unsigned int gbcr; > + int ret = 0; > + > + /* set master/slave audio interface */ > + switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) { > + case SND_SOC_DAIFMT_BP_FP: > + /* cpu is master */ > + tdm->ms_mode = TDM_AS_MASTER; > + break; > + case SND_SOC_DAIFMT_BC_FC: > + /* codec is master */ > + tdm->ms_mode = TDM_AS_SLAVE; > + break; > + case SND_SOC_DAIFMT_BC_FP: > + case SND_SOC_DAIFMT_BP_FC: > + ret = -EINVAL; > + break; > + default: > + dev_dbg(tdm->dev, "dwc : Invalid clock provider format\n"); > + ret = -EINVAL; > + break; > + } > + > + gbcr = (tdm->clkpolity << CLKPOL_BIT) | > + (tdm->elm << ELM_BIT) | > + (tdm->syncm << SYNCM_BIT) | > + (tdm->ms_mode << MS_BIT); > + jh7110_tdm_writel(tdm, TDM_PCMGBCR, gbcr); > + > + return ret; > +} > + > +static const struct snd_soc_dai_ops jh7110_tdm_dai_ops = { > + .startup = jh7110_tdm_startup, > + .hw_params = jh7110_tdm_hw_params, > + .trigger = jh7110_tdm_trigger, > + .set_fmt = jh7110_tdm_set_dai_fmt, > +}; > + > +static int jh7110_tdm_dai_probe(struct snd_soc_dai *dai) > +{ > + struct jh7110_tdm_dev *tdm = snd_soc_dai_get_drvdata(dai); > + > + snd_soc_dai_init_dma_data(dai, &tdm->play_dma_data, &tdm->capture_dma_data); > + snd_soc_dai_set_drvdata(dai, tdm); > + return 0; > +} > + > +#define JH7110_TDM_RATES SNDRV_PCM_RATE_8000_48000 > + > +#define JH7110_TDM_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | \ > + SNDRV_PCM_FMTBIT_S32_LE) > + > +static struct snd_soc_dai_driver jh7110_tdm_dai = { > + .name = "sf_tdm", > + .id = 0, > + .playback = { > + .stream_name = "Playback", > + .channels_min = 1, > + .channels_max = 8, > + .rates = JH7110_TDM_RATES, > + .formats = JH7110_TDM_FORMATS, > + }, > + .capture = { > + .stream_name = "Capture", > + .channels_min = 1, > + .channels_max = 8, > + .rates = JH7110_TDM_RATES, > + .formats = JH7110_TDM_FORMATS, > + }, > + .ops = &jh7110_tdm_dai_ops, > + .probe = jh7110_tdm_dai_probe, > + .symmetric_rate = 1, > +}; > + > +static const struct snd_pcm_hardware jh7110_pcm_hardware = { > + .info = (SNDRV_PCM_INFO_MMAP | > + SNDRV_PCM_INFO_MMAP_VALID | > + SNDRV_PCM_INFO_PAUSE | > + SNDRV_PCM_INFO_RESUME | > + SNDRV_PCM_INFO_INTERLEAVED | > + SNDRV_PCM_INFO_BLOCK_TRANSFER), > + .buffer_bytes_max = 192512, > + .period_bytes_min = 4096, > + .period_bytes_max = 32768, > + .periods_min = 1, > + .periods_max = 48, > + .fifo_size = 16, > +}; > + > +static const struct snd_dmaengine_pcm_config jh7110_dmaengine_pcm_config = { > + .pcm_hardware = &jh7110_pcm_hardware, > + .prepare_slave_config = snd_dmaengine_pcm_prepare_slave_config, > + .prealloc_buffer_size = 192512, > +}; > + > +static void jh7110_tdm_init_params(struct jh7110_tdm_dev *tdm) > +{ > + tdm->clkpolity = TDM_TX_RASING_RX_FALLING; > + tdm->elm = TDM_ELM_LATE; > + tdm->syncm = TDM_SYNCM_SHORT; > + > + tdm->rx.ifl = TDM_FIFO_HALF; > + tdm->tx.ifl = TDM_FIFO_HALF; > + tdm->rx.wl = TDM_16BIT_WORD_LEN; > + tdm->tx.wl = TDM_16BIT_WORD_LEN; > + tdm->rx.sscale = 2; > + tdm->tx.sscale = 2; > + tdm->rx.lrj = TDM_LEFT_JUSTIFT; > + tdm->tx.lrj = TDM_LEFT_JUSTIFT; > + > + tdm->play_dma_data.addr = JH7110_TDM_FIFO; > + tdm->play_dma_data.addr_width = DMA_SLAVE_BUSWIDTH_2_BYTES; > + tdm->play_dma_data.fifo_size = JH7110_TDM_FIFO_DEPTH / 2; > + tdm->play_dma_data.maxburst = 16; > + > + tdm->capture_dma_data.addr = JH7110_TDM_FIFO; > + tdm->capture_dma_data.addr_width = DMA_SLAVE_BUSWIDTH_2_BYTES; > + tdm->capture_dma_data.fifo_size = JH7110_TDM_FIFO_DEPTH / 2; > + tdm->capture_dma_data.maxburst = 8; > +} > + > +static int jh7110_tdm_clk_reset_init(struct platform_device *pdev, > + struct jh7110_tdm_dev *tdm) > +{ > + int i, ret; > + > + for (i = 0; i < tdm->num_clks; i++) { > + tdm->clks[i] = devm_clk_get(&pdev->dev, tdm->clk_names[i]); > + if (IS_ERR(tdm->clks[i])) { > + dev_err(&pdev->dev, "Failed to get clock: %s\n", > + tdm->clk_names[i]); > + return PTR_ERR(tdm->clks[i]); > + } > + } devm_clk_bulk_get() ? > + > + tdm->resets = devm_reset_control_array_get_exclusive(&pdev->dev); > + if (IS_ERR(tdm->resets)) { > + ret = PTR_ERR(tdm->resets); > + dev_err(&pdev->dev, "Failed to get tdm resets"); > + return ret; > + } > + > + return jh7110_tdm_clk_enable(tdm); > +} > + > +static int jh7110_tdm_probe(struct platform_device *pdev) > +{ > + struct jh7110_tdm_dev *tdm; > + const struct starfive_tdm_driverdata *driver_data; > + int ret; > + > + tdm = devm_kzalloc(&pdev->dev, sizeof(*tdm), GFP_KERNEL); > + if (!tdm) > + return -ENOMEM; > + > + driver_data = of_device_get_match_data(&pdev->dev); > + tdm->clk_names = (const char **)driver_data->clk_names; > + tdm->num_clks = driver_data->num_clks; > + > + tdm->tdm_base = devm_platform_ioremap_resource(pdev, 0); > + if (IS_ERR(tdm->tdm_base)) > + return PTR_ERR(tdm->tdm_base); > + > + tdm->dev = &pdev->dev; > + > + ret = jh7110_tdm_clk_reset_init(pdev, tdm); > + if (ret) { > + dev_err(&pdev->dev, "Failed to enable audio-tdm clock\n"); > + return ret; > + } > + > + jh7110_tdm_init_params(tdm); > + > + dev_set_drvdata(&pdev->dev, tdm); > + ret = devm_snd_soc_register_component(&pdev->dev, &jh7110_tdm_component, > + &jh7110_tdm_dai, 1); > + if (ret != 0) { if (ret) > + dev_err(&pdev->dev, "Failed to register dai\n"); > + return ret; > + } > + > + ret = devm_snd_dmaengine_pcm_register(&pdev->dev, > + &jh7110_dmaengine_pcm_config, > + SND_DMAENGINE_PCM_FLAG_COMPAT); > + if (ret) { > + dev_err(&pdev->dev, "Could not register pcm: %d\n", ret); > + return ret; > + } > + > + pm_runtime_enable(&pdev->dev); > +#ifdef CONFIG_PM > + jh7110_tdm_clk_disable(tdm); > +#endif > + > + return 0; > +} > + > +static int jh7110_tdm_dev_remove(struct platform_device *pdev) > +{ > + pm_runtime_disable(&pdev->dev); > + return 0; > +} > + > +static const struct starfive_tdm_driverdata jh7110_drvdata = { > + .clk_names = {"mclk_inner", "tdm_ahb", "tdm_apb", "tdm_internal", "tdm_ext", "tdm"}, > + .num_clks = 6, > +}; > + > +static const struct of_device_id jh7110_tdm_of_match[] = { > + { .compatible = "starfive,jh7110-tdm", .data = &jh7110_drvdata }, > + {} > +}; > + > +MODULE_DEVICE_TABLE(of, jh7110_tdm_of_match); > + > +static const struct dev_pm_ops jh7110_tdm_pm_ops = { > + SET_RUNTIME_PM_OPS(jh7110_tdm_runtime_suspend, > + jh7110_tdm_runtime_resume, NULL) You can use RUNTIME_PM_OPS() and avoid having #ifdef CONFIG_PM around jh7110_tdm_runtime_suspend and jh7110_tdm_runtime_resume definitions. > +}; > + > +static struct platform_driver jh7110_tdm_driver = { > + .driver = { > + .name = "jh7110-tdm", > + .of_match_table = jh7110_tdm_of_match, > + .pm = &jh7110_tdm_pm_ops, > + }, > + .probe = jh7110_tdm_probe, > + .remove = jh7110_tdm_dev_remove, > +}; > +module_platform_driver(jh7110_tdm_driver); > + > +MODULE_DESCRIPTION("StarFive JH7110 TDM ASoC Driver"); > +MODULE_AUTHOR("Walker Chen <walker.chen@starfivetech.com>"); > +MODULE_LICENSE("GPL"); > diff --git a/sound/soc/starfive/jh7110_tdm.h b/sound/soc/starfive/jh7110_tdm.h > new file mode 100644 > index 000000000000..80f17946a45d > --- /dev/null > +++ b/sound/soc/starfive/jh7110_tdm.h > @@ -0,0 +1,147 @@ > +/* SPDX-License-Identifier: GPL-2.0 > + * > + * TDM driver for the StarFive JH7110 SoC > + * > + * Copyright (C) 2022-2023 StarFive Technology Co., Ltd. > + * > + * Author: Walker Chen <walker.chen@starfivetech.com> > + */ > + > +#ifndef __SND_SOC_STARFIVE_TDM_H > +#define __SND_SOC_STARFIVE_TDM_H > + > +#include <linux/clk.h> > +#include <linux/device.h> > +#include <linux/types.h> > +#include <sound/dmaengine_pcm.h> > +#include <sound/pcm.h> > +#include <linux/dmaengine.h> > +#include <linux/types.h> > + > +#define TDM_PCMGBCR 0x00 > + #define PCMGBCR_MASK 0x1e > + #define PCMGBCR_ENABLE BIT(0) > + #define PCMGBCR_TRITXEN BIT(4) > + #define CLKPOL_BIT 5 > + #define TRITXEN_BIT 4 > + #define ELM_BIT 3 > + #define SYNCM_BIT 2 > + #define MS_BIT 1 > +#define TDM_PCMTXCR 0x04 > + #define PCMTXCR_TXEN BIT(0) > + #define IFL_BIT 11 > + #define WL_BIT 8 > + #define SSCALE_BIT 4 > + #define SL_BIT 2 > + #define LRJ_BIT 1 > +#define TDM_PCMRXCR 0x08 > + #define PCMRXCR_RXEN BIT(0) > + #define PCMRXCR_RXSL_MASK 0xc > + #define PCMRXCR_RXSL_16BIT 0x4 > + #define PCMRXCR_RXSL_32BIT 0x8 > + #define PCMRXCR_SCALE_MASK 0xf0 > + #define PCMRXCR_SCALE_1CH 0x10 > +#define TDM_PCMDIV 0x0c > + > +/* DMA registers */ > +#define JH7110_TDM_FIFO 0x170c0000 > +#define JH7110_TDM_FIFO_DEPTH 32 > +#define JH7110_TDM_MAX_CLOCKS 6 > + > +enum TDM_MASTER_SLAVE_MODE { > + TDM_AS_MASTER = 0, > + TDM_AS_SLAVE, > +}; > + > +enum TDM_CLKPOL { > + /* tx raising and rx falling */ > + TDM_TX_RASING_RX_FALLING = 0, > + /* tx falling and rx raising */ > + TDM_TX_FALLING_RX_RASING, > +}; > + > +enum TDM_ELM { > + /* only work while SYNCM=0 */ > + TDM_ELM_LATE = 0, > + TDM_ELM_EARLY, > +}; > + > +enum TDM_SYNCM { > + /* short frame sync */ > + TDM_SYNCM_SHORT = 0, > + /* long frame sync */ > + TDM_SYNCM_LONG, > +}; > + > +enum TDM_IFL { > + /* FIFO to send or received : half-1/2, Quarter-1/4 */ > + TDM_FIFO_HALF = 0, > + TDM_FIFO_QUARTER, > +}; > + > +enum TDM_WL { > + /* send or received word length */ > + TDM_8BIT_WORD_LEN = 0, > + TDM_16BIT_WORD_LEN, > + TDM_20BIT_WORD_LEN, > + TDM_24BIT_WORD_LEN, > + TDM_32BIT_WORD_LEN, > +}; > + > +enum TDM_SL { > + /* send or received slot length */ > + TDM_8BIT_SLOT_LEN = 0, > + TDM_16BIT_SLOT_LEN, > + TDM_32BIT_SLOT_LEN, > +}; > + > +enum TDM_LRJ { > + /* left-justify or right-justify */ > + TDM_RIGHT_JUSTIFY = 0, > + TDM_LEFT_JUSTIFT, > +}; > + > +struct tdm_chan_cfg { > + enum TDM_IFL ifl; > + enum TDM_WL wl; > + unsigned char sscale; > + enum TDM_SL sl; > + enum TDM_LRJ lrj; > + unsigned char enable; > +}; > + > +struct starfive_tdm_driverdata { > + const char *clk_names[JH7110_TDM_MAX_CLOCKS]; > + int num_clks; > +}; > + > +struct jh7110_tdm_dev { > + void __iomem *tdm_base; > + struct device *dev; > + const char **clk_names; > + struct clk *clks[JH7110_TDM_MAX_CLOCKS]; > + int num_clks; > + struct reset_control *resets; > + > + enum TDM_CLKPOL clkpolity; > + enum TDM_ELM elm; > + enum TDM_SYNCM syncm; > + enum TDM_MASTER_SLAVE_MODE ms_mode; > + > + struct tdm_chan_cfg tx; > + struct tdm_chan_cfg rx; > + > + u16 syncdiv; > + u32 samplerate; > + u32 pcmclk; > + > + /* data related to DMA transfers b/w tdm and DMAC */ > + struct snd_dmaengine_dai_dma_data play_dma_data; > + struct snd_dmaengine_dai_dma_data capture_dma_data; > + u32 saved_pcmgbcr; > + u32 saved_pcmtxcr; > + u32 saved_pcmrxcr; > + u32 saved_pcmdiv; > +}; > + > +#endif /* __SND_SOC_STARFIVE_TDM_H */ > -- > 2.17.1 >
On 2023/5/9 12:33, Claudiu.Beznea@microchip.com wrote: > On 06.05.2023 12:01, Walker Chen wrote: >> EXTERNAL EMAIL: Do not click links or open attachments unless you know the content is safe >> >> Add tdm driver support for the StarFive JH7110 SoC. >> >> Signed-off-by: Walker Chen <walker.chen@starfivetech.com> >> --- >> MAINTAINERS | 6 + >> sound/soc/Kconfig | 1 + >> sound/soc/Makefile | 1 + >> sound/soc/starfive/Kconfig | 15 + >> sound/soc/starfive/Makefile | 2 + >> sound/soc/starfive/jh7110_tdm.c | 573 ++++++++++++++++++++++++++++++++ >> sound/soc/starfive/jh7110_tdm.h | 147 ++++++++ >> 7 files changed, 745 insertions(+) >> create mode 100644 sound/soc/starfive/Kconfig >> create mode 100644 sound/soc/starfive/Makefile >> create mode 100644 sound/soc/starfive/jh7110_tdm.c >> create mode 100644 sound/soc/starfive/jh7110_tdm.h >> >> diff --git a/MAINTAINERS b/MAINTAINERS >> index 5f9c544bc189..add89615d327 100644 >> --- a/MAINTAINERS >> +++ b/MAINTAINERS >> @@ -19945,6 +19945,12 @@ F: Documentation/devicetree/bindings/power/starfive* >> F: drivers/soc/starfive/jh71xx_pmu.c >> F: include/dt-bindings/power/starfive,jh7110-pmu.h >> >> +STARFIVE JH7110 TDM DRIVERS >> +M: Walker Chen <walker.chen@starfivetech.com> >> +S: Maintained >> +F: Documentation/devicetree/bindings/sound/starfive,jh7110-tdm.yaml >> +F: sound/soc/starfive/jh7110-tdm.* >> + >> STARFIVE SOC DRIVERS >> M: Conor Dooley <conor@kernel.org> >> S: Maintained >> diff --git a/sound/soc/Kconfig b/sound/soc/Kconfig >> index 848fbae26c3b..8d1d9401ecf2 100644 >> --- a/sound/soc/Kconfig >> +++ b/sound/soc/Kconfig >> @@ -91,6 +91,7 @@ source "sound/soc/sh/Kconfig" >> source "sound/soc/sof/Kconfig" >> source "sound/soc/spear/Kconfig" >> source "sound/soc/sprd/Kconfig" >> +source "sound/soc/starfive/Kconfig" >> source "sound/soc/sti/Kconfig" >> source "sound/soc/stm/Kconfig" >> source "sound/soc/sunxi/Kconfig" >> diff --git a/sound/soc/Makefile b/sound/soc/Makefile >> index 507eaed1d6a1..65aeb4ef4068 100644 >> --- a/sound/soc/Makefile >> +++ b/sound/soc/Makefile >> @@ -59,6 +59,7 @@ obj-$(CONFIG_SND_SOC) += sh/ >> obj-$(CONFIG_SND_SOC) += sof/ >> obj-$(CONFIG_SND_SOC) += spear/ >> obj-$(CONFIG_SND_SOC) += sprd/ >> +obj-$(CONFIG_SND_SOC) += starfive/ >> obj-$(CONFIG_SND_SOC) += sti/ >> obj-$(CONFIG_SND_SOC) += stm/ >> obj-$(CONFIG_SND_SOC) += sunxi/ >> diff --git a/sound/soc/starfive/Kconfig b/sound/soc/starfive/Kconfig >> new file mode 100644 >> index 000000000000..737c956f7b93 >> --- /dev/null >> +++ b/sound/soc/starfive/Kconfig >> @@ -0,0 +1,15 @@ >> +# SPDX-License-Identifier: GPL-2.0-only >> +config SND_SOC_STARFIVE >> + tristate "Audio support for StarFive SoC" >> + depends on COMPILE_TEST || SOC_STARFIVE >> + help >> + Say Y or M if you want to add support for codecs attached to >> + the Starfive SoCs' Audio interfaces. You will also need to >> + select the audio interfaces to support below. >> + >> +config SND_SOC_JH7110_TDM >> + tristate "JH7110 TDM device driver" >> + depends on HAVE_CLK && SND_SOC_STARFIVE >> + select SND_SOC_GENERIC_DMAENGINE_PCM >> + help >> + Say Y or M if you want to add support for StarFive TDM driver. >> diff --git a/sound/soc/starfive/Makefile b/sound/soc/starfive/Makefile >> new file mode 100644 >> index 000000000000..f7d960211d72 >> --- /dev/null >> +++ b/sound/soc/starfive/Makefile >> @@ -0,0 +1,2 @@ >> +# StarFive Platform Support >> +obj-$(CONFIG_SND_SOC_JH7110_TDM) += jh7110_tdm.o >> diff --git a/sound/soc/starfive/jh7110_tdm.c b/sound/soc/starfive/jh7110_tdm.c >> new file mode 100644 >> index 000000000000..33f7cf43e4bd >> --- /dev/null >> +++ b/sound/soc/starfive/jh7110_tdm.c >> @@ -0,0 +1,573 @@ >> +// SPDX-License-Identifier: GPL-2.0 >> +/* >> + * jh7110_tdm.c -- StarFive JH7110 TDM driver >> + * >> + * Copyright (C) 2022-2023 StarFive Technology Co., Ltd. >> + * >> + * Author: Walker Chen <walker.chen@starfivetech.com> >> + */ >> + >> +#include <linux/clk.h> >> +#include <linux/device.h> >> +#include <linux/module.h> >> +#include <linux/of_irq.h> >> +#include <linux/of_platform.h> >> +#include <linux/pm_runtime.h> >> +#include <linux/regmap.h> >> +#include <linux/reset.h> >> +#include <sound/initval.h> >> +#include <sound/pcm_params.h> >> +#include <sound/soc.h> >> +#include <sound/soc-dai.h> >> +#include "jh7110_tdm.h" >> + >> +static inline u32 jh7110_tdm_readl(struct jh7110_tdm_dev *tdm, u16 reg) >> +{ >> + return readl_relaxed(tdm->tdm_base + reg); >> +} >> + >> +static inline void jh7110_tdm_writel(struct jh7110_tdm_dev *tdm, u16 reg, u32 val) >> +{ >> + writel_relaxed(val, tdm->tdm_base + reg); >> +} >> + >> +static void jh7110_tdm_save_context(struct jh7110_tdm_dev *tdm, >> + struct snd_pcm_substream *substream) >> +{ >> + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) >> + tdm->saved_pcmtxcr = jh7110_tdm_readl(tdm, TDM_PCMTXCR); >> + else >> + tdm->saved_pcmrxcr = jh7110_tdm_readl(tdm, TDM_PCMRXCR); >> +} >> + >> +static void jh7110_tdm_start(struct jh7110_tdm_dev *tdm, >> + struct snd_pcm_substream *substream) >> +{ >> + u32 data; >> + >> + data = jh7110_tdm_readl(tdm, TDM_PCMGBCR); >> + jh7110_tdm_writel(tdm, TDM_PCMGBCR, data | PCMGBCR_ENABLE); >> + >> + /* restore context */ >> + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) >> + jh7110_tdm_writel(tdm, TDM_PCMTXCR, tdm->saved_pcmtxcr | PCMTXCR_TXEN); >> + else >> + jh7110_tdm_writel(tdm, TDM_PCMRXCR, tdm->saved_pcmrxcr | PCMRXCR_RXEN); >> +} >> + >> +static void jh7110_tdm_stop(struct jh7110_tdm_dev *tdm, >> + struct snd_pcm_substream *substream) >> +{ >> + unsigned int val; >> + >> + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { >> + val = jh7110_tdm_readl(tdm, TDM_PCMTXCR); >> + val &= ~PCMTXCR_TXEN; >> + jh7110_tdm_writel(tdm, TDM_PCMTXCR, val); >> + } else { >> + val = jh7110_tdm_readl(tdm, TDM_PCMRXCR); >> + val &= ~PCMRXCR_RXEN; >> + jh7110_tdm_writel(tdm, TDM_PCMRXCR, val); >> + } >> +} >> + >> +static int jh7110_tdm_syncdiv(struct jh7110_tdm_dev *tdm) >> +{ >> + u32 sl, sscale, syncdiv; >> + >> + if (tdm->rx.sl >= tdm->tx.sl) >> + sl = tdm->rx.sl; >> + else >> + sl = tdm->tx.sl; >> + >> + if (tdm->rx.sscale >= tdm->tx.sscale) >> + sscale = tdm->rx.sscale; >> + else >> + sscale = tdm->tx.sscale; >> + >> + syncdiv = tdm->pcmclk / tdm->samplerate - 1; >> + >> + if ((syncdiv + 1) < (sl * sscale)) { >> + dev_err(tdm->dev, "Failed to set syncdiv!\n"); >> + return -EINVAL; >> + } >> + >> + if (tdm->syncm == TDM_SYNCM_LONG && >> + (tdm->rx.sscale <= 1 || tdm->tx.sscale <= 1)) { >> + if ((syncdiv + 1) <= sl) { >> + dev_err(tdm->dev, "Wrong syncdiv! It must be (syncdiv+1) > max[tx.sl, rx.sl]\n"); >> + return -EINVAL; >> + } >> + } >> + >> + jh7110_tdm_writel(tdm, TDM_PCMDIV, syncdiv); >> + return 0; >> +} >> + >> +static int jh7110_tdm_config(struct jh7110_tdm_dev *tdm, >> + struct snd_pcm_substream *substream) >> +{ >> + u32 datarx, datatx; >> + int ret; >> + >> + ret = jh7110_tdm_syncdiv(tdm); >> + if (ret) >> + return ret; >> + >> + datarx = (tdm->rx.ifl << IFL_BIT) | >> + (tdm->rx.wl << WL_BIT) | >> + (tdm->rx.sscale << SSCALE_BIT) | >> + (tdm->rx.sl << SL_BIT) | >> + (tdm->rx.lrj << LRJ_BIT); >> + >> + datatx = (tdm->tx.ifl << IFL_BIT) | >> + (tdm->tx.wl << WL_BIT) | >> + (tdm->tx.sscale << SSCALE_BIT) | >> + (tdm->tx.sl << SL_BIT) | >> + (tdm->tx.lrj << LRJ_BIT); >> + >> + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) >> + jh7110_tdm_writel(tdm, TDM_PCMTXCR, datatx); >> + else >> + jh7110_tdm_writel(tdm, TDM_PCMRXCR, datarx); >> + >> + return 0; >> +} >> + >> +static void jh7110_tdm_clk_disable(struct jh7110_tdm_dev *tdm) >> +{ >> + int i; >> + >> + for (i = tdm->num_clks - 1; i >= 0; i--) >> + clk_disable_unprepare(tdm->clks[i]); >> +} > > This could be replaced by clk_bulk_disable_unprepare(). Thanks for your reminder, it will be changed. > >> + >> +static int jh7110_tdm_clk_enable(struct jh7110_tdm_dev *tdm) >> +{ >> + int i, ret; >> + >> + for (i = 0; i < tdm->num_clks; i++) { >> + ret = clk_prepare_enable(tdm->clks[i]); >> + if (ret) { >> + while (i-- > 0) >> + clk_disable_unprepare(tdm->clks[i]); >> + return ret; >> + } >> + } > > > And this could be replaced by clk_bulk_prepare_enable(). Will be changed. > >> + >> + ret = reset_control_deassert(tdm->resets); >> + if (ret) { >> + dev_err(tdm->dev, "Failed to deassert tdm resets\n"); >> + goto dis_tdm_clk; >> + } >> + >> + /* select tdm_ext clock as the clock source for tdm */ >> + ret = clk_set_parent(tdm->clks[5], tdm->clks[4]); >> + if (ret) { >> + dev_err(tdm->dev, "Can't set clock source for clk_tdm: %d\n", ret); >> + goto dis_tdm_clk; >> + } >> + return 0; >> + >> +dis_tdm_clk: >> + for (i = tdm->num_clks - 1; i >= 0; i--) >> + clk_disable_unprepare(tdm->clks[i]); > > clk_bulk_disable_unprepare() Will be changed. > >> + >> + return ret; >> +} >> + >> +#ifdef CONFIG_PM >> +static int jh7110_tdm_runtime_suspend(struct device *dev) >> +{ >> + struct jh7110_tdm_dev *tdm = dev_get_drvdata(dev); >> + >> + jh7110_tdm_clk_disable(tdm); >> + return 0; >> +} >> + >> +static int jh7110_tdm_runtime_resume(struct device *dev) >> +{ >> + struct jh7110_tdm_dev *tdm = dev_get_drvdata(dev); >> + >> + return jh7110_tdm_clk_enable(tdm); >> +} >> +#endif >> + >> +#ifdef CONFIG_PM_SLEEP >> +static int jh7110_tdm_suspend(struct snd_soc_component *component) >> +{ >> + /* save context */ >> + tdm->saved_pcmgbcr = jh7110_tdm_readl(tdm, TDM_PCMGBCR); >> + tdm->saved_pcmdiv = jh7110_tdm_readl(tdm, TDM_PCMDIV); >> + >> + return pm_runtime_force_suspend(component->dev); >> +} >> + >> +static int jh7110_tdm_resume(struct snd_soc_component *component) >> +{ >> + struct jh7110_tdm_dev *tdm = snd_soc_component_get_drvdata(component); >> + >> + /* restore context */ >> + jh7110_tdm_writel(tdm, TDM_PCMGBCR, tdm->saved_pcmgbcr); >> + jh7110_tdm_writel(tdm, TDM_PCMDIV, tdm->saved_pcmdiv); >> + >> + return pm_runtime_force_resume(component->dev); >> +} >> + >> +#else >> +#define jh7110_tdm_suspend NULL >> +#define jh7110_tdm_resume NULL >> +#endif > > you may use pm_sleep_ptr() to avoid these. OK, thanks for your prompt. > >> + >> +static const struct snd_soc_component_driver jh7110_tdm_component = { >> + .name = "jh7110-tdm", >> + .suspend = jh7110_tdm_suspend, >> + .resume = jh7110_tdm_resume, >> +}; >> + >> +static int jh7110_tdm_startup(struct snd_pcm_substream *substream, >> + struct snd_soc_dai *cpu_dai) >> +{ >> + struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); >> + struct snd_soc_dai_link *dai_link = rtd->dai_link; >> + >> + dai_link->stop_dma_first = 1; >> + >> + return 0; >> +} >> + >> +static int jh7110_tdm_hw_params(struct snd_pcm_substream *substream, >> + struct snd_pcm_hw_params *params, >> + struct snd_soc_dai *dai) >> +{ >> + struct jh7110_tdm_dev *tdm = snd_soc_dai_get_drvdata(dai); >> + int chan_wl, chan_sl, chan_nr; >> + unsigned int data_width; >> + unsigned int dma_bus_width; >> + struct snd_dmaengine_dai_dma_data *dma_data = NULL; >> + int ret = 0; >> + >> + data_width = params_width(params); >> + >> + tdm->samplerate = params_rate(params); >> + tdm->pcmclk = params_channels(params) * tdm->samplerate * data_width; >> + >> + switch (params_format(params)) { >> + case SNDRV_PCM_FORMAT_S16_LE: >> + chan_wl = TDM_16BIT_WORD_LEN; >> + chan_sl = TDM_16BIT_SLOT_LEN; >> + dma_bus_width = DMA_SLAVE_BUSWIDTH_2_BYTES; >> + break; >> + >> + case SNDRV_PCM_FORMAT_S32_LE: >> + chan_wl = TDM_32BIT_WORD_LEN; >> + chan_sl = TDM_32BIT_SLOT_LEN; >> + dma_bus_width = DMA_SLAVE_BUSWIDTH_4_BYTES; >> + break; >> + >> + default: >> + dev_err(tdm->dev, "tdm: unsupported PCM fmt"); >> + return -EINVAL; >> + } >> + >> + chan_nr = params_channels(params); >> + switch (chan_nr) { >> + case 1: >> + case 2: >> + case 4: >> + case 6: >> + case 8: >> + break; >> + default: >> + dev_err(tdm->dev, "channel not supported\n"); >> + return -EINVAL; >> + } >> + >> + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { >> + tdm->tx.wl = chan_wl; >> + tdm->tx.sl = chan_sl; >> + tdm->tx.sscale = chan_nr; >> + tdm->play_dma_data.addr_width = dma_bus_width; >> + dma_data = &tdm->play_dma_data; >> + } else { >> + tdm->rx.wl = chan_wl; >> + tdm->rx.sl = chan_sl; >> + tdm->rx.sscale = chan_nr; >> + tdm->capture_dma_data.addr_width = dma_bus_width; >> + dma_data = &tdm->capture_dma_data; >> + } >> + >> + snd_soc_dai_set_dma_data(dai, substream, dma_data); >> + >> + ret = jh7110_tdm_config(tdm, substream); >> + if (ret) >> + return ret; >> + >> + jh7110_tdm_save_context(tdm, substream); >> + return 0; >> +} >> + >> +static int jh7110_tdm_trigger(struct snd_pcm_substream *substream, >> + int cmd, struct snd_soc_dai *dai) >> +{ >> + struct jh7110_tdm_dev *tdm = snd_soc_dai_get_drvdata(dai); >> + int ret = 0; >> + >> + switch (cmd) { >> + case SNDRV_PCM_TRIGGER_START: >> + case SNDRV_PCM_TRIGGER_RESUME: >> + case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: >> + jh7110_tdm_start(tdm, substream); >> + break; >> + >> + case SNDRV_PCM_TRIGGER_STOP: >> + case SNDRV_PCM_TRIGGER_SUSPEND: >> + case SNDRV_PCM_TRIGGER_PAUSE_PUSH: >> + jh7110_tdm_stop(tdm, substream); >> + break; >> + default: >> + ret = -EINVAL; >> + break; >> + } >> + return ret; >> +} >> + >> +static int jh7110_tdm_set_dai_fmt(struct snd_soc_dai *cpu_dai, >> + unsigned int fmt) >> +{ >> + struct jh7110_tdm_dev *tdm = snd_soc_dai_get_drvdata(cpu_dai); >> + unsigned int gbcr; >> + int ret = 0; >> + >> + /* set master/slave audio interface */ >> + switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) { >> + case SND_SOC_DAIFMT_BP_FP: >> + /* cpu is master */ >> + tdm->ms_mode = TDM_AS_MASTER; >> + break; >> + case SND_SOC_DAIFMT_BC_FC: >> + /* codec is master */ >> + tdm->ms_mode = TDM_AS_SLAVE; >> + break; >> + case SND_SOC_DAIFMT_BC_FP: >> + case SND_SOC_DAIFMT_BP_FC: >> + ret = -EINVAL; >> + break; >> + default: >> + dev_dbg(tdm->dev, "dwc : Invalid clock provider format\n"); >> + ret = -EINVAL; >> + break; >> + } >> + >> + gbcr = (tdm->clkpolity << CLKPOL_BIT) | >> + (tdm->elm << ELM_BIT) | >> + (tdm->syncm << SYNCM_BIT) | >> + (tdm->ms_mode << MS_BIT); >> + jh7110_tdm_writel(tdm, TDM_PCMGBCR, gbcr); >> + >> + return ret; >> +} >> + >> +static const struct snd_soc_dai_ops jh7110_tdm_dai_ops = { >> + .startup = jh7110_tdm_startup, >> + .hw_params = jh7110_tdm_hw_params, >> + .trigger = jh7110_tdm_trigger, >> + .set_fmt = jh7110_tdm_set_dai_fmt, >> +}; >> + >> +static int jh7110_tdm_dai_probe(struct snd_soc_dai *dai) >> +{ >> + struct jh7110_tdm_dev *tdm = snd_soc_dai_get_drvdata(dai); >> + >> + snd_soc_dai_init_dma_data(dai, &tdm->play_dma_data, &tdm->capture_dma_data); >> + snd_soc_dai_set_drvdata(dai, tdm); >> + return 0; >> +} >> + >> +#define JH7110_TDM_RATES SNDRV_PCM_RATE_8000_48000 >> + >> +#define JH7110_TDM_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | \ >> + SNDRV_PCM_FMTBIT_S32_LE) >> + >> +static struct snd_soc_dai_driver jh7110_tdm_dai = { >> + .name = "sf_tdm", >> + .id = 0, >> + .playback = { >> + .stream_name = "Playback", >> + .channels_min = 1, >> + .channels_max = 8, >> + .rates = JH7110_TDM_RATES, >> + .formats = JH7110_TDM_FORMATS, >> + }, >> + .capture = { >> + .stream_name = "Capture", >> + .channels_min = 1, >> + .channels_max = 8, >> + .rates = JH7110_TDM_RATES, >> + .formats = JH7110_TDM_FORMATS, >> + }, >> + .ops = &jh7110_tdm_dai_ops, >> + .probe = jh7110_tdm_dai_probe, >> + .symmetric_rate = 1, >> +}; >> + >> +static const struct snd_pcm_hardware jh7110_pcm_hardware = { >> + .info = (SNDRV_PCM_INFO_MMAP | >> + SNDRV_PCM_INFO_MMAP_VALID | >> + SNDRV_PCM_INFO_PAUSE | >> + SNDRV_PCM_INFO_RESUME | >> + SNDRV_PCM_INFO_INTERLEAVED | >> + SNDRV_PCM_INFO_BLOCK_TRANSFER), >> + .buffer_bytes_max = 192512, >> + .period_bytes_min = 4096, >> + .period_bytes_max = 32768, >> + .periods_min = 1, >> + .periods_max = 48, >> + .fifo_size = 16, >> +}; >> + >> +static const struct snd_dmaengine_pcm_config jh7110_dmaengine_pcm_config = { >> + .pcm_hardware = &jh7110_pcm_hardware, >> + .prepare_slave_config = snd_dmaengine_pcm_prepare_slave_config, >> + .prealloc_buffer_size = 192512, >> +}; >> + >> +static void jh7110_tdm_init_params(struct jh7110_tdm_dev *tdm) >> +{ >> + tdm->clkpolity = TDM_TX_RASING_RX_FALLING; >> + tdm->elm = TDM_ELM_LATE; >> + tdm->syncm = TDM_SYNCM_SHORT; >> + >> + tdm->rx.ifl = TDM_FIFO_HALF; >> + tdm->tx.ifl = TDM_FIFO_HALF; >> + tdm->rx.wl = TDM_16BIT_WORD_LEN; >> + tdm->tx.wl = TDM_16BIT_WORD_LEN; >> + tdm->rx.sscale = 2; >> + tdm->tx.sscale = 2; >> + tdm->rx.lrj = TDM_LEFT_JUSTIFT; >> + tdm->tx.lrj = TDM_LEFT_JUSTIFT; >> + >> + tdm->play_dma_data.addr = JH7110_TDM_FIFO; >> + tdm->play_dma_data.addr_width = DMA_SLAVE_BUSWIDTH_2_BYTES; >> + tdm->play_dma_data.fifo_size = JH7110_TDM_FIFO_DEPTH / 2; >> + tdm->play_dma_data.maxburst = 16; >> + >> + tdm->capture_dma_data.addr = JH7110_TDM_FIFO; >> + tdm->capture_dma_data.addr_width = DMA_SLAVE_BUSWIDTH_2_BYTES; >> + tdm->capture_dma_data.fifo_size = JH7110_TDM_FIFO_DEPTH / 2; >> + tdm->capture_dma_data.maxburst = 8; >> +} >> + >> +static int jh7110_tdm_clk_reset_init(struct platform_device *pdev, >> + struct jh7110_tdm_dev *tdm) >> +{ >> + int i, ret; >> + >> + for (i = 0; i < tdm->num_clks; i++) { >> + tdm->clks[i] = devm_clk_get(&pdev->dev, tdm->clk_names[i]); >> + if (IS_ERR(tdm->clks[i])) { >> + dev_err(&pdev->dev, "Failed to get clock: %s\n", >> + tdm->clk_names[i]); >> + return PTR_ERR(tdm->clks[i]); >> + } >> + } > > devm_clk_bulk_get() ? get/enable/disable clocks with 'devm_clk_bulk_' interface > >> + >> + tdm->resets = devm_reset_control_array_get_exclusive(&pdev->dev); >> + if (IS_ERR(tdm->resets)) { >> + ret = PTR_ERR(tdm->resets); >> + dev_err(&pdev->dev, "Failed to get tdm resets"); >> + return ret; >> + } >> + >> + return jh7110_tdm_clk_enable(tdm); >> +} >> + >> +static int jh7110_tdm_probe(struct platform_device *pdev) >> +{ >> + struct jh7110_tdm_dev *tdm; >> + const struct starfive_tdm_driverdata *driver_data; >> + int ret; >> + >> + tdm = devm_kzalloc(&pdev->dev, sizeof(*tdm), GFP_KERNEL); >> + if (!tdm) >> + return -ENOMEM; >> + >> + driver_data = of_device_get_match_data(&pdev->dev); >> + tdm->clk_names = (const char **)driver_data->clk_names; >> + tdm->num_clks = driver_data->num_clks; >> + >> + tdm->tdm_base = devm_platform_ioremap_resource(pdev, 0); >> + if (IS_ERR(tdm->tdm_base)) >> + return PTR_ERR(tdm->tdm_base); >> + >> + tdm->dev = &pdev->dev; >> + >> + ret = jh7110_tdm_clk_reset_init(pdev, tdm); >> + if (ret) { >> + dev_err(&pdev->dev, "Failed to enable audio-tdm clock\n"); >> + return ret; >> + } >> + >> + jh7110_tdm_init_params(tdm); >> + >> + dev_set_drvdata(&pdev->dev, tdm); >> + ret = devm_snd_soc_register_component(&pdev->dev, &jh7110_tdm_component, >> + &jh7110_tdm_dai, 1); >> + if (ret != 0) { > > if (ret) Will be fixed. > >> + dev_err(&pdev->dev, "Failed to register dai\n"); >> + return ret; >> + } >> + >> + ret = devm_snd_dmaengine_pcm_register(&pdev->dev, >> + &jh7110_dmaengine_pcm_config, >> + SND_DMAENGINE_PCM_FLAG_COMPAT); >> + if (ret) { >> + dev_err(&pdev->dev, "Could not register pcm: %d\n", ret); >> + return ret; >> + } >> + >> + pm_runtime_enable(&pdev->dev); >> +#ifdef CONFIG_PM >> + jh7110_tdm_clk_disable(tdm); >> +#endif >> + >> + return 0; >> +} >> + >> +static int jh7110_tdm_dev_remove(struct platform_device *pdev) >> +{ >> + pm_runtime_disable(&pdev->dev); >> + return 0; >> +} >> + >> +static const struct starfive_tdm_driverdata jh7110_drvdata = { >> + .clk_names = {"mclk_inner", "tdm_ahb", "tdm_apb", "tdm_internal", "tdm_ext", "tdm"}, >> + .num_clks = 6, >> +}; >> + >> +static const struct of_device_id jh7110_tdm_of_match[] = { >> + { .compatible = "starfive,jh7110-tdm", .data = &jh7110_drvdata }, >> + {} >> +}; >> + >> +MODULE_DEVICE_TABLE(of, jh7110_tdm_of_match); >> + >> +static const struct dev_pm_ops jh7110_tdm_pm_ops = { >> + SET_RUNTIME_PM_OPS(jh7110_tdm_runtime_suspend, >> + jh7110_tdm_runtime_resume, NULL) > > You can use RUNTIME_PM_OPS() and avoid having #ifdef CONFIG_PM around > jh7110_tdm_runtime_suspend and jh7110_tdm_runtime_resume definitions. I found that the definition of SET_RUNTIME_PM_OPS is based on RUNTIME_PM_OPS, so CONFIG_PM is not needed. Thank you very much for your detailed review and comments ! Best regards, Walker
diff --git a/MAINTAINERS b/MAINTAINERS index 5f9c544bc189..add89615d327 100644 --- a/MAINTAINERS +++ b/MAINTAINERS @@ -19945,6 +19945,12 @@ F: Documentation/devicetree/bindings/power/starfive* F: drivers/soc/starfive/jh71xx_pmu.c F: include/dt-bindings/power/starfive,jh7110-pmu.h +STARFIVE JH7110 TDM DRIVERS +M: Walker Chen <walker.chen@starfivetech.com> +S: Maintained +F: Documentation/devicetree/bindings/sound/starfive,jh7110-tdm.yaml +F: sound/soc/starfive/jh7110-tdm.* + STARFIVE SOC DRIVERS M: Conor Dooley <conor@kernel.org> S: Maintained diff --git a/sound/soc/Kconfig b/sound/soc/Kconfig index 848fbae26c3b..8d1d9401ecf2 100644 --- a/sound/soc/Kconfig +++ b/sound/soc/Kconfig @@ -91,6 +91,7 @@ source "sound/soc/sh/Kconfig" source "sound/soc/sof/Kconfig" source "sound/soc/spear/Kconfig" source "sound/soc/sprd/Kconfig" +source "sound/soc/starfive/Kconfig" source "sound/soc/sti/Kconfig" source "sound/soc/stm/Kconfig" source "sound/soc/sunxi/Kconfig" diff --git a/sound/soc/Makefile b/sound/soc/Makefile index 507eaed1d6a1..65aeb4ef4068 100644 --- a/sound/soc/Makefile +++ b/sound/soc/Makefile @@ -59,6 +59,7 @@ obj-$(CONFIG_SND_SOC) += sh/ obj-$(CONFIG_SND_SOC) += sof/ obj-$(CONFIG_SND_SOC) += spear/ obj-$(CONFIG_SND_SOC) += sprd/ +obj-$(CONFIG_SND_SOC) += starfive/ obj-$(CONFIG_SND_SOC) += sti/ obj-$(CONFIG_SND_SOC) += stm/ obj-$(CONFIG_SND_SOC) += sunxi/ diff --git a/sound/soc/starfive/Kconfig b/sound/soc/starfive/Kconfig new file mode 100644 index 000000000000..737c956f7b93 --- /dev/null +++ b/sound/soc/starfive/Kconfig @@ -0,0 +1,15 @@ +# SPDX-License-Identifier: GPL-2.0-only +config SND_SOC_STARFIVE + tristate "Audio support for StarFive SoC" + depends on COMPILE_TEST || SOC_STARFIVE + help + Say Y or M if you want to add support for codecs attached to + the Starfive SoCs' Audio interfaces. You will also need to + select the audio interfaces to support below. + +config SND_SOC_JH7110_TDM + tristate "JH7110 TDM device driver" + depends on HAVE_CLK && SND_SOC_STARFIVE + select SND_SOC_GENERIC_DMAENGINE_PCM + help + Say Y or M if you want to add support for StarFive TDM driver. diff --git a/sound/soc/starfive/Makefile b/sound/soc/starfive/Makefile new file mode 100644 index 000000000000..f7d960211d72 --- /dev/null +++ b/sound/soc/starfive/Makefile @@ -0,0 +1,2 @@ +# StarFive Platform Support +obj-$(CONFIG_SND_SOC_JH7110_TDM) += jh7110_tdm.o diff --git a/sound/soc/starfive/jh7110_tdm.c b/sound/soc/starfive/jh7110_tdm.c new file mode 100644 index 000000000000..33f7cf43e4bd --- /dev/null +++ b/sound/soc/starfive/jh7110_tdm.c @@ -0,0 +1,573 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * jh7110_tdm.c -- StarFive JH7110 TDM driver + * + * Copyright (C) 2022-2023 StarFive Technology Co., Ltd. + * + * Author: Walker Chen <walker.chen@starfivetech.com> + */ + +#include <linux/clk.h> +#include <linux/device.h> +#include <linux/module.h> +#include <linux/of_irq.h> +#include <linux/of_platform.h> +#include <linux/pm_runtime.h> +#include <linux/regmap.h> +#include <linux/reset.h> +#include <sound/initval.h> +#include <sound/pcm_params.h> +#include <sound/soc.h> +#include <sound/soc-dai.h> +#include "jh7110_tdm.h" + +static inline u32 jh7110_tdm_readl(struct jh7110_tdm_dev *tdm, u16 reg) +{ + return readl_relaxed(tdm->tdm_base + reg); +} + +static inline void jh7110_tdm_writel(struct jh7110_tdm_dev *tdm, u16 reg, u32 val) +{ + writel_relaxed(val, tdm->tdm_base + reg); +} + +static void jh7110_tdm_save_context(struct jh7110_tdm_dev *tdm, + struct snd_pcm_substream *substream) +{ + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) + tdm->saved_pcmtxcr = jh7110_tdm_readl(tdm, TDM_PCMTXCR); + else + tdm->saved_pcmrxcr = jh7110_tdm_readl(tdm, TDM_PCMRXCR); +} + +static void jh7110_tdm_start(struct jh7110_tdm_dev *tdm, + struct snd_pcm_substream *substream) +{ + u32 data; + + data = jh7110_tdm_readl(tdm, TDM_PCMGBCR); + jh7110_tdm_writel(tdm, TDM_PCMGBCR, data | PCMGBCR_ENABLE); + + /* restore context */ + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) + jh7110_tdm_writel(tdm, TDM_PCMTXCR, tdm->saved_pcmtxcr | PCMTXCR_TXEN); + else + jh7110_tdm_writel(tdm, TDM_PCMRXCR, tdm->saved_pcmrxcr | PCMRXCR_RXEN); +} + +static void jh7110_tdm_stop(struct jh7110_tdm_dev *tdm, + struct snd_pcm_substream *substream) +{ + unsigned int val; + + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { + val = jh7110_tdm_readl(tdm, TDM_PCMTXCR); + val &= ~PCMTXCR_TXEN; + jh7110_tdm_writel(tdm, TDM_PCMTXCR, val); + } else { + val = jh7110_tdm_readl(tdm, TDM_PCMRXCR); + val &= ~PCMRXCR_RXEN; + jh7110_tdm_writel(tdm, TDM_PCMRXCR, val); + } +} + +static int jh7110_tdm_syncdiv(struct jh7110_tdm_dev *tdm) +{ + u32 sl, sscale, syncdiv; + + if (tdm->rx.sl >= tdm->tx.sl) + sl = tdm->rx.sl; + else + sl = tdm->tx.sl; + + if (tdm->rx.sscale >= tdm->tx.sscale) + sscale = tdm->rx.sscale; + else + sscale = tdm->tx.sscale; + + syncdiv = tdm->pcmclk / tdm->samplerate - 1; + + if ((syncdiv + 1) < (sl * sscale)) { + dev_err(tdm->dev, "Failed to set syncdiv!\n"); + return -EINVAL; + } + + if (tdm->syncm == TDM_SYNCM_LONG && + (tdm->rx.sscale <= 1 || tdm->tx.sscale <= 1)) { + if ((syncdiv + 1) <= sl) { + dev_err(tdm->dev, "Wrong syncdiv! It must be (syncdiv+1) > max[tx.sl, rx.sl]\n"); + return -EINVAL; + } + } + + jh7110_tdm_writel(tdm, TDM_PCMDIV, syncdiv); + return 0; +} + +static int jh7110_tdm_config(struct jh7110_tdm_dev *tdm, + struct snd_pcm_substream *substream) +{ + u32 datarx, datatx; + int ret; + + ret = jh7110_tdm_syncdiv(tdm); + if (ret) + return ret; + + datarx = (tdm->rx.ifl << IFL_BIT) | + (tdm->rx.wl << WL_BIT) | + (tdm->rx.sscale << SSCALE_BIT) | + (tdm->rx.sl << SL_BIT) | + (tdm->rx.lrj << LRJ_BIT); + + datatx = (tdm->tx.ifl << IFL_BIT) | + (tdm->tx.wl << WL_BIT) | + (tdm->tx.sscale << SSCALE_BIT) | + (tdm->tx.sl << SL_BIT) | + (tdm->tx.lrj << LRJ_BIT); + + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) + jh7110_tdm_writel(tdm, TDM_PCMTXCR, datatx); + else + jh7110_tdm_writel(tdm, TDM_PCMRXCR, datarx); + + return 0; +} + +static void jh7110_tdm_clk_disable(struct jh7110_tdm_dev *tdm) +{ + int i; + + for (i = tdm->num_clks - 1; i >= 0; i--) + clk_disable_unprepare(tdm->clks[i]); +} + +static int jh7110_tdm_clk_enable(struct jh7110_tdm_dev *tdm) +{ + int i, ret; + + for (i = 0; i < tdm->num_clks; i++) { + ret = clk_prepare_enable(tdm->clks[i]); + if (ret) { + while (i-- > 0) + clk_disable_unprepare(tdm->clks[i]); + return ret; + } + } + + ret = reset_control_deassert(tdm->resets); + if (ret) { + dev_err(tdm->dev, "Failed to deassert tdm resets\n"); + goto dis_tdm_clk; + } + + /* select tdm_ext clock as the clock source for tdm */ + ret = clk_set_parent(tdm->clks[5], tdm->clks[4]); + if (ret) { + dev_err(tdm->dev, "Can't set clock source for clk_tdm: %d\n", ret); + goto dis_tdm_clk; + } + return 0; + +dis_tdm_clk: + for (i = tdm->num_clks - 1; i >= 0; i--) + clk_disable_unprepare(tdm->clks[i]); + + return ret; +} + +#ifdef CONFIG_PM +static int jh7110_tdm_runtime_suspend(struct device *dev) +{ + struct jh7110_tdm_dev *tdm = dev_get_drvdata(dev); + + jh7110_tdm_clk_disable(tdm); + return 0; +} + +static int jh7110_tdm_runtime_resume(struct device *dev) +{ + struct jh7110_tdm_dev *tdm = dev_get_drvdata(dev); + + return jh7110_tdm_clk_enable(tdm); +} +#endif + +#ifdef CONFIG_PM_SLEEP +static int jh7110_tdm_suspend(struct snd_soc_component *component) +{ + /* save context */ + tdm->saved_pcmgbcr = jh7110_tdm_readl(tdm, TDM_PCMGBCR); + tdm->saved_pcmdiv = jh7110_tdm_readl(tdm, TDM_PCMDIV); + + return pm_runtime_force_suspend(component->dev); +} + +static int jh7110_tdm_resume(struct snd_soc_component *component) +{ + struct jh7110_tdm_dev *tdm = snd_soc_component_get_drvdata(component); + + /* restore context */ + jh7110_tdm_writel(tdm, TDM_PCMGBCR, tdm->saved_pcmgbcr); + jh7110_tdm_writel(tdm, TDM_PCMDIV, tdm->saved_pcmdiv); + + return pm_runtime_force_resume(component->dev); +} + +#else +#define jh7110_tdm_suspend NULL +#define jh7110_tdm_resume NULL +#endif + +static const struct snd_soc_component_driver jh7110_tdm_component = { + .name = "jh7110-tdm", + .suspend = jh7110_tdm_suspend, + .resume = jh7110_tdm_resume, +}; + +static int jh7110_tdm_startup(struct snd_pcm_substream *substream, + struct snd_soc_dai *cpu_dai) +{ + struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); + struct snd_soc_dai_link *dai_link = rtd->dai_link; + + dai_link->stop_dma_first = 1; + + return 0; +} + +static int jh7110_tdm_hw_params(struct snd_pcm_substream *substream, + struct snd_pcm_hw_params *params, + struct snd_soc_dai *dai) +{ + struct jh7110_tdm_dev *tdm = snd_soc_dai_get_drvdata(dai); + int chan_wl, chan_sl, chan_nr; + unsigned int data_width; + unsigned int dma_bus_width; + struct snd_dmaengine_dai_dma_data *dma_data = NULL; + int ret = 0; + + data_width = params_width(params); + + tdm->samplerate = params_rate(params); + tdm->pcmclk = params_channels(params) * tdm->samplerate * data_width; + + switch (params_format(params)) { + case SNDRV_PCM_FORMAT_S16_LE: + chan_wl = TDM_16BIT_WORD_LEN; + chan_sl = TDM_16BIT_SLOT_LEN; + dma_bus_width = DMA_SLAVE_BUSWIDTH_2_BYTES; + break; + + case SNDRV_PCM_FORMAT_S32_LE: + chan_wl = TDM_32BIT_WORD_LEN; + chan_sl = TDM_32BIT_SLOT_LEN; + dma_bus_width = DMA_SLAVE_BUSWIDTH_4_BYTES; + break; + + default: + dev_err(tdm->dev, "tdm: unsupported PCM fmt"); + return -EINVAL; + } + + chan_nr = params_channels(params); + switch (chan_nr) { + case 1: + case 2: + case 4: + case 6: + case 8: + break; + default: + dev_err(tdm->dev, "channel not supported\n"); + return -EINVAL; + } + + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { + tdm->tx.wl = chan_wl; + tdm->tx.sl = chan_sl; + tdm->tx.sscale = chan_nr; + tdm->play_dma_data.addr_width = dma_bus_width; + dma_data = &tdm->play_dma_data; + } else { + tdm->rx.wl = chan_wl; + tdm->rx.sl = chan_sl; + tdm->rx.sscale = chan_nr; + tdm->capture_dma_data.addr_width = dma_bus_width; + dma_data = &tdm->capture_dma_data; + } + + snd_soc_dai_set_dma_data(dai, substream, dma_data); + + ret = jh7110_tdm_config(tdm, substream); + if (ret) + return ret; + + jh7110_tdm_save_context(tdm, substream); + return 0; +} + +static int jh7110_tdm_trigger(struct snd_pcm_substream *substream, + int cmd, struct snd_soc_dai *dai) +{ + struct jh7110_tdm_dev *tdm = snd_soc_dai_get_drvdata(dai); + int ret = 0; + + switch (cmd) { + case SNDRV_PCM_TRIGGER_START: + case SNDRV_PCM_TRIGGER_RESUME: + case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: + jh7110_tdm_start(tdm, substream); + break; + + case SNDRV_PCM_TRIGGER_STOP: + case SNDRV_PCM_TRIGGER_SUSPEND: + case SNDRV_PCM_TRIGGER_PAUSE_PUSH: + jh7110_tdm_stop(tdm, substream); + break; + default: + ret = -EINVAL; + break; + } + return ret; +} + +static int jh7110_tdm_set_dai_fmt(struct snd_soc_dai *cpu_dai, + unsigned int fmt) +{ + struct jh7110_tdm_dev *tdm = snd_soc_dai_get_drvdata(cpu_dai); + unsigned int gbcr; + int ret = 0; + + /* set master/slave audio interface */ + switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) { + case SND_SOC_DAIFMT_BP_FP: + /* cpu is master */ + tdm->ms_mode = TDM_AS_MASTER; + break; + case SND_SOC_DAIFMT_BC_FC: + /* codec is master */ + tdm->ms_mode = TDM_AS_SLAVE; + break; + case SND_SOC_DAIFMT_BC_FP: + case SND_SOC_DAIFMT_BP_FC: + ret = -EINVAL; + break; + default: + dev_dbg(tdm->dev, "dwc : Invalid clock provider format\n"); + ret = -EINVAL; + break; + } + + gbcr = (tdm->clkpolity << CLKPOL_BIT) | + (tdm->elm << ELM_BIT) | + (tdm->syncm << SYNCM_BIT) | + (tdm->ms_mode << MS_BIT); + jh7110_tdm_writel(tdm, TDM_PCMGBCR, gbcr); + + return ret; +} + +static const struct snd_soc_dai_ops jh7110_tdm_dai_ops = { + .startup = jh7110_tdm_startup, + .hw_params = jh7110_tdm_hw_params, + .trigger = jh7110_tdm_trigger, + .set_fmt = jh7110_tdm_set_dai_fmt, +}; + +static int jh7110_tdm_dai_probe(struct snd_soc_dai *dai) +{ + struct jh7110_tdm_dev *tdm = snd_soc_dai_get_drvdata(dai); + + snd_soc_dai_init_dma_data(dai, &tdm->play_dma_data, &tdm->capture_dma_data); + snd_soc_dai_set_drvdata(dai, tdm); + return 0; +} + +#define JH7110_TDM_RATES SNDRV_PCM_RATE_8000_48000 + +#define JH7110_TDM_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | \ + SNDRV_PCM_FMTBIT_S32_LE) + +static struct snd_soc_dai_driver jh7110_tdm_dai = { + .name = "sf_tdm", + .id = 0, + .playback = { + .stream_name = "Playback", + .channels_min = 1, + .channels_max = 8, + .rates = JH7110_TDM_RATES, + .formats = JH7110_TDM_FORMATS, + }, + .capture = { + .stream_name = "Capture", + .channels_min = 1, + .channels_max = 8, + .rates = JH7110_TDM_RATES, + .formats = JH7110_TDM_FORMATS, + }, + .ops = &jh7110_tdm_dai_ops, + .probe = jh7110_tdm_dai_probe, + .symmetric_rate = 1, +}; + +static const struct snd_pcm_hardware jh7110_pcm_hardware = { + .info = (SNDRV_PCM_INFO_MMAP | + SNDRV_PCM_INFO_MMAP_VALID | + SNDRV_PCM_INFO_PAUSE | + SNDRV_PCM_INFO_RESUME | + SNDRV_PCM_INFO_INTERLEAVED | + SNDRV_PCM_INFO_BLOCK_TRANSFER), + .buffer_bytes_max = 192512, + .period_bytes_min = 4096, + .period_bytes_max = 32768, + .periods_min = 1, + .periods_max = 48, + .fifo_size = 16, +}; + +static const struct snd_dmaengine_pcm_config jh7110_dmaengine_pcm_config = { + .pcm_hardware = &jh7110_pcm_hardware, + .prepare_slave_config = snd_dmaengine_pcm_prepare_slave_config, + .prealloc_buffer_size = 192512, +}; + +static void jh7110_tdm_init_params(struct jh7110_tdm_dev *tdm) +{ + tdm->clkpolity = TDM_TX_RASING_RX_FALLING; + tdm->elm = TDM_ELM_LATE; + tdm->syncm = TDM_SYNCM_SHORT; + + tdm->rx.ifl = TDM_FIFO_HALF; + tdm->tx.ifl = TDM_FIFO_HALF; + tdm->rx.wl = TDM_16BIT_WORD_LEN; + tdm->tx.wl = TDM_16BIT_WORD_LEN; + tdm->rx.sscale = 2; + tdm->tx.sscale = 2; + tdm->rx.lrj = TDM_LEFT_JUSTIFT; + tdm->tx.lrj = TDM_LEFT_JUSTIFT; + + tdm->play_dma_data.addr = JH7110_TDM_FIFO; + tdm->play_dma_data.addr_width = DMA_SLAVE_BUSWIDTH_2_BYTES; + tdm->play_dma_data.fifo_size = JH7110_TDM_FIFO_DEPTH / 2; + tdm->play_dma_data.maxburst = 16; + + tdm->capture_dma_data.addr = JH7110_TDM_FIFO; + tdm->capture_dma_data.addr_width = DMA_SLAVE_BUSWIDTH_2_BYTES; + tdm->capture_dma_data.fifo_size = JH7110_TDM_FIFO_DEPTH / 2; + tdm->capture_dma_data.maxburst = 8; +} + +static int jh7110_tdm_clk_reset_init(struct platform_device *pdev, + struct jh7110_tdm_dev *tdm) +{ + int i, ret; + + for (i = 0; i < tdm->num_clks; i++) { + tdm->clks[i] = devm_clk_get(&pdev->dev, tdm->clk_names[i]); + if (IS_ERR(tdm->clks[i])) { + dev_err(&pdev->dev, "Failed to get clock: %s\n", + tdm->clk_names[i]); + return PTR_ERR(tdm->clks[i]); + } + } + + tdm->resets = devm_reset_control_array_get_exclusive(&pdev->dev); + if (IS_ERR(tdm->resets)) { + ret = PTR_ERR(tdm->resets); + dev_err(&pdev->dev, "Failed to get tdm resets"); + return ret; + } + + return jh7110_tdm_clk_enable(tdm); +} + +static int jh7110_tdm_probe(struct platform_device *pdev) +{ + struct jh7110_tdm_dev *tdm; + const struct starfive_tdm_driverdata *driver_data; + int ret; + + tdm = devm_kzalloc(&pdev->dev, sizeof(*tdm), GFP_KERNEL); + if (!tdm) + return -ENOMEM; + + driver_data = of_device_get_match_data(&pdev->dev); + tdm->clk_names = (const char **)driver_data->clk_names; + tdm->num_clks = driver_data->num_clks; + + tdm->tdm_base = devm_platform_ioremap_resource(pdev, 0); + if (IS_ERR(tdm->tdm_base)) + return PTR_ERR(tdm->tdm_base); + + tdm->dev = &pdev->dev; + + ret = jh7110_tdm_clk_reset_init(pdev, tdm); + if (ret) { + dev_err(&pdev->dev, "Failed to enable audio-tdm clock\n"); + return ret; + } + + jh7110_tdm_init_params(tdm); + + dev_set_drvdata(&pdev->dev, tdm); + ret = devm_snd_soc_register_component(&pdev->dev, &jh7110_tdm_component, + &jh7110_tdm_dai, 1); + if (ret != 0) { + dev_err(&pdev->dev, "Failed to register dai\n"); + return ret; + } + + ret = devm_snd_dmaengine_pcm_register(&pdev->dev, + &jh7110_dmaengine_pcm_config, + SND_DMAENGINE_PCM_FLAG_COMPAT); + if (ret) { + dev_err(&pdev->dev, "Could not register pcm: %d\n", ret); + return ret; + } + + pm_runtime_enable(&pdev->dev); +#ifdef CONFIG_PM + jh7110_tdm_clk_disable(tdm); +#endif + + return 0; +} + +static int jh7110_tdm_dev_remove(struct platform_device *pdev) +{ + pm_runtime_disable(&pdev->dev); + return 0; +} + +static const struct starfive_tdm_driverdata jh7110_drvdata = { + .clk_names = {"mclk_inner", "tdm_ahb", "tdm_apb", "tdm_internal", "tdm_ext", "tdm"}, + .num_clks = 6, +}; + +static const struct of_device_id jh7110_tdm_of_match[] = { + { .compatible = "starfive,jh7110-tdm", .data = &jh7110_drvdata }, + {} +}; + +MODULE_DEVICE_TABLE(of, jh7110_tdm_of_match); + +static const struct dev_pm_ops jh7110_tdm_pm_ops = { + SET_RUNTIME_PM_OPS(jh7110_tdm_runtime_suspend, + jh7110_tdm_runtime_resume, NULL) +}; + +static struct platform_driver jh7110_tdm_driver = { + .driver = { + .name = "jh7110-tdm", + .of_match_table = jh7110_tdm_of_match, + .pm = &jh7110_tdm_pm_ops, + }, + .probe = jh7110_tdm_probe, + .remove = jh7110_tdm_dev_remove, +}; +module_platform_driver(jh7110_tdm_driver); + +MODULE_DESCRIPTION("StarFive JH7110 TDM ASoC Driver"); +MODULE_AUTHOR("Walker Chen <walker.chen@starfivetech.com>"); +MODULE_LICENSE("GPL"); diff --git a/sound/soc/starfive/jh7110_tdm.h b/sound/soc/starfive/jh7110_tdm.h new file mode 100644 index 000000000000..80f17946a45d --- /dev/null +++ b/sound/soc/starfive/jh7110_tdm.h @@ -0,0 +1,147 @@ +/* SPDX-License-Identifier: GPL-2.0 + * + * TDM driver for the StarFive JH7110 SoC + * + * Copyright (C) 2022-2023 StarFive Technology Co., Ltd. + * + * Author: Walker Chen <walker.chen@starfivetech.com> + */ + +#ifndef __SND_SOC_STARFIVE_TDM_H +#define __SND_SOC_STARFIVE_TDM_H + +#include <linux/clk.h> +#include <linux/device.h> +#include <linux/types.h> +#include <sound/dmaengine_pcm.h> +#include <sound/pcm.h> +#include <linux/dmaengine.h> +#include <linux/types.h> + +#define TDM_PCMGBCR 0x00 + #define PCMGBCR_MASK 0x1e + #define PCMGBCR_ENABLE BIT(0) + #define PCMGBCR_TRITXEN BIT(4) + #define CLKPOL_BIT 5 + #define TRITXEN_BIT 4 + #define ELM_BIT 3 + #define SYNCM_BIT 2 + #define MS_BIT 1 +#define TDM_PCMTXCR 0x04 + #define PCMTXCR_TXEN BIT(0) + #define IFL_BIT 11 + #define WL_BIT 8 + #define SSCALE_BIT 4 + #define SL_BIT 2 + #define LRJ_BIT 1 +#define TDM_PCMRXCR 0x08 + #define PCMRXCR_RXEN BIT(0) + #define PCMRXCR_RXSL_MASK 0xc + #define PCMRXCR_RXSL_16BIT 0x4 + #define PCMRXCR_RXSL_32BIT 0x8 + #define PCMRXCR_SCALE_MASK 0xf0 + #define PCMRXCR_SCALE_1CH 0x10 +#define TDM_PCMDIV 0x0c + +/* DMA registers */ +#define JH7110_TDM_FIFO 0x170c0000 +#define JH7110_TDM_FIFO_DEPTH 32 +#define JH7110_TDM_MAX_CLOCKS 6 + +enum TDM_MASTER_SLAVE_MODE { + TDM_AS_MASTER = 0, + TDM_AS_SLAVE, +}; + +enum TDM_CLKPOL { + /* tx raising and rx falling */ + TDM_TX_RASING_RX_FALLING = 0, + /* tx falling and rx raising */ + TDM_TX_FALLING_RX_RASING, +}; + +enum TDM_ELM { + /* only work while SYNCM=0 */ + TDM_ELM_LATE = 0, + TDM_ELM_EARLY, +}; + +enum TDM_SYNCM { + /* short frame sync */ + TDM_SYNCM_SHORT = 0, + /* long frame sync */ + TDM_SYNCM_LONG, +}; + +enum TDM_IFL { + /* FIFO to send or received : half-1/2, Quarter-1/4 */ + TDM_FIFO_HALF = 0, + TDM_FIFO_QUARTER, +}; + +enum TDM_WL { + /* send or received word length */ + TDM_8BIT_WORD_LEN = 0, + TDM_16BIT_WORD_LEN, + TDM_20BIT_WORD_LEN, + TDM_24BIT_WORD_LEN, + TDM_32BIT_WORD_LEN, +}; + +enum TDM_SL { + /* send or received slot length */ + TDM_8BIT_SLOT_LEN = 0, + TDM_16BIT_SLOT_LEN, + TDM_32BIT_SLOT_LEN, +}; + +enum TDM_LRJ { + /* left-justify or right-justify */ + TDM_RIGHT_JUSTIFY = 0, + TDM_LEFT_JUSTIFT, +}; + +struct tdm_chan_cfg { + enum TDM_IFL ifl; + enum TDM_WL wl; + unsigned char sscale; + enum TDM_SL sl; + enum TDM_LRJ lrj; + unsigned char enable; +}; + +struct starfive_tdm_driverdata { + const char *clk_names[JH7110_TDM_MAX_CLOCKS]; + int num_clks; +}; + +struct jh7110_tdm_dev { + void __iomem *tdm_base; + struct device *dev; + const char **clk_names; + struct clk *clks[JH7110_TDM_MAX_CLOCKS]; + int num_clks; + struct reset_control *resets; + + enum TDM_CLKPOL clkpolity; + enum TDM_ELM elm; + enum TDM_SYNCM syncm; + enum TDM_MASTER_SLAVE_MODE ms_mode; + + struct tdm_chan_cfg tx; + struct tdm_chan_cfg rx; + + u16 syncdiv; + u32 samplerate; + u32 pcmclk; + + /* data related to DMA transfers b/w tdm and DMAC */ + struct snd_dmaengine_dai_dma_data play_dma_data; + struct snd_dmaengine_dai_dma_data capture_dma_data; + u32 saved_pcmgbcr; + u32 saved_pcmtxcr; + u32 saved_pcmrxcr; + u32 saved_pcmdiv; +}; + +#endif /* __SND_SOC_STARFIVE_TDM_H */
Add tdm driver support for the StarFive JH7110 SoC. Signed-off-by: Walker Chen <walker.chen@starfivetech.com> --- MAINTAINERS | 6 + sound/soc/Kconfig | 1 + sound/soc/Makefile | 1 + sound/soc/starfive/Kconfig | 15 + sound/soc/starfive/Makefile | 2 + sound/soc/starfive/jh7110_tdm.c | 573 ++++++++++++++++++++++++++++++++ sound/soc/starfive/jh7110_tdm.h | 147 ++++++++ 7 files changed, 745 insertions(+) create mode 100644 sound/soc/starfive/Kconfig create mode 100644 sound/soc/starfive/Makefile create mode 100644 sound/soc/starfive/jh7110_tdm.c create mode 100644 sound/soc/starfive/jh7110_tdm.h