← Back to branch summary

~ubuntu-branches/ubuntu/precise/linux-lowlatency/precise

« back to all changes in this revision

Viewing changes to sound/soc/imx/imx-pcm-dma-mx2.c

  • Committer: Package Import Robot
  • Author(s): Alessio Igor Bogani
  • Date: 2011-10-26 11:13:05 UTC
  • Revision ID: package-import@ubuntu.com-20111026111305-tz023xykf0i6eosh
Tags: upstream-3.2.0
Import upstream version 3.2.0

Show diffs side-by-side

added added

removed removed

Lines of Context:
sound/soc/imx/imx-pcm-dma-mx2.c
 
1
/*
 
2
 * imx-pcm-dma-mx2.c  --  ALSA Soc Audio Layer
 
3
 *
 
4
 * Copyright 2009 Sascha Hauer <s.hauer@pengutronix.de>
 
5
 *
 
6
 * This code is based on code copyrighted by Freescale,
 
7
 * Liam Girdwood, Javier Martin and probably others.
 
8
 *
 
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.
 
13
 */
 
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>
 
23
#include <linux/dmaengine.h>
 
24
 
 
25
#include <sound/core.h>
 
26
#include <sound/initval.h>
 
27
#include <sound/pcm.h>
 
28
#include <sound/pcm_params.h>
 
29
#include <sound/soc.h>
 
30
 
 
31
#include <mach/dma.h>
 
32
 
 
33
#include "imx-ssi.h"
 
34
 
 
35
struct imx_pcm_runtime_data {
 
36
        int period_bytes;
 
37
        int periods;
 
38
        int dma;
 
39
        unsigned long offset;
 
40
        unsigned long size;
 
41
        void *buf;
 
42
        int period_time;
 
43
        struct dma_async_tx_descriptor *desc;
 
44
        struct dma_chan *dma_chan;
 
45
        struct imx_dma_data dma_data;
 
46
};
 
47
 
 
48
static void audio_dma_irq(void *data)
 
49
{
 
50
        struct snd_pcm_substream *substream = (struct snd_pcm_substream *)data;
 
51
        struct snd_pcm_runtime *runtime = substream->runtime;
 
52
        struct imx_pcm_runtime_data *iprtd = runtime->private_data;
 
53
 
 
54
        iprtd->offset += iprtd->period_bytes;
 
55
        iprtd->offset %= iprtd->period_bytes * iprtd->periods;
 
56
 
 
57
        snd_pcm_period_elapsed(substream);
 
58
}
 
59
 
 
60
static bool filter(struct dma_chan *chan, void *param)
 
61
{
 
62
        struct imx_pcm_runtime_data *iprtd = param;
 
63
 
 
64
        if (!imx_dma_is_general_purpose(chan))
 
65
                return false;
 
66
 
 
67
        chan->private = &iprtd->dma_data;
 
68
 
 
69
        return true;
 
70
}
 
71
 
 
72
static int imx_ssi_dma_alloc(struct snd_pcm_substream *substream,
 
73
                                struct snd_pcm_hw_params *params)
 
74
{
 
75
        struct snd_soc_pcm_runtime *rtd = substream->private_data;
 
76
        struct imx_pcm_dma_params *dma_params;
 
77
        struct snd_pcm_runtime *runtime = substream->runtime;
 
78
        struct imx_pcm_runtime_data *iprtd = runtime->private_data;
 
79
        struct dma_slave_config slave_config;
 
80
        dma_cap_mask_t mask;
 
81
        enum dma_slave_buswidth buswidth;
 
82
        int ret;
 
83
 
 
84
        dma_params = snd_soc_dai_get_dma_data(rtd->cpu_dai, substream);
 
85
 
 
86
        iprtd->dma_data.peripheral_type = IMX_DMATYPE_SSI;
 
87
        iprtd->dma_data.priority = DMA_PRIO_HIGH;
 
88
        iprtd->dma_data.dma_request = dma_params->dma;
 
89
 
 
90
        /* Try to grab a DMA channel */
 
91
        dma_cap_zero(mask);
 
92
        dma_cap_set(DMA_SLAVE, mask);
 
93
        iprtd->dma_chan = dma_request_channel(mask, filter, iprtd);
 
94
        if (!iprtd->dma_chan)
 
95
                return -EINVAL;
 
96
 
 
97
        switch (params_format(params)) {
 
98
        case SNDRV_PCM_FORMAT_S16_LE:
 
99
                buswidth = DMA_SLAVE_BUSWIDTH_2_BYTES;
 
100
                break;
 
101
        case SNDRV_PCM_FORMAT_S20_3LE:
 
102
        case SNDRV_PCM_FORMAT_S24_LE:
 
103
                buswidth = DMA_SLAVE_BUSWIDTH_4_BYTES;
 
104
                break;
 
105
        default:
 
106
                return 0;
 
107
        }
 
108
 
 
109
        if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
 
110
                slave_config.direction = DMA_TO_DEVICE;
 
111
                slave_config.dst_addr = dma_params->dma_addr;
 
112
                slave_config.dst_addr_width = buswidth;
 
113
                slave_config.dst_maxburst = dma_params->burstsize;
 
114
        } else {
 
115
                slave_config.direction = DMA_FROM_DEVICE;
 
116
                slave_config.src_addr = dma_params->dma_addr;
 
117
                slave_config.src_addr_width = buswidth;
 
118
                slave_config.src_maxburst = dma_params->burstsize;
 
119
        }
 
120
 
 
121
        ret = dmaengine_slave_config(iprtd->dma_chan, &slave_config);
 
122
        if (ret)
 
123
                return ret;
 
124
 
 
125
        return 0;
 
126
}
 
127
 
 
128
static int snd_imx_pcm_hw_params(struct snd_pcm_substream *substream,
 
129
                                struct snd_pcm_hw_params *params)
 
130
{
 
131
        struct snd_soc_pcm_runtime *rtd = substream->private_data;
 
132
        struct snd_pcm_runtime *runtime = substream->runtime;
 
133
        struct imx_pcm_runtime_data *iprtd = runtime->private_data;
 
134
        unsigned long dma_addr;
 
135
        struct dma_chan *chan;
 
136
        struct imx_pcm_dma_params *dma_params;
 
137
        int ret;
 
138
 
 
139
        dma_params = snd_soc_dai_get_dma_data(rtd->cpu_dai, substream);
 
140
        ret = imx_ssi_dma_alloc(substream, params);
 
141
        if (ret)
 
142
                return ret;
 
143
        chan = iprtd->dma_chan;
 
144
 
 
145
        iprtd->size = params_buffer_bytes(params);
 
146
        iprtd->periods = params_periods(params);
 
147
        iprtd->period_bytes = params_period_bytes(params);
 
148
        iprtd->offset = 0;
 
149
        iprtd->period_time = HZ / (params_rate(params) /
 
150
                        params_period_size(params));
 
151
 
 
152
        snd_pcm_set_runtime_buffer(substream, &substream->dma_buffer);
 
153
 
 
154
        dma_addr = runtime->dma_addr;
 
155
 
 
156
        iprtd->buf = (unsigned int *)substream->dma_buffer.area;
 
157
 
 
158
        iprtd->desc = chan->device->device_prep_dma_cyclic(chan, dma_addr,
 
159
                        iprtd->period_bytes * iprtd->periods,
 
160
                        iprtd->period_bytes,
 
161
                        substream->stream == SNDRV_PCM_STREAM_PLAYBACK ?
 
162
                        DMA_TO_DEVICE : DMA_FROM_DEVICE);
 
163
        if (!iprtd->desc) {
 
164
                dev_err(&chan->dev->device, "cannot prepare slave dma\n");
 
165
                return -EINVAL;
 
166
        }
 
167
 
 
168
        iprtd->desc->callback = audio_dma_irq;
 
169
        iprtd->desc->callback_param = substream;
 
170
 
 
171
        return 0;
 
172
}
 
173
 
 
174
static int snd_imx_pcm_hw_free(struct snd_pcm_substream *substream)
 
175
{
 
176
        struct snd_pcm_runtime *runtime = substream->runtime;
 
177
        struct imx_pcm_runtime_data *iprtd = runtime->private_data;
 
178
 
 
179
        if (iprtd->dma_chan) {
 
180
                dma_release_channel(iprtd->dma_chan);
 
181
                iprtd->dma_chan = NULL;
 
182
        }
 
183
 
 
184
        return 0;
 
185
}
 
186
 
 
187
static int snd_imx_pcm_prepare(struct snd_pcm_substream *substream)
 
188
{
 
189
        struct snd_soc_pcm_runtime *rtd = substream->private_data;
 
190
        struct imx_pcm_dma_params *dma_params;
 
191
 
 
192
        dma_params = snd_soc_dai_get_dma_data(rtd->cpu_dai, substream);
 
193
 
 
194
        return 0;
 
195
}
 
196
 
 
197
static int snd_imx_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
 
198
{
 
199
        struct snd_pcm_runtime *runtime = substream->runtime;
 
200
        struct imx_pcm_runtime_data *iprtd = runtime->private_data;
 
201
 
 
202
        switch (cmd) {
 
203
        case SNDRV_PCM_TRIGGER_START:
 
204
        case SNDRV_PCM_TRIGGER_RESUME:
 
205
        case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
 
206
                dmaengine_submit(iprtd->desc);
 
207
 
 
208
                break;
 
209
 
 
210
        case SNDRV_PCM_TRIGGER_STOP:
 
211
        case SNDRV_PCM_TRIGGER_SUSPEND:
 
212
        case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
 
213
                dmaengine_terminate_all(iprtd->dma_chan);
 
214
 
 
215
                break;
 
216
        default:
 
217
                return -EINVAL;
 
218
        }
 
219
 
 
220
        return 0;
 
221
}
 
222
 
 
223
static snd_pcm_uframes_t snd_imx_pcm_pointer(struct snd_pcm_substream *substream)
 
224
{
 
225
        struct snd_pcm_runtime *runtime = substream->runtime;
 
226
        struct imx_pcm_runtime_data *iprtd = runtime->private_data;
 
227
 
 
228
        pr_debug("%s: %ld %ld\n", __func__, iprtd->offset,
 
229
                        bytes_to_frames(substream->runtime, iprtd->offset));
 
230
 
 
231
        return bytes_to_frames(substream->runtime, iprtd->offset);
 
232
}
 
233
 
 
234
static struct snd_pcm_hardware snd_imx_hardware = {
 
235
        .info = SNDRV_PCM_INFO_INTERLEAVED |
 
236
                SNDRV_PCM_INFO_BLOCK_TRANSFER |
 
237
                SNDRV_PCM_INFO_MMAP |
 
238
                SNDRV_PCM_INFO_MMAP_VALID |
 
239
                SNDRV_PCM_INFO_PAUSE |
 
240
                SNDRV_PCM_INFO_RESUME,
 
241
        .formats = SNDRV_PCM_FMTBIT_S16_LE,
 
242
        .rate_min = 8000,
 
243
        .channels_min = 2,
 
244
        .channels_max = 2,
 
245
        .buffer_bytes_max = IMX_SSI_DMABUF_SIZE,
 
246
        .period_bytes_min = 128,
 
247
        .period_bytes_max = 65535, /* Limited by SDMA engine */
 
248
        .periods_min = 2,
 
249
        .periods_max = 255,
 
250
        .fifo_size = 0,
 
251
};
 
252
 
 
253
static int snd_imx_open(struct snd_pcm_substream *substream)
 
254
{
 
255
        struct snd_pcm_runtime *runtime = substream->runtime;
 
256
        struct imx_pcm_runtime_data *iprtd;
 
257
        int ret;
 
258
 
 
259
        iprtd = kzalloc(sizeof(*iprtd), GFP_KERNEL);
 
260
        if (iprtd == NULL)
 
261
                return -ENOMEM;
 
262
        runtime->private_data = iprtd;
 
263
 
 
264
        ret = snd_pcm_hw_constraint_integer(substream->runtime,
 
265
                        SNDRV_PCM_HW_PARAM_PERIODS);
 
266
        if (ret < 0) {
 
267
                kfree(iprtd);
 
268
                return ret;
 
269
        }
 
270
 
 
271
        snd_soc_set_runtime_hwparams(substream, &snd_imx_hardware);
 
272
 
 
273
        return 0;
 
274
}
 
275
 
 
276
static int snd_imx_close(struct snd_pcm_substream *substream)
 
277
{
 
278
        struct snd_pcm_runtime *runtime = substream->runtime;
 
279
        struct imx_pcm_runtime_data *iprtd = runtime->private_data;
 
280
 
 
281
        kfree(iprtd);
 
282
 
 
283
        return 0;
 
284
}
 
285
 
 
286
static struct snd_pcm_ops imx_pcm_ops = {
 
287
        .open           = snd_imx_open,
 
288
        .close          = snd_imx_close,
 
289
        .ioctl          = snd_pcm_lib_ioctl,
 
290
        .hw_params      = snd_imx_pcm_hw_params,
 
291
        .hw_free        = snd_imx_pcm_hw_free,
 
292
        .prepare        = snd_imx_pcm_prepare,
 
293
        .trigger        = snd_imx_pcm_trigger,
 
294
        .pointer        = snd_imx_pcm_pointer,
 
295
        .mmap           = snd_imx_pcm_mmap,
 
296
};
 
297
 
 
298
static struct snd_soc_platform_driver imx_soc_platform_mx2 = {
 
299
        .ops            = &imx_pcm_ops,
 
300
        .pcm_new        = imx_pcm_new,
 
301
        .pcm_free       = imx_pcm_free,
 
302
};
 
303
 
 
304
static int __devinit imx_soc_platform_probe(struct platform_device *pdev)
 
305
{
 
306
        struct imx_ssi *ssi = platform_get_drvdata(pdev);
 
307
 
 
308
        ssi->dma_params_tx.burstsize = 6;
 
309
        ssi->dma_params_rx.burstsize = 4;
 
310
 
 
311
        return snd_soc_register_platform(&pdev->dev, &imx_soc_platform_mx2);
 
312
}
 
313
 
 
314
static int __devexit imx_soc_platform_remove(struct platform_device *pdev)
 
315
{
 
316
        snd_soc_unregister_platform(&pdev->dev);
 
317
        return 0;
 
318
}
 
319
 
 
320
static struct platform_driver imx_pcm_driver = {
 
321
        .driver = {
 
322
                        .name = "imx-pcm-audio",
 
323
                        .owner = THIS_MODULE,
 
324
        },
 
325
        .probe = imx_soc_platform_probe,
 
326
        .remove = __devexit_p(imx_soc_platform_remove),
 
327
};
 
328
 
 
329
static int __init snd_imx_pcm_init(void)
 
330
{
 
331
        return platform_driver_register(&imx_pcm_driver);
 
332
}
 
333
module_init(snd_imx_pcm_init);
 
334
 
 
335
static void __exit snd_imx_pcm_exit(void)
 
336
{
 
337
        platform_driver_unregister(&imx_pcm_driver);
 
338
}
 
339
module_exit(snd_imx_pcm_exit);
 
340
MODULE_LICENSE("GPL");
 
341
MODULE_ALIAS("platform:imx-pcm-audio");