2 * imx-pcm-fiq.c -- ALSA Soc Audio Layer
4 * Copyright 2009 Sascha Hauer <s.hauer@pengutronix.de>
6 * This code is based on code copyrighted by Freescale,
7 * Liam Girdwood, Javier Martin and probably others.
9 * This program is free software; you can redistribute it and/or modify it
10 * under the terms of the GNU General Public License as published by the
11 * Free Software Foundation; either version 2 of the License, or (at your
12 * option) any later version.
14 #include <linux/clk.h>
15 #include <linux/delay.h>
16 #include <linux/device.h>
17 #include <linux/dma-mapping.h>
18 #include <linux/init.h>
19 #include <linux/interrupt.h>
20 #include <linux/module.h>
21 #include <linux/platform_device.h>
22 #include <linux/slab.h>
24 #include <sound/core.h>
25 #include <sound/dmaengine_pcm.h>
26 #include <sound/initval.h>
27 #include <sound/pcm.h>
28 #include <sound/pcm_params.h>
29 #include <sound/soc.h>
33 #include <linux/platform_data/asoc-imx-ssi.h>
38 struct imx_pcm_runtime_data
{
44 struct snd_pcm_substream
*substream
;
49 static enum hrtimer_restart
snd_hrtimer_callback(struct hrtimer
*hrt
)
51 struct imx_pcm_runtime_data
*iprtd
=
52 container_of(hrt
, struct imx_pcm_runtime_data
, hrt
);
53 struct snd_pcm_substream
*substream
= iprtd
->substream
;
56 if (!atomic_read(&iprtd
->playing
) && !atomic_read(&iprtd
->capturing
))
57 return HRTIMER_NORESTART
;
61 if (substream
->stream
== SNDRV_PCM_STREAM_PLAYBACK
)
62 iprtd
->offset
= regs
.ARM_r8
& 0xffff;
64 iprtd
->offset
= regs
.ARM_r9
& 0xffff;
66 snd_pcm_period_elapsed(substream
);
68 hrtimer_forward_now(hrt
, ns_to_ktime(iprtd
->poll_time_ns
));
70 return HRTIMER_RESTART
;
73 static struct fiq_handler fh
= {
77 static int snd_imx_pcm_hw_params(struct snd_pcm_substream
*substream
,
78 struct snd_pcm_hw_params
*params
)
80 struct snd_pcm_runtime
*runtime
= substream
->runtime
;
81 struct imx_pcm_runtime_data
*iprtd
= runtime
->private_data
;
83 iprtd
->periods
= params_periods(params
);
84 iprtd
->period
= params_period_bytes(params
);
86 iprtd
->poll_time_ns
= 1000000000 / params_rate(params
) *
87 params_period_size(params
);
88 snd_pcm_set_runtime_buffer(substream
, &substream
->dma_buffer
);
93 static int snd_imx_pcm_prepare(struct snd_pcm_substream
*substream
)
95 struct snd_pcm_runtime
*runtime
= substream
->runtime
;
96 struct imx_pcm_runtime_data
*iprtd
= runtime
->private_data
;
100 if (substream
->stream
== SNDRV_PCM_STREAM_PLAYBACK
)
101 regs
.ARM_r8
= (iprtd
->period
* iprtd
->periods
- 1) << 16;
103 regs
.ARM_r9
= (iprtd
->period
* iprtd
->periods
- 1) << 16;
110 static int imx_pcm_fiq
;
112 static int snd_imx_pcm_trigger(struct snd_pcm_substream
*substream
, int cmd
)
114 struct snd_pcm_runtime
*runtime
= substream
->runtime
;
115 struct imx_pcm_runtime_data
*iprtd
= runtime
->private_data
;
118 case SNDRV_PCM_TRIGGER_START
:
119 case SNDRV_PCM_TRIGGER_RESUME
:
120 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE
:
121 if (substream
->stream
== SNDRV_PCM_STREAM_PLAYBACK
)
122 atomic_set(&iprtd
->playing
, 1);
124 atomic_set(&iprtd
->capturing
, 1);
125 hrtimer_start(&iprtd
->hrt
, ns_to_ktime(iprtd
->poll_time_ns
),
127 enable_fiq(imx_pcm_fiq
);
130 case SNDRV_PCM_TRIGGER_STOP
:
131 case SNDRV_PCM_TRIGGER_SUSPEND
:
132 case SNDRV_PCM_TRIGGER_PAUSE_PUSH
:
133 if (substream
->stream
== SNDRV_PCM_STREAM_PLAYBACK
)
134 atomic_set(&iprtd
->playing
, 0);
136 atomic_set(&iprtd
->capturing
, 0);
137 if (!atomic_read(&iprtd
->playing
) &&
138 !atomic_read(&iprtd
->capturing
))
139 disable_fiq(imx_pcm_fiq
);
149 static snd_pcm_uframes_t
snd_imx_pcm_pointer(struct snd_pcm_substream
*substream
)
151 struct snd_pcm_runtime
*runtime
= substream
->runtime
;
152 struct imx_pcm_runtime_data
*iprtd
= runtime
->private_data
;
154 return bytes_to_frames(substream
->runtime
, iprtd
->offset
);
157 static struct snd_pcm_hardware snd_imx_hardware
= {
158 .info
= SNDRV_PCM_INFO_INTERLEAVED
|
159 SNDRV_PCM_INFO_BLOCK_TRANSFER
|
160 SNDRV_PCM_INFO_MMAP
|
161 SNDRV_PCM_INFO_MMAP_VALID
|
162 SNDRV_PCM_INFO_PAUSE
|
163 SNDRV_PCM_INFO_RESUME
,
164 .formats
= SNDRV_PCM_FMTBIT_S16_LE
,
165 .buffer_bytes_max
= IMX_SSI_DMABUF_SIZE
,
166 .period_bytes_min
= 128,
167 .period_bytes_max
= 16 * 1024,
173 static int snd_imx_open(struct snd_pcm_substream
*substream
)
175 struct snd_pcm_runtime
*runtime
= substream
->runtime
;
176 struct imx_pcm_runtime_data
*iprtd
;
179 iprtd
= kzalloc(sizeof(*iprtd
), GFP_KERNEL
);
182 runtime
->private_data
= iprtd
;
184 iprtd
->substream
= substream
;
186 atomic_set(&iprtd
->playing
, 0);
187 atomic_set(&iprtd
->capturing
, 0);
188 hrtimer_init(&iprtd
->hrt
, CLOCK_MONOTONIC
, HRTIMER_MODE_REL
);
189 iprtd
->hrt
.function
= snd_hrtimer_callback
;
191 ret
= snd_pcm_hw_constraint_integer(substream
->runtime
,
192 SNDRV_PCM_HW_PARAM_PERIODS
);
198 snd_soc_set_runtime_hwparams(substream
, &snd_imx_hardware
);
202 static int snd_imx_close(struct snd_pcm_substream
*substream
)
204 struct snd_pcm_runtime
*runtime
= substream
->runtime
;
205 struct imx_pcm_runtime_data
*iprtd
= runtime
->private_data
;
207 hrtimer_cancel(&iprtd
->hrt
);
214 static int snd_imx_pcm_mmap(struct snd_pcm_substream
*substream
,
215 struct vm_area_struct
*vma
)
217 struct snd_pcm_runtime
*runtime
= substream
->runtime
;
220 ret
= dma_mmap_writecombine(substream
->pcm
->card
->dev
, vma
,
221 runtime
->dma_area
, runtime
->dma_addr
, runtime
->dma_bytes
);
223 pr_debug("%s: ret: %d %p 0x%08x 0x%08x\n", __func__
, ret
,
230 static struct snd_pcm_ops imx_pcm_ops
= {
231 .open
= snd_imx_open
,
232 .close
= snd_imx_close
,
233 .ioctl
= snd_pcm_lib_ioctl
,
234 .hw_params
= snd_imx_pcm_hw_params
,
235 .prepare
= snd_imx_pcm_prepare
,
236 .trigger
= snd_imx_pcm_trigger
,
237 .pointer
= snd_imx_pcm_pointer
,
238 .mmap
= snd_imx_pcm_mmap
,
241 static int imx_pcm_preallocate_dma_buffer(struct snd_pcm
*pcm
, int stream
)
243 struct snd_pcm_substream
*substream
= pcm
->streams
[stream
].substream
;
244 struct snd_dma_buffer
*buf
= &substream
->dma_buffer
;
245 size_t size
= IMX_SSI_DMABUF_SIZE
;
247 buf
->dev
.type
= SNDRV_DMA_TYPE_DEV
;
248 buf
->dev
.dev
= pcm
->card
->dev
;
249 buf
->private_data
= NULL
;
250 buf
->area
= dma_alloc_writecombine(pcm
->card
->dev
, size
,
251 &buf
->addr
, GFP_KERNEL
);
259 static int imx_pcm_new(struct snd_soc_pcm_runtime
*rtd
)
261 struct snd_card
*card
= rtd
->card
->snd_card
;
262 struct snd_pcm
*pcm
= rtd
->pcm
;
265 ret
= dma_coerce_mask_and_coherent(card
->dev
, DMA_BIT_MASK(32));
269 if (pcm
->streams
[SNDRV_PCM_STREAM_PLAYBACK
].substream
) {
270 ret
= imx_pcm_preallocate_dma_buffer(pcm
,
271 SNDRV_PCM_STREAM_PLAYBACK
);
276 if (pcm
->streams
[SNDRV_PCM_STREAM_CAPTURE
].substream
) {
277 ret
= imx_pcm_preallocate_dma_buffer(pcm
,
278 SNDRV_PCM_STREAM_CAPTURE
);
286 static int ssi_irq
= 0;
288 static int imx_pcm_fiq_new(struct snd_soc_pcm_runtime
*rtd
)
290 struct snd_pcm
*pcm
= rtd
->pcm
;
291 struct snd_pcm_substream
*substream
;
294 ret
= imx_pcm_new(rtd
);
298 substream
= pcm
->streams
[SNDRV_PCM_STREAM_PLAYBACK
].substream
;
300 struct snd_dma_buffer
*buf
= &substream
->dma_buffer
;
302 imx_ssi_fiq_tx_buffer
= (unsigned long)buf
->area
;
305 substream
= pcm
->streams
[SNDRV_PCM_STREAM_CAPTURE
].substream
;
307 struct snd_dma_buffer
*buf
= &substream
->dma_buffer
;
309 imx_ssi_fiq_rx_buffer
= (unsigned long)buf
->area
;
312 set_fiq_handler(&imx_ssi_fiq_start
,
313 &imx_ssi_fiq_end
- &imx_ssi_fiq_start
);
318 static void imx_pcm_free(struct snd_pcm
*pcm
)
320 struct snd_pcm_substream
*substream
;
321 struct snd_dma_buffer
*buf
;
324 for (stream
= 0; stream
< 2; stream
++) {
325 substream
= pcm
->streams
[stream
].substream
;
329 buf
= &substream
->dma_buffer
;
333 dma_free_writecombine(pcm
->card
->dev
, buf
->bytes
,
334 buf
->area
, buf
->addr
);
339 static void imx_pcm_fiq_free(struct snd_pcm
*pcm
)
341 mxc_set_irq_fiq(ssi_irq
, 0);
346 static struct snd_soc_platform_driver imx_soc_platform_fiq
= {
348 .pcm_new
= imx_pcm_fiq_new
,
349 .pcm_free
= imx_pcm_fiq_free
,
352 int imx_pcm_fiq_init(struct platform_device
*pdev
,
353 struct imx_pcm_fiq_params
*params
)
357 ret
= claim_fiq(&fh
);
359 dev_err(&pdev
->dev
, "failed to claim fiq: %d", ret
);
363 mxc_set_irq_fiq(params
->irq
, 1);
364 ssi_irq
= params
->irq
;
366 imx_pcm_fiq
= params
->irq
;
368 imx_ssi_fiq_base
= (unsigned long)params
->base
;
370 params
->dma_params_tx
->maxburst
= 4;
371 params
->dma_params_rx
->maxburst
= 6;
373 ret
= snd_soc_register_platform(&pdev
->dev
, &imx_soc_platform_fiq
);
375 goto failed_register
;
380 mxc_set_irq_fiq(ssi_irq
, 0);
385 EXPORT_SYMBOL_GPL(imx_pcm_fiq_init
);
387 void imx_pcm_fiq_exit(struct platform_device
*pdev
)
389 snd_soc_unregister_platform(&pdev
->dev
);
391 EXPORT_SYMBOL_GPL(imx_pcm_fiq_exit
);
393 MODULE_LICENSE("GPL");