SAFE public projects git trees. - safe/jmp/linux-2.6/blob - sound/soc/omap/omap-pcm.c

   1 /*
   2  * omap-pcm.c  --  ALSA PCM interface for the OMAP SoC
   3  *
   4  * Copyright (C) 2008 Nokia Corporation
   5  *
   6  * Contact: Jarkko Nikula <jhnikula@gmail.com>
   7  *          Peter Ujfalusi <peter.ujfalusi@nokia.com>
   8  *
   9  * This program is free software; you can redistribute it and/or
  10  * modify it under the terms of the GNU General Public License
  11  * version 2 as published by the Free Software Foundation.
  12  *
  13  * This program is distributed in the hope that it will be useful, but
  14  * WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  16  * General Public License for more details.
  17  *
  18  * You should have received a copy of the GNU General Public License
  19  * along with this program; if not, write to the Free Software
  20  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
  21  * 02110-1301 USA
  22  *
  23  */
  24
  25 #include <linux/dma-mapping.h>
  26 #include <sound/core.h>
  27 #include <sound/pcm.h>
  28 #include <sound/pcm_params.h>
  29 #include <sound/soc.h>
  30
  31 #include <plat/dma.h>
  32 #include "omap-pcm.h"
  33
  34 static const struct snd_pcm_hardware omap_pcm_hardware = {
  35         .info                   = SNDRV_PCM_INFO_MMAP |
  36                                   SNDRV_PCM_INFO_MMAP_VALID |
  37                                   SNDRV_PCM_INFO_INTERLEAVED |
  38                                   SNDRV_PCM_INFO_PAUSE |
  39                                   SNDRV_PCM_INFO_RESUME,
  40         .formats                = SNDRV_PCM_FMTBIT_S16_LE |
  41                                   SNDRV_PCM_FMTBIT_S32_LE,
  42         .period_bytes_min       = 32,
  43         .period_bytes_max       = 64 * 1024,
  44         .periods_min            = 2,
  45         .periods_max            = 255,
  46         .buffer_bytes_max       = 128 * 1024,
  47 };
  48
  49 struct omap_runtime_data {
  50         spinlock_t                      lock;
  51         struct omap_pcm_dma_data        *dma_data;
  52         int                             dma_ch;
  53         int                             period_index;
  54 };
  55
  56 static void omap_pcm_dma_irq(int ch, u16 stat, void *data)
  57 {
  58         struct snd_pcm_substream *substream = data;
  59         struct snd_pcm_runtime *runtime = substream->runtime;
  60         struct omap_runtime_data *prtd = runtime->private_data;
  61         unsigned long flags;
  62
  63         if ((cpu_is_omap1510())) {
  64                 /*
  65                  * OMAP1510 doesn't fully support DMA progress counter
  66                  * and there is no software emulation implemented yet,
  67                  * so have to maintain our own progress counters
  68                  * that can be used by omap_pcm_pointer() instead.
  69                  */
  70                 spin_lock_irqsave(&prtd->lock, flags);
  71                 if ((stat == OMAP_DMA_LAST_IRQ) &&
  72                                 (prtd->period_index == runtime->periods - 1)) {
  73                         /* we are in sync, do nothing */
  74                         spin_unlock_irqrestore(&prtd->lock, flags);
  75                         return;
  76                 }
  77                 if (prtd->period_index >= 0) {
  78                         if (stat & OMAP_DMA_BLOCK_IRQ) {
  79                                 /* end of buffer reached, loop back */
  80                                 prtd->period_index = 0;
  81                         } else if (stat & OMAP_DMA_LAST_IRQ) {
  82                                 /* update the counter for the last period */
  83                                 prtd->period_index = runtime->periods - 1;
  84                         } else if (++prtd->period_index >= runtime->periods) {
  85                                 /* end of buffer missed? loop back */
  86                                 prtd->period_index = 0;
  87                         }
  88                 }
  89                 spin_unlock_irqrestore(&prtd->lock, flags);
  90         }
  91
  92         snd_pcm_period_elapsed(substream);
  93 }
  94
  95 /* this may get called several times by oss emulation */
  96 static int omap_pcm_hw_params(struct snd_pcm_substream *substream,
  97                               struct snd_pcm_hw_params *params)
  98 {
  99         struct snd_pcm_runtime *runtime = substream->runtime;
 100         struct snd_soc_pcm_runtime *rtd = substream->private_data;
 101         struct omap_runtime_data *prtd = runtime->private_data;
 102         struct omap_pcm_dma_data *dma_data;
 103         int err = 0;
 104
 105         dma_data = snd_soc_dai_get_dma_data(rtd->dai->cpu_dai, substream);
 106
 107         /* return if this is a bufferless transfer e.g.
 108          * codec <--> BT codec or GSM modem -- lg FIXME */
 109         if (!dma_data)
 110                 return 0;
 111
 112         snd_pcm_set_runtime_buffer(substream, &substream->dma_buffer);
 113         runtime->dma_bytes = params_buffer_bytes(params);
 114
 115         if (prtd->dma_data)
 116                 return 0;
 117         prtd->dma_data = dma_data;
 118         err = omap_request_dma(dma_data->dma_req, dma_data->name,
 119                                omap_pcm_dma_irq, substream, &prtd->dma_ch);
 120         if (!err) {
 121                 /*
 122                  * Link channel with itself so DMA doesn't need any
 123                  * reprogramming while looping the buffer
 124                  */
 125                 omap_dma_link_lch(prtd->dma_ch, prtd->dma_ch);
 126         }
 127
 128         return err;
 129 }
 130
 131 static int omap_pcm_hw_free(struct snd_pcm_substream *substream)
 132 {
 133         struct snd_pcm_runtime *runtime = substream->runtime;
 134         struct omap_runtime_data *prtd = runtime->private_data;
 135
 136         if (prtd->dma_data == NULL)
 137                 return 0;
 138
 139         omap_dma_unlink_lch(prtd->dma_ch, prtd->dma_ch);
 140         omap_free_dma(prtd->dma_ch);
 141         prtd->dma_data = NULL;
 142
 143         snd_pcm_set_runtime_buffer(substream, NULL);
 144
 145         return 0;
 146 }
 147
 148 static int omap_pcm_prepare(struct snd_pcm_substream *substream)
 149 {
 150         struct snd_pcm_runtime *runtime = substream->runtime;
 151         struct omap_runtime_data *prtd = runtime->private_data;
 152         struct omap_pcm_dma_data *dma_data = prtd->dma_data;
 153         struct omap_dma_channel_params dma_params;
 154         int bytes;
 155
 156         /* return if this is a bufferless transfer e.g.
 157          * codec <--> BT codec or GSM modem -- lg FIXME */
 158         if (!prtd->dma_data)
 159                 return 0;
 160
 161         memset(&dma_params, 0, sizeof(dma_params));
 162         dma_params.data_type                    = dma_data->data_type;
 163         dma_params.trigger                      = dma_data->dma_req;
 164         dma_params.sync_mode                    = dma_data->sync_mode;
 165         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
 166                 dma_params.src_amode            = OMAP_DMA_AMODE_POST_INC;
 167                 dma_params.dst_amode            = OMAP_DMA_AMODE_CONSTANT;
 168                 dma_params.src_or_dst_synch     = OMAP_DMA_DST_SYNC;
 169                 dma_params.src_start            = runtime->dma_addr;
 170                 dma_params.dst_start            = dma_data->port_addr;
 171                 dma_params.dst_port             = OMAP_DMA_PORT_MPUI;
 172                 dma_params.dst_fi               = dma_data->packet_size;
 173         } else {
 174                 dma_params.src_amode            = OMAP_DMA_AMODE_CONSTANT;
 175                 dma_params.dst_amode            = OMAP_DMA_AMODE_POST_INC;
 176                 dma_params.src_or_dst_synch     = OMAP_DMA_SRC_SYNC;
 177                 dma_params.src_start            = dma_data->port_addr;
 178                 dma_params.dst_start            = runtime->dma_addr;
 179                 dma_params.src_port             = OMAP_DMA_PORT_MPUI;
 180                 dma_params.src_fi               = dma_data->packet_size;
 181         }
 182         /*
 183          * Set DMA transfer frame size equal to ALSA period size and frame
 184          * count as no. of ALSA periods. Then with DMA frame interrupt enabled,
 185          * we can transfer the whole ALSA buffer with single DMA transfer but
 186          * still can get an interrupt at each period bounary
 187          */
 188         bytes = snd_pcm_lib_period_bytes(substream);
 189         dma_params.elem_count   = bytes >> dma_data->data_type;
 190         dma_params.frame_count  = runtime->periods;
 191         omap_set_dma_params(prtd->dma_ch, &dma_params);
 192
 193         if ((cpu_is_omap1510()))
 194                 omap_enable_dma_irq(prtd->dma_ch, OMAP_DMA_FRAME_IRQ |
 195                               OMAP_DMA_LAST_IRQ | OMAP_DMA_BLOCK_IRQ);
 196         else
 197                 omap_enable_dma_irq(prtd->dma_ch, OMAP_DMA_FRAME_IRQ);
 198
 199         if (!(cpu_class_is_omap1())) {
 200                 omap_set_dma_src_burst_mode(prtd->dma_ch,
 201                                                 OMAP_DMA_DATA_BURST_16);
 202                 omap_set_dma_dest_burst_mode(prtd->dma_ch,
 203                                                 OMAP_DMA_DATA_BURST_16);
 204         }
 205
 206         return 0;
 207 }
 208
 209 static int omap_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
 210 {
 211         struct snd_pcm_runtime *runtime = substream->runtime;
 212         struct omap_runtime_data *prtd = runtime->private_data;
 213         struct omap_pcm_dma_data *dma_data = prtd->dma_data;
 214         unsigned long flags;
 215         int ret = 0;
 216
 217         spin_lock_irqsave(&prtd->lock, flags);
 218         switch (cmd) {
 219         case SNDRV_PCM_TRIGGER_START:
 220         case SNDRV_PCM_TRIGGER_RESUME:
 221         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
 222                 prtd->period_index = 0;
 223                 /* Configure McBSP internal buffer usage */
 224                 if (dma_data->set_threshold)
 225                         dma_data->set_threshold(substream);
 226
 227                 omap_start_dma(prtd->dma_ch);
 228                 break;
 229
 230         case SNDRV_PCM_TRIGGER_STOP:
 231         case SNDRV_PCM_TRIGGER_SUSPEND:
 232         case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
 233                 prtd->period_index = -1;
 234                 omap_stop_dma(prtd->dma_ch);
 235                 break;
 236         default:
 237                 ret = -EINVAL;
 238         }
 239         spin_unlock_irqrestore(&prtd->lock, flags);
 240
 241         return ret;
 242 }
 243
 244 static snd_pcm_uframes_t omap_pcm_pointer(struct snd_pcm_substream *substream)
 245 {
 246         struct snd_pcm_runtime *runtime = substream->runtime;
 247         struct omap_runtime_data *prtd = runtime->private_data;
 248         dma_addr_t ptr;
 249         snd_pcm_uframes_t offset;
 250
 251         if (cpu_is_omap1510()) {
 252                 offset = prtd->period_index * runtime->period_size;
 253         } else if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) {
 254                 ptr = omap_get_dma_dst_pos(prtd->dma_ch);
 255                 offset = bytes_to_frames(runtime, ptr - runtime->dma_addr);
 256         } else {
 257                 ptr = omap_get_dma_src_pos(prtd->dma_ch);
 258                 offset = bytes_to_frames(runtime, ptr - runtime->dma_addr);
 259         }
 260
 261         if (offset >= runtime->buffer_size)
 262                 offset = 0;
 263
 264         return offset;
 265 }
 266
 267 static int omap_pcm_open(struct snd_pcm_substream *substream)
 268 {
 269         struct snd_pcm_runtime *runtime = substream->runtime;
 270         struct omap_runtime_data *prtd;
 271         int ret;
 272
 273         snd_soc_set_runtime_hwparams(substream, &omap_pcm_hardware);
 274
 275         /* Ensure that buffer size is a multiple of period size */
 276         ret = snd_pcm_hw_constraint_integer(runtime,
 277                                             SNDRV_PCM_HW_PARAM_PERIODS);
 278         if (ret < 0)
 279                 goto out;
 280
 281         prtd = kzalloc(sizeof(*prtd), GFP_KERNEL);
 282         if (prtd == NULL) {
 283                 ret = -ENOMEM;
 284                 goto out;
 285         }
 286         spin_lock_init(&prtd->lock);
 287         runtime->private_data = prtd;
 288
 289 out:
 290         return ret;
 291 }
 292
 293 static int omap_pcm_close(struct snd_pcm_substream *substream)
 294 {
 295         struct snd_pcm_runtime *runtime = substream->runtime;
 296
 297         kfree(runtime->private_data);
 298         return 0;
 299 }
 300
 301 static int omap_pcm_mmap(struct snd_pcm_substream *substream,
 302         struct vm_area_struct *vma)
 303 {
 304         struct snd_pcm_runtime *runtime = substream->runtime;
 305
 306         return dma_mmap_writecombine(substream->pcm->card->dev, vma,
 307                                      runtime->dma_area,
 308                                      runtime->dma_addr,
 309                                      runtime->dma_bytes);
 310 }
 311
 312 static struct snd_pcm_ops omap_pcm_ops = {
 313         .open           = omap_pcm_open,
 314         .close          = omap_pcm_close,
 315         .ioctl          = snd_pcm_lib_ioctl,
 316         .hw_params      = omap_pcm_hw_params,
 317         .hw_free        = omap_pcm_hw_free,
 318         .prepare        = omap_pcm_prepare,
 319         .trigger        = omap_pcm_trigger,
 320         .pointer        = omap_pcm_pointer,
 321         .mmap           = omap_pcm_mmap,
 322 };
 323
 324 static u64 omap_pcm_dmamask = DMA_BIT_MASK(64);
 325
 326 static int omap_pcm_preallocate_dma_buffer(struct snd_pcm *pcm,
 327         int stream)
 328 {
 329         struct snd_pcm_substream *substream = pcm->streams[stream].substream;
 330         struct snd_dma_buffer *buf = &substream->dma_buffer;
 331         size_t size = omap_pcm_hardware.buffer_bytes_max;
 332
 333         buf->dev.type = SNDRV_DMA_TYPE_DEV;
 334         buf->dev.dev = pcm->card->dev;
 335         buf->private_data = NULL;
 336         buf->area = dma_alloc_writecombine(pcm->card->dev, size,
 337                                            &buf->addr, GFP_KERNEL);
 338         if (!buf->area)
 339                 return -ENOMEM;
 340
 341         buf->bytes = size;
 342         return 0;
 343 }
 344
 345 static void omap_pcm_free_dma_buffers(struct snd_pcm *pcm)
 346 {
 347         struct snd_pcm_substream *substream;
 348         struct snd_dma_buffer *buf;
 349         int stream;
 350
 351         for (stream = 0; stream < 2; stream++) {
 352                 substream = pcm->streams[stream].substream;
 353                 if (!substream)
 354                         continue;
 355
 356                 buf = &substream->dma_buffer;
 357                 if (!buf->area)
 358                         continue;
 359
 360                 dma_free_writecombine(pcm->card->dev, buf->bytes,
 361                                       buf->area, buf->addr);
 362                 buf->area = NULL;
 363         }
 364 }
 365
 366 static int omap_pcm_new(struct snd_card *card, struct snd_soc_dai *dai,
 367                  struct snd_pcm *pcm)
 368 {
 369         int ret = 0;
 370
 371         if (!card->dev->dma_mask)
 372                 card->dev->dma_mask = &omap_pcm_dmamask;
 373         if (!card->dev->coherent_dma_mask)
 374                 card->dev->coherent_dma_mask = DMA_BIT_MASK(64);
 375
 376         if (dai->playback.channels_min) {
 377                 ret = omap_pcm_preallocate_dma_buffer(pcm,
 378                         SNDRV_PCM_STREAM_PLAYBACK);
 379                 if (ret)
 380                         goto out;
 381         }
 382
 383         if (dai->capture.channels_min) {
 384                 ret = omap_pcm_preallocate_dma_buffer(pcm,
 385                         SNDRV_PCM_STREAM_CAPTURE);
 386                 if (ret)
 387                         goto out;
 388         }
 389
 390 out:
 391         return ret;
 392 }
 393
 394 struct snd_soc_platform omap_soc_platform = {
 395         .name           = "omap-pcm-audio",
 396         .pcm_ops        = &omap_pcm_ops,
 397         .pcm_new        = omap_pcm_new,
 398         .pcm_free       = omap_pcm_free_dma_buffers,
 399 };
 400 EXPORT_SYMBOL_GPL(omap_soc_platform);
 401
 402 static int __init omap_soc_platform_init(void)
 403 {
 404         return snd_soc_register_platform(&omap_soc_platform);
 405 }
 406 module_init(omap_soc_platform_init);
 407
 408 static void __exit omap_soc_platform_exit(void)
 409 {
 410         snd_soc_unregister_platform(&omap_soc_platform);
 411 }
 412 module_exit(omap_soc_platform_exit);
 413
 414 MODULE_AUTHOR("Jarkko Nikula <jhnikula@gmail.com>");
 415 MODULE_DESCRIPTION("OMAP PCM DMA module");
 416 MODULE_LICENSE("GPL");