2 * ALSA SoC Synopsys PIO PCM for I2S driver
4 * sound/soc/dwc/designware_pcm.c
6 * Copyright (C) 2016 Synopsys
7 * Jose Abreu <joabreu@synopsys.com>
9 * This file is licensed under the terms of the GNU General Public
10 * License version 2. This program is licensed "as is" without any
11 * warranty of any kind, whether express or implied.
15 #include <linux/rcupdate.h>
16 #include <sound/pcm.h>
17 #include <sound/pcm_params.h>
20 #define BUFFER_BYTES_MAX (3 * 2 * 8 * PERIOD_BYTES_MIN)
21 #define PERIOD_BYTES_MIN 4096
24 #define dw_pcm_tx_fn(sample_bits) \
25 static unsigned int dw_pcm_tx_##sample_bits(struct dw_i2s_dev *dev, \
26 struct snd_pcm_runtime *runtime, unsigned int tx_ptr, \
27 bool *period_elapsed) \
29 const u##sample_bits (*p)[2] = (void *)runtime->dma_area; \
30 unsigned int period_pos = tx_ptr % runtime->period_size; \
33 for (i = 0; i < dev->fifo_th; i++) { \
34 iowrite32(p[tx_ptr][0], dev->i2s_base + LRBR_LTHR(0)); \
35 iowrite32(p[tx_ptr][1], dev->i2s_base + RRBR_RTHR(0)); \
37 if (++tx_ptr >= runtime->buffer_size) \
40 *period_elapsed = period_pos >= runtime->period_size; \
44 #define dw_pcm_rx_fn(sample_bits) \
45 static unsigned int dw_pcm_rx_##sample_bits(struct dw_i2s_dev *dev, \
46 struct snd_pcm_runtime *runtime, unsigned int rx_ptr, \
47 bool *period_elapsed) \
49 u##sample_bits (*p)[2] = (void *)runtime->dma_area; \
50 unsigned int period_pos = rx_ptr % runtime->period_size; \
53 for (i = 0; i < dev->fifo_th; i++) { \
54 p[rx_ptr][0] = ioread32(dev->i2s_base + LRBR_LTHR(0)); \
55 p[rx_ptr][1] = ioread32(dev->i2s_base + RRBR_RTHR(0)); \
57 if (++rx_ptr >= runtime->buffer_size) \
60 *period_elapsed = period_pos >= runtime->period_size; \
72 static const struct snd_pcm_hardware dw_pcm_hardware = {
73 .info = SNDRV_PCM_INFO_INTERLEAVED |
75 SNDRV_PCM_INFO_MMAP_VALID |
76 SNDRV_PCM_INFO_BLOCK_TRANSFER,
77 .rates = SNDRV_PCM_RATE_32000 |
78 SNDRV_PCM_RATE_44100 |
82 .formats = SNDRV_PCM_FMTBIT_S16_LE |
83 SNDRV_PCM_FMTBIT_S24_LE |
84 SNDRV_PCM_FMTBIT_S32_LE,
87 .buffer_bytes_max = BUFFER_BYTES_MAX,
88 .period_bytes_min = PERIOD_BYTES_MIN,
89 .period_bytes_max = BUFFER_BYTES_MAX / PERIODS_MIN,
90 .periods_min = PERIODS_MIN,
91 .periods_max = BUFFER_BYTES_MAX / PERIOD_BYTES_MIN,
95 static void dw_pcm_transfer(struct dw_i2s_dev *dev, bool push)
97 struct snd_pcm_substream *substream;
98 bool active, period_elapsed;
102 substream = rcu_dereference(dev->tx_substream);
104 substream = rcu_dereference(dev->rx_substream);
105 active = substream && snd_pcm_running(substream);
108 unsigned int new_ptr;
111 ptr = READ_ONCE(dev->tx_ptr);
112 new_ptr = dev->tx_fn(dev, substream->runtime, ptr,
114 cmpxchg(&dev->tx_ptr, ptr, new_ptr);
116 ptr = READ_ONCE(dev->rx_ptr);
117 new_ptr = dev->rx_fn(dev, substream->runtime, ptr,
119 cmpxchg(&dev->rx_ptr, ptr, new_ptr);
123 snd_pcm_period_elapsed(substream);
128 void dw_pcm_push_tx(struct dw_i2s_dev *dev)
130 dw_pcm_transfer(dev, true);
133 void dw_pcm_pop_rx(struct dw_i2s_dev *dev)
135 dw_pcm_transfer(dev, false);
138 static int dw_pcm_open(struct snd_soc_component *component,
139 struct snd_pcm_substream *substream)
141 struct snd_pcm_runtime *runtime = substream->runtime;
142 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
143 struct dw_i2s_dev *dev = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0));
145 snd_soc_set_runtime_hwparams(substream, &dw_pcm_hardware);
146 snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS);
147 runtime->private_data = dev;
152 static int dw_pcm_close(struct snd_soc_component *component,
153 struct snd_pcm_substream *substream)
159 static int dw_pcm_hw_params(struct snd_soc_component *component,
160 struct snd_pcm_substream *substream,
161 struct snd_pcm_hw_params *hw_params)
163 struct snd_pcm_runtime *runtime = substream->runtime;
164 struct dw_i2s_dev *dev = runtime->private_data;
166 switch (params_channels(hw_params)) {
170 dev_err(dev->dev, "invalid channels number\n");
174 switch (params_format(hw_params)) {
175 case SNDRV_PCM_FORMAT_S16_LE:
176 dev->tx_fn = dw_pcm_tx_16;
177 dev->rx_fn = dw_pcm_rx_16;
179 case SNDRV_PCM_FORMAT_S24_LE:
180 case SNDRV_PCM_FORMAT_S32_LE:
181 dev->tx_fn = dw_pcm_tx_32;
182 dev->rx_fn = dw_pcm_rx_32;
185 dev_err(dev->dev, "invalid format\n");
192 static int dw_pcm_trigger(struct snd_soc_component *component,
193 struct snd_pcm_substream *substream, int cmd)
195 struct snd_pcm_runtime *runtime = substream->runtime;
196 struct dw_i2s_dev *dev = runtime->private_data;
200 case SNDRV_PCM_TRIGGER_START:
201 case SNDRV_PCM_TRIGGER_RESUME:
202 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
203 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
204 WRITE_ONCE(dev->tx_ptr, 0);
205 rcu_assign_pointer(dev->tx_substream, substream);
207 WRITE_ONCE(dev->rx_ptr, 0);
208 rcu_assign_pointer(dev->rx_substream, substream);
211 case SNDRV_PCM_TRIGGER_STOP:
212 case SNDRV_PCM_TRIGGER_SUSPEND:
213 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
214 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
215 rcu_assign_pointer(dev->tx_substream, NULL);
217 rcu_assign_pointer(dev->rx_substream, NULL);
227 static snd_pcm_uframes_t dw_pcm_pointer(struct snd_soc_component *component,
228 struct snd_pcm_substream *substream)
230 struct snd_pcm_runtime *runtime = substream->runtime;
231 struct dw_i2s_dev *dev = runtime->private_data;
232 snd_pcm_uframes_t pos;
234 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
235 pos = READ_ONCE(dev->tx_ptr);
237 pos = READ_ONCE(dev->rx_ptr);
239 return pos < runtime->buffer_size ? pos : 0;
242 static int dw_pcm_new(struct snd_soc_component *component,
243 struct snd_soc_pcm_runtime *rtd)
245 size_t size = dw_pcm_hardware.buffer_bytes_max;
247 snd_pcm_set_managed_buffer_all(rtd->pcm,
248 SNDRV_DMA_TYPE_CONTINUOUS,
253 static const struct snd_soc_component_driver dw_pcm_component = {
255 .close = dw_pcm_close,
256 .hw_params = dw_pcm_hw_params,
257 .trigger = dw_pcm_trigger,
258 .pointer = dw_pcm_pointer,
259 .pcm_construct = dw_pcm_new,
262 int dw_pcm_register(struct platform_device *pdev)
264 return devm_snd_soc_register_component(&pdev->dev, &dw_pcm_component,