Blame view
sound/core/pcm_dmaengine.c
11.6 KB
e7f73a161 ASoC: Add dmaengi... |
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 |
/* * Copyright (C) 2012, Analog Devices Inc. * Author: Lars-Peter Clausen <lars@metafoo.de> * * Based on: * imx-pcm-dma-mx2.c, Copyright 2009 Sascha Hauer <s.hauer@pengutronix.de> * mxs-pcm.c, Copyright (C) 2011 Freescale Semiconductor, Inc. * ep93xx-pcm.c, Copyright (C) 2006 Lennert Buytenhek <buytenh@wantstofly.org> * Copyright (C) 2006 Applied Data Systems * * This program is free software; you can redistribute it and/or modify it * under the terms of the GNU General Public License as published by the * Free Software Foundation; either version 2 of the License, or (at your * option) any later version. * * You should have received a copy of the GNU General Public License along * with this program; if not, write to the Free Software Foundation, Inc., * 675 Mass Ave, Cambridge, MA 02139, USA. * */ #include <linux/module.h> #include <linux/init.h> #include <linux/dmaengine.h> #include <linux/slab.h> #include <sound/pcm.h> #include <sound/pcm_params.h> #include <sound/soc.h> #include <sound/dmaengine_pcm.h> struct dmaengine_pcm_runtime_data { struct dma_chan *dma_chan; |
3528f27a5 ASoC: dmaengine-p... |
33 |
dma_cookie_t cookie; |
e7f73a161 ASoC: Add dmaengi... |
34 35 |
unsigned int pos; |
e7f73a161 ASoC: Add dmaengi... |
36 37 38 39 40 41 42 |
}; static inline struct dmaengine_pcm_runtime_data *substream_to_prtd( const struct snd_pcm_substream *substream) { return substream->runtime->private_data; } |
e7f73a161 ASoC: Add dmaengi... |
43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 |
struct dma_chan *snd_dmaengine_pcm_get_chan(struct snd_pcm_substream *substream) { struct dmaengine_pcm_runtime_data *prtd = substream_to_prtd(substream); return prtd->dma_chan; } EXPORT_SYMBOL_GPL(snd_dmaengine_pcm_get_chan); /** * snd_hwparams_to_dma_slave_config - Convert hw_params to dma_slave_config * @substream: PCM substream * @params: hw_params * @slave_config: DMA slave config * * This function can be used to initialize a dma_slave_config from a substream * and hw_params in a dmaengine based PCM driver implementation. */ int snd_hwparams_to_dma_slave_config(const struct snd_pcm_substream *substream, const struct snd_pcm_hw_params *params, struct dma_slave_config *slave_config) { enum dma_slave_buswidth buswidth; |
a655f75c7 ALSA: pcm_dmaengi... |
65 |
int bits; |
e7f73a161 ASoC: Add dmaengi... |
66 |
|
732814c8f ALSA: pcm_dmaengi... |
67 |
bits = params_physical_width(params); |
a655f75c7 ALSA: pcm_dmaengi... |
68 69 70 |
if (bits < 8 || bits > 64) return -EINVAL; else if (bits == 8) |
e7f73a161 ASoC: Add dmaengi... |
71 |
buswidth = DMA_SLAVE_BUSWIDTH_1_BYTE; |
a655f75c7 ALSA: pcm_dmaengi... |
72 |
else if (bits == 16) |
e7f73a161 ASoC: Add dmaengi... |
73 |
buswidth = DMA_SLAVE_BUSWIDTH_2_BYTES; |
75f850fc2 ALSA: pcm_dmaengi... |
74 75 |
else if (bits == 24) buswidth = DMA_SLAVE_BUSWIDTH_3_BYTES; |
a655f75c7 ALSA: pcm_dmaengi... |
76 |
else if (bits <= 32) |
e7f73a161 ASoC: Add dmaengi... |
77 |
buswidth = DMA_SLAVE_BUSWIDTH_4_BYTES; |
a655f75c7 ALSA: pcm_dmaengi... |
78 79 |
else buswidth = DMA_SLAVE_BUSWIDTH_8_BYTES; |
e7f73a161 ASoC: Add dmaengi... |
80 81 82 83 84 85 86 87 |
if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { slave_config->direction = DMA_MEM_TO_DEV; slave_config->dst_addr_width = buswidth; } else { slave_config->direction = DMA_DEV_TO_MEM; slave_config->src_addr_width = buswidth; } |
5fa70f71d ASoC: dmaengine_p... |
88 |
slave_config->device_fc = false; |
e7f73a161 ASoC: Add dmaengi... |
89 90 91 |
return 0; } EXPORT_SYMBOL_GPL(snd_hwparams_to_dma_slave_config); |
85c9f9c5f ASoC: dmaengine-p... |
92 93 94 95 96 97 98 99 100 101 102 103 104 |
/** * snd_dmaengine_pcm_set_config_from_dai_data() - Initializes a dma slave config * using DAI DMA data. * @substream: PCM substream * @dma_data: DAI DMA data * @slave_config: DMA slave configuration * * Initializes the {dst,src}_addr, {dst,src}_maxburst, {dst,src}_addr_width and * slave_id fields of the DMA slave config from the same fields of the DAI DMA * data struct. The src and dst fields will be initialized depending on the * direction of the substream. If the substream is a playback stream the dst * fields will be initialized, if it is a capture stream the src fields will be * initialized. The {dst,src}_addr_width field will only be initialized if the |
73fe01cfb ASoC: dmaengine_p... |
105 106 107 |
* SND_DMAENGINE_PCM_DAI_FLAG_PACK flag is set or if the addr_width field of * the DAI DMA data struct is not equal to DMA_SLAVE_BUSWIDTH_UNDEFINED. If * both conditions are met the latter takes priority. |
85c9f9c5f ASoC: dmaengine-p... |
108 109 110 111 112 113 114 115 116 |
*/ void snd_dmaengine_pcm_set_config_from_dai_data( const struct snd_pcm_substream *substream, const struct snd_dmaengine_dai_dma_data *dma_data, struct dma_slave_config *slave_config) { if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { slave_config->dst_addr = dma_data->addr; slave_config->dst_maxburst = dma_data->maxburst; |
73fe01cfb ASoC: dmaengine_p... |
117 118 119 |
if (dma_data->flags & SND_DMAENGINE_PCM_DAI_FLAG_PACK) slave_config->dst_addr_width = DMA_SLAVE_BUSWIDTH_UNDEFINED; |
85c9f9c5f ASoC: dmaengine-p... |
120 121 122 123 124 |
if (dma_data->addr_width != DMA_SLAVE_BUSWIDTH_UNDEFINED) slave_config->dst_addr_width = dma_data->addr_width; } else { slave_config->src_addr = dma_data->addr; slave_config->src_maxburst = dma_data->maxburst; |
73fe01cfb ASoC: dmaengine_p... |
125 126 127 |
if (dma_data->flags & SND_DMAENGINE_PCM_DAI_FLAG_PACK) slave_config->src_addr_width = DMA_SLAVE_BUSWIDTH_UNDEFINED; |
85c9f9c5f ASoC: dmaengine-p... |
128 129 130 131 132 133 134 |
if (dma_data->addr_width != DMA_SLAVE_BUSWIDTH_UNDEFINED) slave_config->src_addr_width = dma_data->addr_width; } slave_config->slave_id = dma_data->slave_id; } EXPORT_SYMBOL_GPL(snd_dmaengine_pcm_set_config_from_dai_data); |
e7f73a161 ASoC: Add dmaengi... |
135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 |
static void dmaengine_pcm_dma_complete(void *arg) { struct snd_pcm_substream *substream = arg; struct dmaengine_pcm_runtime_data *prtd = substream_to_prtd(substream); prtd->pos += snd_pcm_lib_period_bytes(substream); if (prtd->pos >= snd_pcm_lib_buffer_bytes(substream)) prtd->pos = 0; snd_pcm_period_elapsed(substream); } static int dmaengine_pcm_prepare_and_submit(struct snd_pcm_substream *substream) { struct dmaengine_pcm_runtime_data *prtd = substream_to_prtd(substream); struct dma_chan *chan = prtd->dma_chan; struct dma_async_tx_descriptor *desc; enum dma_transfer_direction direction; |
e7736cdea dmaengine: Add fl... |
153 |
unsigned long flags = DMA_CTRL_ACK; |
e7f73a161 ASoC: Add dmaengi... |
154 155 |
direction = snd_pcm_substream_to_dma_direction(substream); |
e7736cdea dmaengine: Add fl... |
156 157 |
if (!substream->runtime->no_period_wakeup) flags |= DMA_PREP_INTERRUPT; |
7a08cf702 ASoC: dmaengine_p... |
158 |
prtd->pos = 0; |
41ba6b711 ASoC: dmaengine_p... |
159 |
desc = dmaengine_prep_dma_cyclic(chan, |
e7f73a161 ASoC: Add dmaengi... |
160 161 |
substream->runtime->dma_addr, snd_pcm_lib_buffer_bytes(substream), |
e7736cdea dmaengine: Add fl... |
162 |
snd_pcm_lib_period_bytes(substream), direction, flags); |
e7f73a161 ASoC: Add dmaengi... |
163 164 165 166 167 168 |
if (!desc) return -ENOMEM; desc->callback = dmaengine_pcm_dma_complete; desc->callback_param = substream; |
3528f27a5 ASoC: dmaengine-p... |
169 |
prtd->cookie = dmaengine_submit(desc); |
e7f73a161 ASoC: Add dmaengi... |
170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 |
return 0; } /** * snd_dmaengine_pcm_trigger - dmaengine based PCM trigger implementation * @substream: PCM substream * @cmd: Trigger command * * Returns 0 on success, a negative error code otherwise. * * This function can be used as the PCM trigger callback for dmaengine based PCM * driver implementations. */ int snd_dmaengine_pcm_trigger(struct snd_pcm_substream *substream, int cmd) { struct dmaengine_pcm_runtime_data *prtd = substream_to_prtd(substream); |
02fb05a59 ALSA: pcm_dmaengi... |
187 |
struct snd_pcm_runtime *runtime = substream->runtime; |
e7f73a161 ASoC: Add dmaengi... |
188 189 190 191 192 193 194 195 196 197 198 199 200 201 |
int ret; switch (cmd) { case SNDRV_PCM_TRIGGER_START: ret = dmaengine_pcm_prepare_and_submit(substream); if (ret) return ret; dma_async_issue_pending(prtd->dma_chan); break; case SNDRV_PCM_TRIGGER_RESUME: case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: dmaengine_resume(prtd->dma_chan); break; case SNDRV_PCM_TRIGGER_SUSPEND: |
02fb05a59 ALSA: pcm_dmaengi... |
202 203 204 |
if (runtime->info & SNDRV_PCM_INFO_PAUSE) dmaengine_pause(prtd->dma_chan); else |
bc0e73451 ALSA: pcm_dmaengi... |
205 |
dmaengine_terminate_async(prtd->dma_chan); |
02fb05a59 ALSA: pcm_dmaengi... |
206 |
break; |
e7f73a161 ASoC: Add dmaengi... |
207 208 209 210 |
case SNDRV_PCM_TRIGGER_PAUSE_PUSH: dmaengine_pause(prtd->dma_chan); break; case SNDRV_PCM_TRIGGER_STOP: |
bc0e73451 ALSA: pcm_dmaengi... |
211 |
dmaengine_terminate_async(prtd->dma_chan); |
e7f73a161 ASoC: Add dmaengi... |
212 213 214 215 216 217 218 219 220 221 |
break; default: return -EINVAL; } return 0; } EXPORT_SYMBOL_GPL(snd_dmaengine_pcm_trigger); /** |
9883ab229 ASoC: dmaengine-p... |
222 |
* snd_dmaengine_pcm_pointer_no_residue - dmaengine based PCM pointer implementation |
e7f73a161 ASoC: Add dmaengi... |
223 224 |
* @substream: PCM substream * |
9883ab229 ASoC: dmaengine-p... |
225 226 |
* This function is deprecated and should not be used by new drivers, as its * results may be unreliable. |
e7f73a161 ASoC: Add dmaengi... |
227 |
*/ |
9883ab229 ASoC: dmaengine-p... |
228 |
snd_pcm_uframes_t snd_dmaengine_pcm_pointer_no_residue(struct snd_pcm_substream *substream) |
e7f73a161 ASoC: Add dmaengi... |
229 230 231 232 |
{ struct dmaengine_pcm_runtime_data *prtd = substream_to_prtd(substream); return bytes_to_frames(substream->runtime, prtd->pos); } |
9883ab229 ASoC: dmaengine-p... |
233 |
EXPORT_SYMBOL_GPL(snd_dmaengine_pcm_pointer_no_residue); |
e7f73a161 ASoC: Add dmaengi... |
234 |
|
3528f27a5 ASoC: dmaengine-p... |
235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 |
/** * snd_dmaengine_pcm_pointer - dmaengine based PCM pointer implementation * @substream: PCM substream * * This function can be used as the PCM pointer callback for dmaengine based PCM * driver implementations. */ snd_pcm_uframes_t snd_dmaengine_pcm_pointer(struct snd_pcm_substream *substream) { struct dmaengine_pcm_runtime_data *prtd = substream_to_prtd(substream); struct dma_tx_state state; enum dma_status status; unsigned int buf_size; unsigned int pos = 0; status = dmaengine_tx_status(prtd->dma_chan, prtd->cookie, &state); if (status == DMA_IN_PROGRESS || status == DMA_PAUSED) { buf_size = snd_pcm_lib_buffer_bytes(substream); if (state.residue > 0 && state.residue <= buf_size) pos = buf_size - state.residue; } return bytes_to_frames(substream->runtime, pos); } EXPORT_SYMBOL_GPL(snd_dmaengine_pcm_pointer); |
c999836d3 ASoC: dmaengine_p... |
260 261 262 263 264 265 266 267 268 269 |
/** * snd_dmaengine_pcm_request_channel - Request channel for the dmaengine PCM * @filter_fn: Filter function used to request the DMA channel * @filter_data: Data passed to the DMA filter function * * Returns NULL or the requested DMA channel. * * This function request a DMA channel for usage with dmaengine PCM. */ struct dma_chan *snd_dmaengine_pcm_request_channel(dma_filter_fn filter_fn, |
7c1c1d4a7 ASoC: dmaengine-p... |
270 |
void *filter_data) |
e7f73a161 ASoC: Add dmaengi... |
271 272 273 274 275 276 |
{ dma_cap_mask_t mask; dma_cap_zero(mask); dma_cap_set(DMA_SLAVE, mask); dma_cap_set(DMA_CYCLIC, mask); |
e7f73a161 ASoC: Add dmaengi... |
277 |
|
7c1c1d4a7 ASoC: dmaengine-p... |
278 |
return dma_request_channel(mask, filter_fn, filter_data); |
e7f73a161 ASoC: Add dmaengi... |
279 |
} |
c999836d3 ASoC: dmaengine_p... |
280 |
EXPORT_SYMBOL_GPL(snd_dmaengine_pcm_request_channel); |
e7f73a161 ASoC: Add dmaengi... |
281 282 283 284 |
/** * snd_dmaengine_pcm_open - Open a dmaengine based PCM substream * @substream: PCM substream |
7c1c1d4a7 ASoC: dmaengine-p... |
285 |
* @chan: DMA channel to use for data transfers |
e7f73a161 ASoC: Add dmaengi... |
286 287 288 |
* * Returns 0 on success, a negative error code otherwise. * |
7c1c1d4a7 ASoC: dmaengine-p... |
289 290 |
* The function should usually be called from the pcm open callback. Note that * this function will use private_data field of the substream's runtime. So it |
1a6ab46fa ALSA: Fix spellin... |
291 |
* is not available to your pcm driver implementation. |
e7f73a161 ASoC: Add dmaengi... |
292 293 |
*/ int snd_dmaengine_pcm_open(struct snd_pcm_substream *substream, |
7c1c1d4a7 ASoC: dmaengine-p... |
294 |
struct dma_chan *chan) |
e7f73a161 ASoC: Add dmaengi... |
295 296 297 |
{ struct dmaengine_pcm_runtime_data *prtd; int ret; |
7c1c1d4a7 ASoC: dmaengine-p... |
298 299 |
if (!chan) return -ENXIO; |
e7f73a161 ASoC: Add dmaengi... |
300 301 302 303 304 305 306 307 |
ret = snd_pcm_hw_constraint_integer(substream->runtime, SNDRV_PCM_HW_PARAM_PERIODS); if (ret < 0) return ret; prtd = kzalloc(sizeof(*prtd), GFP_KERNEL); if (!prtd) return -ENOMEM; |
7c1c1d4a7 ASoC: dmaengine-p... |
308 |
prtd->dma_chan = chan; |
e7f73a161 ASoC: Add dmaengi... |
309 310 311 312 313 314 315 316 |
substream->runtime->private_data = prtd; return 0; } EXPORT_SYMBOL_GPL(snd_dmaengine_pcm_open); /** |
7c1c1d4a7 ASoC: dmaengine-p... |
317 318 319 320 321 322 323 324 325 326 |
* snd_dmaengine_pcm_open_request_chan - Open a dmaengine based PCM substream and request channel * @substream: PCM substream * @filter_fn: Filter function used to request the DMA channel * @filter_data: Data passed to the DMA filter function * * Returns 0 on success, a negative error code otherwise. * * This function will request a DMA channel using the passed filter function and * data. The function should usually be called from the pcm open callback. Note * that this function will use private_data field of the substream's runtime. So |
1a6ab46fa ALSA: Fix spellin... |
327 |
* it is not available to your pcm driver implementation. |
7c1c1d4a7 ASoC: dmaengine-p... |
328 329 330 331 332 |
*/ int snd_dmaengine_pcm_open_request_chan(struct snd_pcm_substream *substream, dma_filter_fn filter_fn, void *filter_data) { return snd_dmaengine_pcm_open(substream, |
c999836d3 ASoC: dmaengine_p... |
333 |
snd_dmaengine_pcm_request_channel(filter_fn, filter_data)); |
7c1c1d4a7 ASoC: dmaengine-p... |
334 335 336 337 |
} EXPORT_SYMBOL_GPL(snd_dmaengine_pcm_open_request_chan); /** |
e7f73a161 ASoC: Add dmaengi... |
338 339 340 341 342 343 |
* snd_dmaengine_pcm_close - Close a dmaengine based PCM substream * @substream: PCM substream */ int snd_dmaengine_pcm_close(struct snd_pcm_substream *substream) { struct dmaengine_pcm_runtime_data *prtd = substream_to_prtd(substream); |
bc0e73451 ALSA: pcm_dmaengi... |
344 |
dmaengine_synchronize(prtd->dma_chan); |
e7f73a161 ASoC: Add dmaengi... |
345 346 347 348 349 |
kfree(prtd); return 0; } EXPORT_SYMBOL_GPL(snd_dmaengine_pcm_close); |
cba69b4dc ASoC: dmaengine_p... |
350 |
|
7c1c1d4a7 ASoC: dmaengine-p... |
351 352 353 354 355 356 357 358 359 |
/** * snd_dmaengine_pcm_release_chan_close - Close a dmaengine based PCM substream and release channel * @substream: PCM substream * * Releases the DMA channel associated with the PCM substream. */ int snd_dmaengine_pcm_close_release_chan(struct snd_pcm_substream *substream) { struct dmaengine_pcm_runtime_data *prtd = substream_to_prtd(substream); |
bc0e73451 ALSA: pcm_dmaengi... |
360 |
dmaengine_synchronize(prtd->dma_chan); |
7c1c1d4a7 ASoC: dmaengine-p... |
361 |
dma_release_channel(prtd->dma_chan); |
bc0e73451 ALSA: pcm_dmaengi... |
362 |
kfree(prtd); |
7c1c1d4a7 ASoC: dmaengine-p... |
363 |
|
bc0e73451 ALSA: pcm_dmaengi... |
364 |
return 0; |
7c1c1d4a7 ASoC: dmaengine-p... |
365 366 |
} EXPORT_SYMBOL_GPL(snd_dmaengine_pcm_close_release_chan); |
cba69b4dc ASoC: dmaengine_p... |
367 |
MODULE_LICENSE("GPL"); |