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/initval.h>
26 #include <sound/pcm.h>
27 #include <sound/pcm_params.h>
28 #include <sound/soc.h>
32 #include <mach/irqs.h>
37 struct imx_pcm_runtime_data
{
41 unsigned long last_offset
;
45 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
;
54 struct snd_pcm_runtime
*runtime
= substream
->runtime
;
58 if (!atomic_read(&iprtd
->running
))
59 return HRTIMER_NORESTART
;
63 if (substream
->stream
== SNDRV_PCM_STREAM_PLAYBACK
)
64 iprtd
->offset
= regs
.ARM_r8
& 0xffff;
66 iprtd
->offset
= regs
.ARM_r9
& 0xffff;
68 /* How much data have we transferred since the last period report? */
69 if (iprtd
->offset
>= iprtd
->last_offset
)
70 delta
= iprtd
->offset
- iprtd
->last_offset
;
72 delta
= runtime
->buffer_size
+ iprtd
->offset
75 /* If we've transferred at least a period then report it and
76 * reset our poll time */
77 if (delta
>= iprtd
->period
) {
78 snd_pcm_period_elapsed(substream
);
79 iprtd
->last_offset
= iprtd
->offset
;
82 hrtimer_forward_now(hrt
, ns_to_ktime(iprtd
->poll_time_ns
));
84 return HRTIMER_RESTART
;
87 static struct fiq_handler fh
= {
91 static int snd_imx_pcm_hw_params(struct snd_pcm_substream
*substream
,
92 struct snd_pcm_hw_params
*params
)
94 struct snd_pcm_runtime
*runtime
= substream
->runtime
;
95 struct imx_pcm_runtime_data
*iprtd
= runtime
->private_data
;
97 iprtd
->size
= params_buffer_bytes(params
);
98 iprtd
->periods
= params_periods(params
);
99 iprtd
->period
= params_period_bytes(params
) ;
101 iprtd
->last_offset
= 0;
102 iprtd
->poll_time_ns
= 1000000000 / params_rate(params
) *
103 params_period_size(params
);
104 snd_pcm_set_runtime_buffer(substream
, &substream
->dma_buffer
);
109 static int snd_imx_pcm_prepare(struct snd_pcm_substream
*substream
)
111 struct snd_pcm_runtime
*runtime
= substream
->runtime
;
112 struct imx_pcm_runtime_data
*iprtd
= runtime
->private_data
;
116 if (substream
->stream
== SNDRV_PCM_STREAM_PLAYBACK
)
117 regs
.ARM_r8
= (iprtd
->period
* iprtd
->periods
- 1) << 16;
119 regs
.ARM_r9
= (iprtd
->period
* iprtd
->periods
- 1) << 16;
126 static int fiq_enable
;
127 static int imx_pcm_fiq
;
129 static int snd_imx_pcm_trigger(struct snd_pcm_substream
*substream
, int cmd
)
131 struct snd_pcm_runtime
*runtime
= substream
->runtime
;
132 struct imx_pcm_runtime_data
*iprtd
= runtime
->private_data
;
135 case SNDRV_PCM_TRIGGER_START
:
136 case SNDRV_PCM_TRIGGER_RESUME
:
137 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE
:
138 atomic_set(&iprtd
->running
, 1);
139 hrtimer_start(&iprtd
->hrt
, ns_to_ktime(iprtd
->poll_time_ns
),
141 if (++fiq_enable
== 1)
142 enable_fiq(imx_pcm_fiq
);
146 case SNDRV_PCM_TRIGGER_STOP
:
147 case SNDRV_PCM_TRIGGER_SUSPEND
:
148 case SNDRV_PCM_TRIGGER_PAUSE_PUSH
:
149 atomic_set(&iprtd
->running
, 0);
151 if (--fiq_enable
== 0)
152 disable_fiq(imx_pcm_fiq
);
162 static snd_pcm_uframes_t
snd_imx_pcm_pointer(struct snd_pcm_substream
*substream
)
164 struct snd_pcm_runtime
*runtime
= substream
->runtime
;
165 struct imx_pcm_runtime_data
*iprtd
= runtime
->private_data
;
167 return bytes_to_frames(substream
->runtime
, iprtd
->offset
);
170 static struct snd_pcm_hardware snd_imx_hardware
= {
171 .info
= SNDRV_PCM_INFO_INTERLEAVED
|
172 SNDRV_PCM_INFO_BLOCK_TRANSFER
|
173 SNDRV_PCM_INFO_MMAP
|
174 SNDRV_PCM_INFO_MMAP_VALID
|
175 SNDRV_PCM_INFO_PAUSE
|
176 SNDRV_PCM_INFO_RESUME
,
177 .formats
= SNDRV_PCM_FMTBIT_S16_LE
,
181 .buffer_bytes_max
= IMX_SSI_DMABUF_SIZE
,
182 .period_bytes_min
= 128,
183 .period_bytes_max
= 16 * 1024,
189 static int snd_imx_open(struct snd_pcm_substream
*substream
)
191 struct snd_pcm_runtime
*runtime
= substream
->runtime
;
192 struct imx_pcm_runtime_data
*iprtd
;
195 iprtd
= kzalloc(sizeof(*iprtd
), GFP_KERNEL
);
198 runtime
->private_data
= iprtd
;
200 iprtd
->substream
= substream
;
202 atomic_set(&iprtd
->running
, 0);
203 hrtimer_init(&iprtd
->hrt
, CLOCK_MONOTONIC
, HRTIMER_MODE_REL
);
204 iprtd
->hrt
.function
= snd_hrtimer_callback
;
206 ret
= snd_pcm_hw_constraint_integer(substream
->runtime
,
207 SNDRV_PCM_HW_PARAM_PERIODS
);
213 snd_soc_set_runtime_hwparams(substream
, &snd_imx_hardware
);
217 static int snd_imx_close(struct snd_pcm_substream
*substream
)
219 struct snd_pcm_runtime
*runtime
= substream
->runtime
;
220 struct imx_pcm_runtime_data
*iprtd
= runtime
->private_data
;
222 hrtimer_cancel(&iprtd
->hrt
);
229 static struct snd_pcm_ops imx_pcm_ops
= {
230 .open
= snd_imx_open
,
231 .close
= snd_imx_close
,
232 .ioctl
= snd_pcm_lib_ioctl
,
233 .hw_params
= snd_imx_pcm_hw_params
,
234 .prepare
= snd_imx_pcm_prepare
,
235 .trigger
= snd_imx_pcm_trigger
,
236 .pointer
= snd_imx_pcm_pointer
,
237 .mmap
= snd_imx_pcm_mmap
,
240 static int ssi_irq
= 0;
242 static int imx_pcm_fiq_new(struct snd_soc_pcm_runtime
*rtd
)
244 struct snd_pcm
*pcm
= rtd
->pcm
;
245 struct snd_pcm_substream
*substream
;
248 ret
= imx_pcm_new(rtd
);
252 substream
= pcm
->streams
[SNDRV_PCM_STREAM_PLAYBACK
].substream
;
254 struct snd_dma_buffer
*buf
= &substream
->dma_buffer
;
256 imx_ssi_fiq_tx_buffer
= (unsigned long)buf
->area
;
259 substream
= pcm
->streams
[SNDRV_PCM_STREAM_CAPTURE
].substream
;
261 struct snd_dma_buffer
*buf
= &substream
->dma_buffer
;
263 imx_ssi_fiq_rx_buffer
= (unsigned long)buf
->area
;
266 set_fiq_handler(&imx_ssi_fiq_start
,
267 &imx_ssi_fiq_end
- &imx_ssi_fiq_start
);
272 static void imx_pcm_fiq_free(struct snd_pcm
*pcm
)
274 mxc_set_irq_fiq(ssi_irq
, 0);
279 static struct snd_soc_platform_driver imx_soc_platform_fiq
= {
281 .pcm_new
= imx_pcm_fiq_new
,
282 .pcm_free
= imx_pcm_fiq_free
,
285 static int __devinit
imx_soc_platform_probe(struct platform_device
*pdev
)
287 struct imx_ssi
*ssi
= platform_get_drvdata(pdev
);
290 ret
= claim_fiq(&fh
);
292 dev_err(&pdev
->dev
, "failed to claim fiq: %d", ret
);
296 mxc_set_irq_fiq(ssi
->irq
, 1);
299 imx_pcm_fiq
= ssi
->irq
;
301 imx_ssi_fiq_base
= (unsigned long)ssi
->base
;
303 ssi
->dma_params_tx
.burstsize
= 4;
304 ssi
->dma_params_rx
.burstsize
= 6;
306 ret
= snd_soc_register_platform(&pdev
->dev
, &imx_soc_platform_fiq
);
308 goto failed_register
;
313 mxc_set_irq_fiq(ssi_irq
, 0);
319 static int __devexit
imx_soc_platform_remove(struct platform_device
*pdev
)
321 snd_soc_unregister_platform(&pdev
->dev
);
325 static struct platform_driver imx_pcm_driver
= {
327 .name
= "imx-fiq-pcm-audio",
328 .owner
= THIS_MODULE
,
331 .probe
= imx_soc_platform_probe
,
332 .remove
= __devexit_p(imx_soc_platform_remove
),
335 module_platform_driver(imx_pcm_driver
);
337 MODULE_LICENSE("GPL");