155da0948SArnaud Pouliquen // SPDX-License-Identifier: GPL-2.0
255da0948SArnaud Pouliquen /*
355da0948SArnaud Pouliquen * This file is part of STM32 DFSDM ASoC DAI driver
455da0948SArnaud Pouliquen *
555da0948SArnaud Pouliquen * Copyright (C) 2017, STMicroelectronics - All Rights Reserved
655da0948SArnaud Pouliquen * Authors: Arnaud Pouliquen <arnaud.pouliquen@st.com>
755da0948SArnaud Pouliquen * Olivier Moysan <olivier.moysan@st.com>
855da0948SArnaud Pouliquen */
955da0948SArnaud Pouliquen
1055da0948SArnaud Pouliquen #include <linux/clk.h>
1155da0948SArnaud Pouliquen #include <linux/module.h>
1219441e35SOlivier Moysan #include <linux/mutex.h>
1355da0948SArnaud Pouliquen #include <linux/platform_device.h>
1455da0948SArnaud Pouliquen #include <linux/slab.h>
1598e500a1SOlivier Moysan #include <linux/pm_runtime.h>
1655da0948SArnaud Pouliquen #include <linux/iio/iio.h>
1755da0948SArnaud Pouliquen #include <linux/iio/consumer.h>
1855da0948SArnaud Pouliquen #include <linux/iio/adc/stm32-dfsdm-adc.h>
1955da0948SArnaud Pouliquen
2055da0948SArnaud Pouliquen #include <sound/pcm.h>
2155da0948SArnaud Pouliquen #include <sound/soc.h>
2255da0948SArnaud Pouliquen
2355da0948SArnaud Pouliquen #define STM32_ADFSDM_DRV_NAME "stm32-adfsdm"
2455da0948SArnaud Pouliquen
2555da0948SArnaud Pouliquen #define DFSDM_MAX_PERIOD_SIZE (PAGE_SIZE / 2)
2655da0948SArnaud Pouliquen #define DFSDM_MAX_PERIODS 6
2755da0948SArnaud Pouliquen
2855da0948SArnaud Pouliquen struct stm32_adfsdm_priv {
2955da0948SArnaud Pouliquen struct snd_soc_dai_driver dai_drv;
3055da0948SArnaud Pouliquen struct snd_pcm_substream *substream;
3155da0948SArnaud Pouliquen struct device *dev;
3255da0948SArnaud Pouliquen
3355da0948SArnaud Pouliquen /* IIO */
3455da0948SArnaud Pouliquen struct iio_channel *iio_ch;
3555da0948SArnaud Pouliquen struct iio_cb_buffer *iio_cb;
3655da0948SArnaud Pouliquen bool iio_active;
3755da0948SArnaud Pouliquen
3855da0948SArnaud Pouliquen /* PCM buffer */
3955da0948SArnaud Pouliquen unsigned char *pcm_buff;
4055da0948SArnaud Pouliquen unsigned int pos;
4119441e35SOlivier Moysan
4219441e35SOlivier Moysan struct mutex lock; /* protect against race condition on iio state */
4355da0948SArnaud Pouliquen };
4455da0948SArnaud Pouliquen
4555da0948SArnaud Pouliquen static const struct snd_pcm_hardware stm32_adfsdm_pcm_hw = {
4655da0948SArnaud Pouliquen .info = SNDRV_PCM_INFO_INTERLEAVED | SNDRV_PCM_INFO_BLOCK_TRANSFER |
47d151cf89SOlivier Moysan SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_PAUSE,
481e7f6e1cSOlivier Moysan .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S32_LE,
4955da0948SArnaud Pouliquen
5055da0948SArnaud Pouliquen .channels_min = 1,
5155da0948SArnaud Pouliquen .channels_max = 1,
5255da0948SArnaud Pouliquen
5355da0948SArnaud Pouliquen .periods_min = 2,
5455da0948SArnaud Pouliquen .periods_max = DFSDM_MAX_PERIODS,
5555da0948SArnaud Pouliquen
5655da0948SArnaud Pouliquen .period_bytes_max = DFSDM_MAX_PERIOD_SIZE,
5755da0948SArnaud Pouliquen .buffer_bytes_max = DFSDM_MAX_PERIODS * DFSDM_MAX_PERIOD_SIZE
5855da0948SArnaud Pouliquen };
5955da0948SArnaud Pouliquen
stm32_adfsdm_shutdown(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)6055da0948SArnaud Pouliquen static void stm32_adfsdm_shutdown(struct snd_pcm_substream *substream,
6155da0948SArnaud Pouliquen struct snd_soc_dai *dai)
6255da0948SArnaud Pouliquen {
6355da0948SArnaud Pouliquen struct stm32_adfsdm_priv *priv = snd_soc_dai_get_drvdata(dai);
6455da0948SArnaud Pouliquen
6519441e35SOlivier Moysan mutex_lock(&priv->lock);
6655da0948SArnaud Pouliquen if (priv->iio_active) {
6755da0948SArnaud Pouliquen iio_channel_stop_all_cb(priv->iio_cb);
6855da0948SArnaud Pouliquen priv->iio_active = false;
6955da0948SArnaud Pouliquen }
7019441e35SOlivier Moysan mutex_unlock(&priv->lock);
7155da0948SArnaud Pouliquen }
7255da0948SArnaud Pouliquen
stm32_adfsdm_dai_prepare(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)7355da0948SArnaud Pouliquen static int stm32_adfsdm_dai_prepare(struct snd_pcm_substream *substream,
7455da0948SArnaud Pouliquen struct snd_soc_dai *dai)
7555da0948SArnaud Pouliquen {
7655da0948SArnaud Pouliquen struct stm32_adfsdm_priv *priv = snd_soc_dai_get_drvdata(dai);
7755da0948SArnaud Pouliquen int ret;
7855da0948SArnaud Pouliquen
7919441e35SOlivier Moysan mutex_lock(&priv->lock);
8019441e35SOlivier Moysan if (priv->iio_active) {
8119441e35SOlivier Moysan iio_channel_stop_all_cb(priv->iio_cb);
8219441e35SOlivier Moysan priv->iio_active = false;
8319441e35SOlivier Moysan }
8419441e35SOlivier Moysan
8555da0948SArnaud Pouliquen ret = iio_write_channel_attribute(priv->iio_ch,
8655da0948SArnaud Pouliquen substream->runtime->rate, 0,
8755da0948SArnaud Pouliquen IIO_CHAN_INFO_SAMP_FREQ);
8855da0948SArnaud Pouliquen if (ret < 0) {
8955da0948SArnaud Pouliquen dev_err(dai->dev, "%s: Failed to set %d sampling rate\n",
9055da0948SArnaud Pouliquen __func__, substream->runtime->rate);
9119441e35SOlivier Moysan goto out;
9255da0948SArnaud Pouliquen }
9355da0948SArnaud Pouliquen
9455da0948SArnaud Pouliquen if (!priv->iio_active) {
9555da0948SArnaud Pouliquen ret = iio_channel_start_all_cb(priv->iio_cb);
9655da0948SArnaud Pouliquen if (!ret)
9755da0948SArnaud Pouliquen priv->iio_active = true;
9855da0948SArnaud Pouliquen else
9955da0948SArnaud Pouliquen dev_err(dai->dev, "%s: IIO channel start failed (%d)\n",
10055da0948SArnaud Pouliquen __func__, ret);
10155da0948SArnaud Pouliquen }
10255da0948SArnaud Pouliquen
10319441e35SOlivier Moysan out:
10419441e35SOlivier Moysan mutex_unlock(&priv->lock);
10519441e35SOlivier Moysan
10655da0948SArnaud Pouliquen return ret;
10755da0948SArnaud Pouliquen }
10855da0948SArnaud Pouliquen
stm32_adfsdm_set_sysclk(struct snd_soc_dai * dai,int clk_id,unsigned int freq,int dir)10955da0948SArnaud Pouliquen static int stm32_adfsdm_set_sysclk(struct snd_soc_dai *dai, int clk_id,
11055da0948SArnaud Pouliquen unsigned int freq, int dir)
11155da0948SArnaud Pouliquen {
11255da0948SArnaud Pouliquen struct stm32_adfsdm_priv *priv = snd_soc_dai_get_drvdata(dai);
11355da0948SArnaud Pouliquen ssize_t size;
11455da0948SArnaud Pouliquen char str_freq[10];
11555da0948SArnaud Pouliquen
11655da0948SArnaud Pouliquen dev_dbg(dai->dev, "%s: Enter for freq %d\n", __func__, freq);
11755da0948SArnaud Pouliquen
11855da0948SArnaud Pouliquen /* Set IIO frequency if CODEC is master as clock comes from SPI_IN */
11955da0948SArnaud Pouliquen
12011033e51SPierre-Louis Bossart snprintf(str_freq, sizeof(str_freq), "%u\n", freq);
12155da0948SArnaud Pouliquen size = iio_write_channel_ext_info(priv->iio_ch, "spi_clk_freq",
12255da0948SArnaud Pouliquen str_freq, sizeof(str_freq));
12355da0948SArnaud Pouliquen if (size != sizeof(str_freq)) {
12455da0948SArnaud Pouliquen dev_err(dai->dev, "%s: Failed to set SPI clock\n",
12555da0948SArnaud Pouliquen __func__);
12655da0948SArnaud Pouliquen return -EINVAL;
12755da0948SArnaud Pouliquen }
12855da0948SArnaud Pouliquen return 0;
12955da0948SArnaud Pouliquen }
13055da0948SArnaud Pouliquen
13155da0948SArnaud Pouliquen static const struct snd_soc_dai_ops stm32_adfsdm_dai_ops = {
13255da0948SArnaud Pouliquen .shutdown = stm32_adfsdm_shutdown,
13355da0948SArnaud Pouliquen .prepare = stm32_adfsdm_dai_prepare,
13455da0948SArnaud Pouliquen .set_sysclk = stm32_adfsdm_set_sysclk,
13555da0948SArnaud Pouliquen };
13655da0948SArnaud Pouliquen
13755da0948SArnaud Pouliquen static const struct snd_soc_dai_driver stm32_adfsdm_dai = {
13855da0948SArnaud Pouliquen .capture = {
13955da0948SArnaud Pouliquen .channels_min = 1,
14055da0948SArnaud Pouliquen .channels_max = 1,
1411e7f6e1cSOlivier Moysan .formats = SNDRV_PCM_FMTBIT_S16_LE |
1421e7f6e1cSOlivier Moysan SNDRV_PCM_FMTBIT_S32_LE,
1436101bf71SOlivier Moysan .rates = SNDRV_PCM_RATE_CONTINUOUS,
1446101bf71SOlivier Moysan .rate_min = 8000,
1456101bf71SOlivier Moysan .rate_max = 48000,
14655da0948SArnaud Pouliquen },
14755da0948SArnaud Pouliquen .ops = &stm32_adfsdm_dai_ops,
14855da0948SArnaud Pouliquen };
14955da0948SArnaud Pouliquen
15055da0948SArnaud Pouliquen static const struct snd_soc_component_driver stm32_adfsdm_dai_component = {
15155da0948SArnaud Pouliquen .name = "stm32_dfsdm_audio",
15236f07985SCharles Keepax .legacy_dai_naming = 1,
15355da0948SArnaud Pouliquen };
15455da0948SArnaud Pouliquen
stm32_memcpy_32to16(void * dest,const void * src,size_t n)1558e55ea19SOlivier Moysan static void stm32_memcpy_32to16(void *dest, const void *src, size_t n)
1561e7f6e1cSOlivier Moysan {
1571e7f6e1cSOlivier Moysan unsigned int i = 0;
1581e7f6e1cSOlivier Moysan u16 *d = (u16 *)dest, *s = (u16 *)src;
1591e7f6e1cSOlivier Moysan
1601e7f6e1cSOlivier Moysan s++;
1618e55ea19SOlivier Moysan for (i = n >> 1; i > 0; i--) {
1621e7f6e1cSOlivier Moysan *d++ = *s++;
1631e7f6e1cSOlivier Moysan s++;
1641e7f6e1cSOlivier Moysan }
1651e7f6e1cSOlivier Moysan }
1661e7f6e1cSOlivier Moysan
stm32_afsdm_pcm_cb(const void * data,size_t size,void * private)16755da0948SArnaud Pouliquen static int stm32_afsdm_pcm_cb(const void *data, size_t size, void *private)
16855da0948SArnaud Pouliquen {
16955da0948SArnaud Pouliquen struct stm32_adfsdm_priv *priv = private;
170ddb4f06dSKuninori Morimoto struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(priv->substream);
17155da0948SArnaud Pouliquen u8 *pcm_buff = priv->pcm_buff;
17255da0948SArnaud Pouliquen u8 *src_buff = (u8 *)data;
17355da0948SArnaud Pouliquen unsigned int old_pos = priv->pos;
1741e7f6e1cSOlivier Moysan size_t buff_size = snd_pcm_lib_buffer_bytes(priv->substream);
1751e7f6e1cSOlivier Moysan size_t period_size = snd_pcm_lib_period_bytes(priv->substream);
1761e7f6e1cSOlivier Moysan size_t cur_size, src_size = size;
1771e7f6e1cSOlivier Moysan snd_pcm_format_t format = priv->substream->runtime->format;
1781e7f6e1cSOlivier Moysan
1791e7f6e1cSOlivier Moysan if (format == SNDRV_PCM_FORMAT_S16_LE)
1801e7f6e1cSOlivier Moysan src_size >>= 1;
1811e7f6e1cSOlivier Moysan cur_size = src_size;
18255da0948SArnaud Pouliquen
1838db339d6Sbenjamin.gaignard@linaro.org dev_dbg(rtd->dev, "%s: buff_add :%pK, pos = %d, size = %zu\n",
1841e7f6e1cSOlivier Moysan __func__, &pcm_buff[priv->pos], priv->pos, src_size);
18555da0948SArnaud Pouliquen
1861e7f6e1cSOlivier Moysan if ((priv->pos + src_size) > buff_size) {
1871e7f6e1cSOlivier Moysan if (format == SNDRV_PCM_FORMAT_S16_LE)
1888e55ea19SOlivier Moysan stm32_memcpy_32to16(&pcm_buff[priv->pos], src_buff,
1891e7f6e1cSOlivier Moysan buff_size - priv->pos);
1901e7f6e1cSOlivier Moysan else
1911e7f6e1cSOlivier Moysan memcpy(&pcm_buff[priv->pos], src_buff,
1921e7f6e1cSOlivier Moysan buff_size - priv->pos);
19355da0948SArnaud Pouliquen cur_size -= buff_size - priv->pos;
19455da0948SArnaud Pouliquen priv->pos = 0;
19555da0948SArnaud Pouliquen }
19655da0948SArnaud Pouliquen
1971e7f6e1cSOlivier Moysan if (format == SNDRV_PCM_FORMAT_S16_LE)
1988e55ea19SOlivier Moysan stm32_memcpy_32to16(&pcm_buff[priv->pos],
1991e7f6e1cSOlivier Moysan &src_buff[src_size - cur_size], cur_size);
2001e7f6e1cSOlivier Moysan else
2011e7f6e1cSOlivier Moysan memcpy(&pcm_buff[priv->pos], &src_buff[src_size - cur_size],
2021e7f6e1cSOlivier Moysan cur_size);
2031e7f6e1cSOlivier Moysan
20455da0948SArnaud Pouliquen priv->pos = (priv->pos + cur_size) % buff_size;
20555da0948SArnaud Pouliquen
2061e7f6e1cSOlivier Moysan if (cur_size != src_size || (old_pos && (old_pos % period_size < size)))
20755da0948SArnaud Pouliquen snd_pcm_period_elapsed(priv->substream);
20855da0948SArnaud Pouliquen
20955da0948SArnaud Pouliquen return 0;
21055da0948SArnaud Pouliquen }
21155da0948SArnaud Pouliquen
stm32_adfsdm_trigger(struct snd_soc_component * component,struct snd_pcm_substream * substream,int cmd)21221499089SKuninori Morimoto static int stm32_adfsdm_trigger(struct snd_soc_component *component,
21321499089SKuninori Morimoto struct snd_pcm_substream *substream, int cmd)
21455da0948SArnaud Pouliquen {
215ddb4f06dSKuninori Morimoto struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
21655da0948SArnaud Pouliquen struct stm32_adfsdm_priv *priv =
217b1bee67cSKuninori Morimoto snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0));
21855da0948SArnaud Pouliquen
21955da0948SArnaud Pouliquen switch (cmd) {
22055da0948SArnaud Pouliquen case SNDRV_PCM_TRIGGER_START:
22155da0948SArnaud Pouliquen case SNDRV_PCM_TRIGGER_RESUME:
22255da0948SArnaud Pouliquen priv->pos = 0;
22355da0948SArnaud Pouliquen return stm32_dfsdm_get_buff_cb(priv->iio_ch->indio_dev,
22455da0948SArnaud Pouliquen stm32_afsdm_pcm_cb, priv);
22555da0948SArnaud Pouliquen case SNDRV_PCM_TRIGGER_SUSPEND:
22655da0948SArnaud Pouliquen case SNDRV_PCM_TRIGGER_STOP:
22755da0948SArnaud Pouliquen return stm32_dfsdm_release_buff_cb(priv->iio_ch->indio_dev);
22855da0948SArnaud Pouliquen }
22955da0948SArnaud Pouliquen
23055da0948SArnaud Pouliquen return -EINVAL;
23155da0948SArnaud Pouliquen }
23255da0948SArnaud Pouliquen
stm32_adfsdm_pcm_open(struct snd_soc_component * component,struct snd_pcm_substream * substream)23321499089SKuninori Morimoto static int stm32_adfsdm_pcm_open(struct snd_soc_component *component,
23421499089SKuninori Morimoto struct snd_pcm_substream *substream)
23555da0948SArnaud Pouliquen {
236ddb4f06dSKuninori Morimoto struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
237b1bee67cSKuninori Morimoto struct stm32_adfsdm_priv *priv = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0));
23855da0948SArnaud Pouliquen int ret;
23955da0948SArnaud Pouliquen
24055da0948SArnaud Pouliquen ret = snd_soc_set_runtime_hwparams(substream, &stm32_adfsdm_pcm_hw);
24155da0948SArnaud Pouliquen if (!ret)
24255da0948SArnaud Pouliquen priv->substream = substream;
24355da0948SArnaud Pouliquen
24455da0948SArnaud Pouliquen return ret;
24555da0948SArnaud Pouliquen }
24655da0948SArnaud Pouliquen
stm32_adfsdm_pcm_close(struct snd_soc_component * component,struct snd_pcm_substream * substream)24721499089SKuninori Morimoto static int stm32_adfsdm_pcm_close(struct snd_soc_component *component,
24821499089SKuninori Morimoto struct snd_pcm_substream *substream)
24955da0948SArnaud Pouliquen {
250ddb4f06dSKuninori Morimoto struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
25155da0948SArnaud Pouliquen struct stm32_adfsdm_priv *priv =
252b1bee67cSKuninori Morimoto snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0));
25355da0948SArnaud Pouliquen
25455da0948SArnaud Pouliquen priv->substream = NULL;
25555da0948SArnaud Pouliquen
25655da0948SArnaud Pouliquen return 0;
25755da0948SArnaud Pouliquen }
25855da0948SArnaud Pouliquen
stm32_adfsdm_pcm_pointer(struct snd_soc_component * component,struct snd_pcm_substream * substream)25955da0948SArnaud Pouliquen static snd_pcm_uframes_t stm32_adfsdm_pcm_pointer(
26021499089SKuninori Morimoto struct snd_soc_component *component,
26155da0948SArnaud Pouliquen struct snd_pcm_substream *substream)
26255da0948SArnaud Pouliquen {
263ddb4f06dSKuninori Morimoto struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
26455da0948SArnaud Pouliquen struct stm32_adfsdm_priv *priv =
265b1bee67cSKuninori Morimoto snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0));
26655da0948SArnaud Pouliquen
26755da0948SArnaud Pouliquen return bytes_to_frames(substream->runtime, priv->pos);
26855da0948SArnaud Pouliquen }
26955da0948SArnaud Pouliquen
stm32_adfsdm_pcm_hw_params(struct snd_soc_component * component,struct snd_pcm_substream * substream,struct snd_pcm_hw_params * params)27021499089SKuninori Morimoto static int stm32_adfsdm_pcm_hw_params(struct snd_soc_component *component,
27121499089SKuninori Morimoto struct snd_pcm_substream *substream,
27255da0948SArnaud Pouliquen struct snd_pcm_hw_params *params)
27355da0948SArnaud Pouliquen {
274ddb4f06dSKuninori Morimoto struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
27555da0948SArnaud Pouliquen struct stm32_adfsdm_priv *priv =
276b1bee67cSKuninori Morimoto snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0));
27755da0948SArnaud Pouliquen
27855da0948SArnaud Pouliquen priv->pcm_buff = substream->runtime->dma_area;
27955da0948SArnaud Pouliquen
28055da0948SArnaud Pouliquen return iio_channel_cb_set_buffer_watermark(priv->iio_cb,
28155da0948SArnaud Pouliquen params_period_size(params));
28255da0948SArnaud Pouliquen }
28355da0948SArnaud Pouliquen
stm32_adfsdm_pcm_new(struct snd_soc_component * component,struct snd_soc_pcm_runtime * rtd)28421499089SKuninori Morimoto static int stm32_adfsdm_pcm_new(struct snd_soc_component *component,
28521499089SKuninori Morimoto struct snd_soc_pcm_runtime *rtd)
28655da0948SArnaud Pouliquen {
28755da0948SArnaud Pouliquen struct snd_pcm *pcm = rtd->pcm;
28855da0948SArnaud Pouliquen struct stm32_adfsdm_priv *priv =
289b1bee67cSKuninori Morimoto snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0));
29055da0948SArnaud Pouliquen unsigned int size = DFSDM_MAX_PERIODS * DFSDM_MAX_PERIOD_SIZE;
29155da0948SArnaud Pouliquen
2926f7aff35STakashi Iwai snd_pcm_set_managed_buffer_all(pcm, SNDRV_DMA_TYPE_DEV,
29355da0948SArnaud Pouliquen priv->dev, size, size);
29418183edaSTakashi Iwai return 0;
29555da0948SArnaud Pouliquen }
29655da0948SArnaud Pouliquen
stm32_adfsdm_dummy_cb(const void * data,void * private)2979afaf9a5SOlivier Moysan static int stm32_adfsdm_dummy_cb(const void *data, void *private)
2989afaf9a5SOlivier Moysan {
2999afaf9a5SOlivier Moysan /*
3002685d504SJulia Lawall * This dummy callback is requested by iio_channel_get_all_cb() API,
3019afaf9a5SOlivier Moysan * but the stm32_dfsdm_get_buff_cb() API is used instead, to optimize
3029afaf9a5SOlivier Moysan * DMA transfers.
3039afaf9a5SOlivier Moysan */
3049afaf9a5SOlivier Moysan return 0;
3059afaf9a5SOlivier Moysan }
3069afaf9a5SOlivier Moysan
stm32_adfsdm_cleanup(void * data)3077d945b04SOlivier Moysan static void stm32_adfsdm_cleanup(void *data)
3087d945b04SOlivier Moysan {
3097d945b04SOlivier Moysan iio_channel_release_all_cb(data);
3107d945b04SOlivier Moysan }
3117d945b04SOlivier Moysan
31266bf428eSKuninori Morimoto static struct snd_soc_component_driver stm32_adfsdm_soc_platform = {
31321499089SKuninori Morimoto .open = stm32_adfsdm_pcm_open,
31421499089SKuninori Morimoto .close = stm32_adfsdm_pcm_close,
31521499089SKuninori Morimoto .hw_params = stm32_adfsdm_pcm_hw_params,
31621499089SKuninori Morimoto .trigger = stm32_adfsdm_trigger,
31721499089SKuninori Morimoto .pointer = stm32_adfsdm_pcm_pointer,
31821499089SKuninori Morimoto .pcm_construct = stm32_adfsdm_pcm_new,
31955da0948SArnaud Pouliquen };
32055da0948SArnaud Pouliquen
32155da0948SArnaud Pouliquen static const struct of_device_id stm32_adfsdm_of_match[] = {
32255da0948SArnaud Pouliquen {.compatible = "st,stm32h7-dfsdm-dai"},
32355da0948SArnaud Pouliquen {}
32455da0948SArnaud Pouliquen };
32555da0948SArnaud Pouliquen MODULE_DEVICE_TABLE(of, stm32_adfsdm_of_match);
32655da0948SArnaud Pouliquen
stm32_adfsdm_probe(struct platform_device * pdev)32755da0948SArnaud Pouliquen static int stm32_adfsdm_probe(struct platform_device *pdev)
32855da0948SArnaud Pouliquen {
32955da0948SArnaud Pouliquen struct stm32_adfsdm_priv *priv;
330c47255b6SOlivier Moysan struct snd_soc_component *component;
33155da0948SArnaud Pouliquen int ret;
33255da0948SArnaud Pouliquen
33355da0948SArnaud Pouliquen priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
33455da0948SArnaud Pouliquen if (!priv)
33555da0948SArnaud Pouliquen return -ENOMEM;
33655da0948SArnaud Pouliquen
33755da0948SArnaud Pouliquen priv->dev = &pdev->dev;
33855da0948SArnaud Pouliquen priv->dai_drv = stm32_adfsdm_dai;
33919441e35SOlivier Moysan mutex_init(&priv->lock);
34055da0948SArnaud Pouliquen
34155da0948SArnaud Pouliquen dev_set_drvdata(&pdev->dev, priv);
34255da0948SArnaud Pouliquen
34355da0948SArnaud Pouliquen ret = devm_snd_soc_register_component(&pdev->dev,
34455da0948SArnaud Pouliquen &stm32_adfsdm_dai_component,
34555da0948SArnaud Pouliquen &priv->dai_drv, 1);
34655da0948SArnaud Pouliquen if (ret < 0)
34755da0948SArnaud Pouliquen return ret;
34855da0948SArnaud Pouliquen
34955da0948SArnaud Pouliquen /* Associate iio channel */
35055da0948SArnaud Pouliquen priv->iio_ch = devm_iio_channel_get_all(&pdev->dev);
35155da0948SArnaud Pouliquen if (IS_ERR(priv->iio_ch))
35255da0948SArnaud Pouliquen return PTR_ERR(priv->iio_ch);
35355da0948SArnaud Pouliquen
3549afaf9a5SOlivier Moysan priv->iio_cb = iio_channel_get_all_cb(&pdev->dev, &stm32_adfsdm_dummy_cb, NULL);
35555da0948SArnaud Pouliquen if (IS_ERR(priv->iio_cb))
3566dee6722SWei Yongjun return PTR_ERR(priv->iio_cb);
35755da0948SArnaud Pouliquen
3587d945b04SOlivier Moysan ret = devm_add_action_or_reset(&pdev->dev, stm32_adfsdm_cleanup, priv->iio_cb);
3597d945b04SOlivier Moysan if (ret < 0) {
3607d945b04SOlivier Moysan dev_err(&pdev->dev, "Unable to add action\n");
3617d945b04SOlivier Moysan return ret;
3627d945b04SOlivier Moysan }
3637d945b04SOlivier Moysan
364c47255b6SOlivier Moysan component = devm_kzalloc(&pdev->dev, sizeof(*component), GFP_KERNEL);
365c47255b6SOlivier Moysan if (!component)
366c47255b6SOlivier Moysan return -ENOMEM;
367ea029dd8SCezary Rojewski
368ea029dd8SCezary Rojewski ret = snd_soc_component_initialize(component,
369ea029dd8SCezary Rojewski &stm32_adfsdm_soc_platform,
370ea029dd8SCezary Rojewski &pdev->dev);
371ea029dd8SCezary Rojewski if (ret < 0)
372ea029dd8SCezary Rojewski return ret;
373c47255b6SOlivier Moysan #ifdef CONFIG_DEBUG_FS
374c47255b6SOlivier Moysan component->debugfs_prefix = "pcm";
375c47255b6SOlivier Moysan #endif
376c47255b6SOlivier Moysan
377ea029dd8SCezary Rojewski ret = snd_soc_add_component(component, NULL, 0);
378b9a0da5bSZhang Qilong if (ret < 0) {
37955da0948SArnaud Pouliquen dev_err(&pdev->dev, "%s: Failed to register PCM platform\n",
38055da0948SArnaud Pouliquen __func__);
381b9a0da5bSZhang Qilong return ret;
382b9a0da5bSZhang Qilong }
383b9a0da5bSZhang Qilong
384b9a0da5bSZhang Qilong pm_runtime_enable(&pdev->dev);
38555da0948SArnaud Pouliquen
38655da0948SArnaud Pouliquen return ret;
38755da0948SArnaud Pouliquen }
38855da0948SArnaud Pouliquen
stm32_adfsdm_remove(struct platform_device * pdev)389*6cd293d2SUwe Kleine-König static void stm32_adfsdm_remove(struct platform_device *pdev)
390c47255b6SOlivier Moysan {
391c47255b6SOlivier Moysan snd_soc_unregister_component(&pdev->dev);
39298e500a1SOlivier Moysan pm_runtime_disable(&pdev->dev);
393c47255b6SOlivier Moysan }
394c47255b6SOlivier Moysan
39555da0948SArnaud Pouliquen static struct platform_driver stm32_adfsdm_driver = {
39655da0948SArnaud Pouliquen .driver = {
39755da0948SArnaud Pouliquen .name = STM32_ADFSDM_DRV_NAME,
39855da0948SArnaud Pouliquen .of_match_table = stm32_adfsdm_of_match,
39955da0948SArnaud Pouliquen },
40055da0948SArnaud Pouliquen .probe = stm32_adfsdm_probe,
401*6cd293d2SUwe Kleine-König .remove_new = stm32_adfsdm_remove,
40255da0948SArnaud Pouliquen };
40355da0948SArnaud Pouliquen
40455da0948SArnaud Pouliquen module_platform_driver(stm32_adfsdm_driver);
40555da0948SArnaud Pouliquen
40655da0948SArnaud Pouliquen MODULE_DESCRIPTION("stm32 DFSDM DAI driver");
40755da0948SArnaud Pouliquen MODULE_AUTHOR("Arnaud Pouliquen <arnaud.pouliquen@st.com>");
40855da0948SArnaud Pouliquen MODULE_LICENSE("GPL v2");
40955da0948SArnaud Pouliquen MODULE_ALIAS("platform:" STM32_ADFSDM_DRV_NAME);
410