diff options
Diffstat (limited to 'sound/soc/kirkwood/kirkwood-dma.c')
-rw-r--r-- | sound/soc/kirkwood/kirkwood-dma.c | 108 |
1 files changed, 24 insertions, 84 deletions
diff --git a/sound/soc/kirkwood/kirkwood-dma.c b/sound/soc/kirkwood/kirkwood-dma.c index a9f14530c3db..b238434f92b0 100644 --- a/sound/soc/kirkwood/kirkwood-dma.c +++ b/sound/soc/kirkwood/kirkwood-dma.c | |||
@@ -33,11 +33,11 @@ | |||
33 | SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE | \ | 33 | SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE | \ |
34 | SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_BE) | 34 | SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_BE) |
35 | 35 | ||
36 | struct kirkwood_dma_priv { | 36 | static struct kirkwood_dma_data *kirkwood_priv(struct snd_pcm_substream *subs) |
37 | struct snd_pcm_substream *play_stream; | 37 | { |
38 | struct snd_pcm_substream *rec_stream; | 38 | struct snd_soc_pcm_runtime *soc_runtime = subs->private_data; |
39 | struct kirkwood_dma_data *data; | 39 | return snd_soc_dai_get_drvdata(soc_runtime->cpu_dai); |
40 | }; | 40 | } |
41 | 41 | ||
42 | static struct snd_pcm_hardware kirkwood_dma_snd_hw = { | 42 | static struct snd_pcm_hardware kirkwood_dma_snd_hw = { |
43 | .info = (SNDRV_PCM_INFO_INTERLEAVED | | 43 | .info = (SNDRV_PCM_INFO_INTERLEAVED | |
@@ -51,7 +51,7 @@ static struct snd_pcm_hardware kirkwood_dma_snd_hw = { | |||
51 | .rate_max = 384000, | 51 | .rate_max = 384000, |
52 | .channels_min = 1, | 52 | .channels_min = 1, |
53 | .channels_max = 8, | 53 | .channels_max = 8, |
54 | .buffer_bytes_max = KIRKWOOD_SND_MAX_PERIOD_BYTES * KIRKWOOD_SND_MAX_PERIODS, | 54 | .buffer_bytes_max = KIRKWOOD_SND_MAX_BUFFER_BYTES, |
55 | .period_bytes_min = KIRKWOOD_SND_MIN_PERIOD_BYTES, | 55 | .period_bytes_min = KIRKWOOD_SND_MIN_PERIOD_BYTES, |
56 | .period_bytes_max = KIRKWOOD_SND_MAX_PERIOD_BYTES, | 56 | .period_bytes_max = KIRKWOOD_SND_MAX_PERIOD_BYTES, |
57 | .periods_min = KIRKWOOD_SND_MIN_PERIODS, | 57 | .periods_min = KIRKWOOD_SND_MIN_PERIODS, |
@@ -63,8 +63,7 @@ static u64 kirkwood_dma_dmamask = DMA_BIT_MASK(32); | |||
63 | 63 | ||
64 | static irqreturn_t kirkwood_dma_irq(int irq, void *dev_id) | 64 | static irqreturn_t kirkwood_dma_irq(int irq, void *dev_id) |
65 | { | 65 | { |
66 | struct kirkwood_dma_priv *prdata = dev_id; | 66 | struct kirkwood_dma_data *priv = dev_id; |
67 | struct kirkwood_dma_data *priv = prdata->data; | ||
68 | unsigned long mask, status, cause; | 67 | unsigned long mask, status, cause; |
69 | 68 | ||
70 | mask = readl(priv->io + KIRKWOOD_INT_MASK); | 69 | mask = readl(priv->io + KIRKWOOD_INT_MASK); |
@@ -89,10 +88,10 @@ static irqreturn_t kirkwood_dma_irq(int irq, void *dev_id) | |||
89 | writel(status, priv->io + KIRKWOOD_INT_CAUSE); | 88 | writel(status, priv->io + KIRKWOOD_INT_CAUSE); |
90 | 89 | ||
91 | if (status & KIRKWOOD_INT_CAUSE_PLAY_BYTES) | 90 | if (status & KIRKWOOD_INT_CAUSE_PLAY_BYTES) |
92 | snd_pcm_period_elapsed(prdata->play_stream); | 91 | snd_pcm_period_elapsed(priv->substream_play); |
93 | 92 | ||
94 | if (status & KIRKWOOD_INT_CAUSE_REC_BYTES) | 93 | if (status & KIRKWOOD_INT_CAUSE_REC_BYTES) |
95 | snd_pcm_period_elapsed(prdata->rec_stream); | 94 | snd_pcm_period_elapsed(priv->substream_rec); |
96 | 95 | ||
97 | return IRQ_HANDLED; | 96 | return IRQ_HANDLED; |
98 | } | 97 | } |
@@ -126,15 +125,10 @@ static int kirkwood_dma_open(struct snd_pcm_substream *substream) | |||
126 | { | 125 | { |
127 | int err; | 126 | int err; |
128 | struct snd_pcm_runtime *runtime = substream->runtime; | 127 | struct snd_pcm_runtime *runtime = substream->runtime; |
129 | struct snd_soc_pcm_runtime *soc_runtime = substream->private_data; | 128 | struct kirkwood_dma_data *priv = kirkwood_priv(substream); |
130 | struct snd_soc_platform *platform = soc_runtime->platform; | ||
131 | struct snd_soc_dai *cpu_dai = soc_runtime->cpu_dai; | ||
132 | struct kirkwood_dma_data *priv; | ||
133 | struct kirkwood_dma_priv *prdata = snd_soc_platform_get_drvdata(platform); | ||
134 | const struct mbus_dram_target_info *dram; | 129 | const struct mbus_dram_target_info *dram; |
135 | unsigned long addr; | 130 | unsigned long addr; |
136 | 131 | ||
137 | priv = snd_soc_dai_get_dma_data(cpu_dai, substream); | ||
138 | snd_soc_set_runtime_hwparams(substream, &kirkwood_dma_snd_hw); | 132 | snd_soc_set_runtime_hwparams(substream, &kirkwood_dma_snd_hw); |
139 | 133 | ||
140 | /* Ensure that all constraints linked to dma burst are fulfilled */ | 134 | /* Ensure that all constraints linked to dma burst are fulfilled */ |
@@ -157,21 +151,11 @@ static int kirkwood_dma_open(struct snd_pcm_substream *substream) | |||
157 | if (err < 0) | 151 | if (err < 0) |
158 | return err; | 152 | return err; |
159 | 153 | ||
160 | if (prdata == NULL) { | 154 | if (!priv->substream_play && !priv->substream_rec) { |
161 | prdata = kzalloc(sizeof(struct kirkwood_dma_priv), GFP_KERNEL); | ||
162 | if (prdata == NULL) | ||
163 | return -ENOMEM; | ||
164 | |||
165 | prdata->data = priv; | ||
166 | |||
167 | err = request_irq(priv->irq, kirkwood_dma_irq, IRQF_SHARED, | 155 | err = request_irq(priv->irq, kirkwood_dma_irq, IRQF_SHARED, |
168 | "kirkwood-i2s", prdata); | 156 | "kirkwood-i2s", priv); |
169 | if (err) { | 157 | if (err) |
170 | kfree(prdata); | ||
171 | return -EBUSY; | 158 | return -EBUSY; |
172 | } | ||
173 | |||
174 | snd_soc_platform_set_drvdata(platform, prdata); | ||
175 | 159 | ||
176 | /* | 160 | /* |
177 | * Enable Error interrupts. We're only ack'ing them but | 161 | * Enable Error interrupts. We're only ack'ing them but |
@@ -183,11 +167,11 @@ static int kirkwood_dma_open(struct snd_pcm_substream *substream) | |||
183 | dram = mv_mbus_dram_info(); | 167 | dram = mv_mbus_dram_info(); |
184 | addr = substream->dma_buffer.addr; | 168 | addr = substream->dma_buffer.addr; |
185 | if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { | 169 | if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { |
186 | prdata->play_stream = substream; | 170 | priv->substream_play = substream; |
187 | kirkwood_dma_conf_mbus_windows(priv->io, | 171 | kirkwood_dma_conf_mbus_windows(priv->io, |
188 | KIRKWOOD_PLAYBACK_WIN, addr, dram); | 172 | KIRKWOOD_PLAYBACK_WIN, addr, dram); |
189 | } else { | 173 | } else { |
190 | prdata->rec_stream = substream; | 174 | priv->substream_rec = substream; |
191 | kirkwood_dma_conf_mbus_windows(priv->io, | 175 | kirkwood_dma_conf_mbus_windows(priv->io, |
192 | KIRKWOOD_RECORD_WIN, addr, dram); | 176 | KIRKWOOD_RECORD_WIN, addr, dram); |
193 | } | 177 | } |
@@ -197,27 +181,19 @@ static int kirkwood_dma_open(struct snd_pcm_substream *substream) | |||
197 | 181 | ||
198 | static int kirkwood_dma_close(struct snd_pcm_substream *substream) | 182 | static int kirkwood_dma_close(struct snd_pcm_substream *substream) |
199 | { | 183 | { |
200 | struct snd_soc_pcm_runtime *soc_runtime = substream->private_data; | 184 | struct kirkwood_dma_data *priv = kirkwood_priv(substream); |
201 | struct snd_soc_dai *cpu_dai = soc_runtime->cpu_dai; | ||
202 | struct snd_soc_platform *platform = soc_runtime->platform; | ||
203 | struct kirkwood_dma_priv *prdata = snd_soc_platform_get_drvdata(platform); | ||
204 | struct kirkwood_dma_data *priv; | ||
205 | |||
206 | priv = snd_soc_dai_get_dma_data(cpu_dai, substream); | ||
207 | 185 | ||
208 | if (!prdata || !priv) | 186 | if (!priv) |
209 | return 0; | 187 | return 0; |
210 | 188 | ||
211 | if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) | 189 | if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) |
212 | prdata->play_stream = NULL; | 190 | priv->substream_play = NULL; |
213 | else | 191 | else |
214 | prdata->rec_stream = NULL; | 192 | priv->substream_rec = NULL; |
215 | 193 | ||
216 | if (!prdata->play_stream && !prdata->rec_stream) { | 194 | if (!priv->substream_play && !priv->substream_rec) { |
217 | writel(0, priv->io + KIRKWOOD_ERR_MASK); | 195 | writel(0, priv->io + KIRKWOOD_ERR_MASK); |
218 | free_irq(priv->irq, prdata); | 196 | free_irq(priv->irq, priv); |
219 | kfree(prdata); | ||
220 | snd_soc_platform_set_drvdata(platform, NULL); | ||
221 | } | 197 | } |
222 | 198 | ||
223 | return 0; | 199 | return 0; |
@@ -243,13 +219,9 @@ static int kirkwood_dma_hw_free(struct snd_pcm_substream *substream) | |||
243 | static int kirkwood_dma_prepare(struct snd_pcm_substream *substream) | 219 | static int kirkwood_dma_prepare(struct snd_pcm_substream *substream) |
244 | { | 220 | { |
245 | struct snd_pcm_runtime *runtime = substream->runtime; | 221 | struct snd_pcm_runtime *runtime = substream->runtime; |
246 | struct snd_soc_pcm_runtime *soc_runtime = substream->private_data; | 222 | struct kirkwood_dma_data *priv = kirkwood_priv(substream); |
247 | struct snd_soc_dai *cpu_dai = soc_runtime->cpu_dai; | ||
248 | struct kirkwood_dma_data *priv; | ||
249 | unsigned long size, count; | 223 | unsigned long size, count; |
250 | 224 | ||
251 | priv = snd_soc_dai_get_dma_data(cpu_dai, substream); | ||
252 | |||
253 | /* compute buffer size in term of "words" as requested in specs */ | 225 | /* compute buffer size in term of "words" as requested in specs */ |
254 | size = frames_to_bytes(runtime, runtime->buffer_size); | 226 | size = frames_to_bytes(runtime, runtime->buffer_size); |
255 | size = (size>>2)-1; | 227 | size = (size>>2)-1; |
@@ -272,13 +244,9 @@ static int kirkwood_dma_prepare(struct snd_pcm_substream *substream) | |||
272 | static snd_pcm_uframes_t kirkwood_dma_pointer(struct snd_pcm_substream | 244 | static snd_pcm_uframes_t kirkwood_dma_pointer(struct snd_pcm_substream |
273 | *substream) | 245 | *substream) |
274 | { | 246 | { |
275 | struct snd_soc_pcm_runtime *soc_runtime = substream->private_data; | 247 | struct kirkwood_dma_data *priv = kirkwood_priv(substream); |
276 | struct snd_soc_dai *cpu_dai = soc_runtime->cpu_dai; | ||
277 | struct kirkwood_dma_data *priv; | ||
278 | snd_pcm_uframes_t count; | 248 | snd_pcm_uframes_t count; |
279 | 249 | ||
280 | priv = snd_soc_dai_get_dma_data(cpu_dai, substream); | ||
281 | |||
282 | if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) | 250 | if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) |
283 | count = bytes_to_frames(substream->runtime, | 251 | count = bytes_to_frames(substream->runtime, |
284 | readl(priv->io + KIRKWOOD_PLAY_BYTE_COUNT)); | 252 | readl(priv->io + KIRKWOOD_PLAY_BYTE_COUNT)); |
@@ -366,36 +334,8 @@ static void kirkwood_dma_free_dma_buffers(struct snd_pcm *pcm) | |||
366 | } | 334 | } |
367 | } | 335 | } |
368 | 336 | ||
369 | static struct snd_soc_platform_driver kirkwood_soc_platform = { | 337 | struct snd_soc_platform_driver kirkwood_soc_platform = { |
370 | .ops = &kirkwood_dma_ops, | 338 | .ops = &kirkwood_dma_ops, |
371 | .pcm_new = kirkwood_dma_new, | 339 | .pcm_new = kirkwood_dma_new, |
372 | .pcm_free = kirkwood_dma_free_dma_buffers, | 340 | .pcm_free = kirkwood_dma_free_dma_buffers, |
373 | }; | 341 | }; |
374 | |||
375 | static int kirkwood_soc_platform_probe(struct platform_device *pdev) | ||
376 | { | ||
377 | return snd_soc_register_platform(&pdev->dev, &kirkwood_soc_platform); | ||
378 | } | ||
379 | |||
380 | static int kirkwood_soc_platform_remove(struct platform_device *pdev) | ||
381 | { | ||
382 | snd_soc_unregister_platform(&pdev->dev); | ||
383 | return 0; | ||
384 | } | ||
385 | |||
386 | static struct platform_driver kirkwood_pcm_driver = { | ||
387 | .driver = { | ||
388 | .name = "kirkwood-pcm-audio", | ||
389 | .owner = THIS_MODULE, | ||
390 | }, | ||
391 | |||
392 | .probe = kirkwood_soc_platform_probe, | ||
393 | .remove = kirkwood_soc_platform_remove, | ||
394 | }; | ||
395 | |||
396 | module_platform_driver(kirkwood_pcm_driver); | ||
397 | |||
398 | MODULE_AUTHOR("Arnaud Patard <arnaud.patard@rtp-net.org>"); | ||
399 | MODULE_DESCRIPTION("Marvell Kirkwood Audio DMA module"); | ||
400 | MODULE_LICENSE("GPL"); | ||
401 | MODULE_ALIAS("platform:kirkwood-pcm-audio"); | ||