1 // SPDX-License-Identifier: GPL-2.0
5  * Copyright (C) 2017, STMicroelectronics - All Rights Reserved
18 #include <linux/iio/adc/stm32-dfsdm-adc.h>
23 #define STM32_ADFSDM_DRV_NAME "stm32-adfsdm"
68 	mutex_lock(&priv->lock);  in stm32_adfsdm_shutdown()
69 	if (priv->iio_active) {  in stm32_adfsdm_shutdown()
70 		iio_channel_stop_all_cb(priv->iio_cb);  in stm32_adfsdm_shutdown()
71 		priv->iio_active = false;  in stm32_adfsdm_shutdown()
73 	mutex_unlock(&priv->lock);  in stm32_adfsdm_shutdown()
82 	mutex_lock(&priv->lock);  in stm32_adfsdm_dai_prepare()
83 	if (priv->iio_active) {  in stm32_adfsdm_dai_prepare()
84 		iio_channel_stop_all_cb(priv->iio_cb);  in stm32_adfsdm_dai_prepare()
85 		priv->iio_active = false;  in stm32_adfsdm_dai_prepare()
88 	ret = iio_write_channel_attribute(priv->iio_ch,  in stm32_adfsdm_dai_prepare()
89 					  substream->runtime->rate, 0,  in stm32_adfsdm_dai_prepare()
92 		dev_err(dai->dev, "%s: Failed to set %d sampling rate\n",  in stm32_adfsdm_dai_prepare()
93 			__func__, substream->runtime->rate);  in stm32_adfsdm_dai_prepare()
97 	if (!priv->iio_active) {  in stm32_adfsdm_dai_prepare()
98 		ret = iio_channel_start_all_cb(priv->iio_cb);  in stm32_adfsdm_dai_prepare()
100 			priv->iio_active = true;  in stm32_adfsdm_dai_prepare()
102 			dev_err(dai->dev, "%s: IIO channel start failed (%d)\n",  in stm32_adfsdm_dai_prepare()
107 	mutex_unlock(&priv->lock);  in stm32_adfsdm_dai_prepare()
119 	dev_dbg(dai->dev, "%s: Enter for freq %d\n", __func__, freq);  in stm32_adfsdm_set_sysclk()
124 	size = iio_write_channel_ext_info(priv->iio_ch, "spi_clk_freq",  in stm32_adfsdm_set_sysclk()
127 		dev_err(dai->dev, "%s: Failed to set SPI clock\n",  in stm32_adfsdm_set_sysclk()
129 		return -EINVAL;  in stm32_adfsdm_set_sysclk()
158 	struct snd_soc_pcm_runtime *rtd = priv->substream->private_data;  in stm32_afsdm_pcm_cb()
159 	u8 *pcm_buff = priv->pcm_buff;  in stm32_afsdm_pcm_cb()
161 	unsigned int buff_size = snd_pcm_lib_buffer_bytes(priv->substream);  in stm32_afsdm_pcm_cb()
162 	unsigned int period_size = snd_pcm_lib_period_bytes(priv->substream);  in stm32_afsdm_pcm_cb()
163 	unsigned int old_pos = priv->pos;  in stm32_afsdm_pcm_cb()
166 	dev_dbg(rtd->dev, "%s: buff_add :%pK, pos = %d, size = %zu\n",  in stm32_afsdm_pcm_cb()
167 		__func__, &pcm_buff[priv->pos], priv->pos, size);  in stm32_afsdm_pcm_cb()
169 	if ((priv->pos + size) > buff_size) {  in stm32_afsdm_pcm_cb()
170 		memcpy(&pcm_buff[priv->pos], src_buff, buff_size - priv->pos);  in stm32_afsdm_pcm_cb()
171 		cur_size -= buff_size - priv->pos;  in stm32_afsdm_pcm_cb()
172 		priv->pos = 0;  in stm32_afsdm_pcm_cb()
175 	memcpy(&pcm_buff[priv->pos], &src_buff[size - cur_size], cur_size);  in stm32_afsdm_pcm_cb()
176 	priv->pos = (priv->pos + cur_size) % buff_size;  in stm32_afsdm_pcm_cb()
179 		snd_pcm_period_elapsed(priv->substream);  in stm32_afsdm_pcm_cb()
186 	struct snd_soc_pcm_runtime *rtd = substream->private_data;  in stm32_adfsdm_trigger()
188 		snd_soc_dai_get_drvdata(rtd->cpu_dai);  in stm32_adfsdm_trigger()
193 		priv->pos = 0;  in stm32_adfsdm_trigger()
194 		return stm32_dfsdm_get_buff_cb(priv->iio_ch->indio_dev,  in stm32_adfsdm_trigger()
198 		return stm32_dfsdm_release_buff_cb(priv->iio_ch->indio_dev);  in stm32_adfsdm_trigger()
201 	return -EINVAL;  in stm32_adfsdm_trigger()
206 	struct snd_soc_pcm_runtime *rtd = substream->private_data;  in stm32_adfsdm_pcm_open()
207 	struct stm32_adfsdm_priv *priv = snd_soc_dai_get_drvdata(rtd->cpu_dai);  in stm32_adfsdm_pcm_open()
212 		priv->substream = substream;  in stm32_adfsdm_pcm_open()
219 	struct snd_soc_pcm_runtime *rtd = substream->private_data;  in stm32_adfsdm_pcm_close()
221 		snd_soc_dai_get_drvdata(rtd->cpu_dai);  in stm32_adfsdm_pcm_close()
224 	priv->substream = NULL;  in stm32_adfsdm_pcm_close()
232 	struct snd_soc_pcm_runtime *rtd = substream->private_data;  in stm32_adfsdm_pcm_pointer()
234 		snd_soc_dai_get_drvdata(rtd->cpu_dai);  in stm32_adfsdm_pcm_pointer()
236 	return bytes_to_frames(substream->runtime, priv->pos);  in stm32_adfsdm_pcm_pointer()
242 	struct snd_soc_pcm_runtime *rtd = substream->private_data;  in stm32_adfsdm_pcm_hw_params()
244 		snd_soc_dai_get_drvdata(rtd->cpu_dai);  in stm32_adfsdm_pcm_hw_params()
250 	priv->pcm_buff = substream->runtime->dma_area;  in stm32_adfsdm_pcm_hw_params()
252 	return iio_channel_cb_set_buffer_watermark(priv->iio_cb,  in stm32_adfsdm_pcm_hw_params()
274 	struct snd_pcm *pcm = rtd->pcm;  in stm32_adfsdm_pcm_new()
276 		snd_soc_dai_get_drvdata(rtd->cpu_dai);  in stm32_adfsdm_pcm_new()
280 						     priv->dev, size, size);  in stm32_adfsdm_pcm_new()
287 	substream = pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream;  in stm32_adfsdm_pcm_free()
299 	{.compatible = "st,stm32h7-dfsdm-dai"},
310 	priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);  in stm32_adfsdm_probe()
312 		return -ENOMEM;  in stm32_adfsdm_probe()
314 	priv->dev = &pdev->dev;  in stm32_adfsdm_probe()
315 	priv->dai_drv = stm32_adfsdm_dai;  in stm32_adfsdm_probe()
316 	mutex_init(&priv->lock);  in stm32_adfsdm_probe()
318 	dev_set_drvdata(&pdev->dev, priv);  in stm32_adfsdm_probe()
320 	ret = devm_snd_soc_register_component(&pdev->dev,  in stm32_adfsdm_probe()
322 					      &priv->dai_drv, 1);  in stm32_adfsdm_probe()
327 	priv->iio_ch  = devm_iio_channel_get_all(&pdev->dev);  in stm32_adfsdm_probe()
328 	if (IS_ERR(priv->iio_ch))  in stm32_adfsdm_probe()
329 		return PTR_ERR(priv->iio_ch);  in stm32_adfsdm_probe()
331 	priv->iio_cb = iio_channel_get_all_cb(&pdev->dev, NULL, NULL);  in stm32_adfsdm_probe()
332 	if (IS_ERR(priv->iio_cb))  in stm32_adfsdm_probe()
333 		return PTR_ERR(priv->iio_cb);  in stm32_adfsdm_probe()
335 	component = devm_kzalloc(&pdev->dev, sizeof(*component), GFP_KERNEL);  in stm32_adfsdm_probe()
337 		return -ENOMEM;  in stm32_adfsdm_probe()
339 	component->debugfs_prefix = "pcm";  in stm32_adfsdm_probe()
342 	ret = snd_soc_add_component(&pdev->dev, component,  in stm32_adfsdm_probe()
345 		dev_err(&pdev->dev, "%s: Failed to register PCM platform\n",  in stm32_adfsdm_probe()
353 	snd_soc_unregister_component(&pdev->dev);  in stm32_adfsdm_remove()