git.oblomov.eu Git - linux-2.6/blob - sound/atmel/abdac.c

   1 /*
   2  * Driver for the Atmel on-chip Audio Bitstream DAC (ABDAC)
   3  *
   4  * Copyright (C) 2006-2009 Atmel Corporation
   5  *
   6  * This program is free software; you can redistribute it and/or modify it
   7  * under the terms of the GNU General Public License version 2 as published by
   8  * the Free Software Foundation.
   9  */
  10 #include <linux/clk.h>
  11 #include <linux/bitmap.h>
  12 #include <linux/dw_dmac.h>
  13 #include <linux/dmaengine.h>
  14 #include <linux/dma-mapping.h>
  15 #include <linux/init.h>
  16 #include <linux/interrupt.h>
  17 #include <linux/module.h>
  18 #include <linux/platform_device.h>
  19 #include <linux/io.h>
  20
  21 #include <sound/core.h>
  22 #include <sound/initval.h>
  23 #include <sound/pcm.h>
  24 #include <sound/pcm_params.h>
  25 #include <sound/atmel-abdac.h>
  26
  27 /* DAC register offsets */
  28 #define DAC_DATA                                0x0000
  29 #define DAC_CTRL                                0x0008
  30 #define DAC_INT_MASK                            0x000c
  31 #define DAC_INT_EN                              0x0010
  32 #define DAC_INT_DIS                             0x0014
  33 #define DAC_INT_CLR                             0x0018
  34 #define DAC_INT_STATUS                          0x001c
  35
  36 /* Bitfields in CTRL */
  37 #define DAC_SWAP_OFFSET                         30
  38 #define DAC_SWAP_SIZE                           1
  39 #define DAC_EN_OFFSET                           31
  40 #define DAC_EN_SIZE                             1
  41
  42 /* Bitfields in INT_MASK/INT_EN/INT_DIS/INT_STATUS/INT_CLR */
  43 #define DAC_UNDERRUN_OFFSET                     28
  44 #define DAC_UNDERRUN_SIZE                       1
  45 #define DAC_TX_READY_OFFSET                     29
  46 #define DAC_TX_READY_SIZE                       1
  47
  48 /* Bit manipulation macros */
  49 #define DAC_BIT(name)                                   \
  50         (1 << DAC_##name##_OFFSET)
  51 #define DAC_BF(name, value)                             \
  52         (((value) & ((1 << DAC_##name##_SIZE) - 1))     \
  53          << DAC_##name##_OFFSET)
  54 #define DAC_BFEXT(name, value)                          \
  55         (((value) >> DAC_##name##_OFFSET)               \
  56          & ((1 << DAC_##name##_SIZE) - 1))
  57 #define DAC_BFINS(name, value, old)                     \
  58         (((old) & ~(((1 << DAC_##name##_SIZE) - 1)      \
  59                     << DAC_##name##_OFFSET))            \
  60          | DAC_BF(name, value))
  61
  62 /* Register access macros */
  63 #define dac_readl(port, reg)                            \
  64         __raw_readl((port)->regs + DAC_##reg)
  65 #define dac_writel(port, reg, value)                    \
  66         __raw_writel((value), (port)->regs + DAC_##reg)
  67
  68 /*
  69  * ABDAC supports a maximum of 6 different rates from a generic clock. The
  70  * generic clock has a power of two divider, which gives 6 steps from 192 kHz
  71  * to 5112 Hz.
  72  */
  73 #define MAX_NUM_RATES   6
  74 /* ALSA seems to use rates between 192000 Hz and 5112 Hz. */
  75 #define RATE_MAX        192000
  76 #define RATE_MIN        5112
  77
  78 enum {
  79         DMA_READY = 0,
  80 };
  81
  82 struct atmel_abdac_dma {
  83         struct dma_chan         *chan;
  84         struct dw_cyclic_desc   *cdesc;
  85 };
  86
  87 struct atmel_abdac {
  88         struct clk                              *pclk;
  89         struct clk                              *sample_clk;
  90         struct platform_device                  *pdev;
  91         struct atmel_abdac_dma                  dma;
  92
  93         struct snd_pcm_hw_constraint_list       constraints_rates;
  94         struct snd_pcm_substream                *substream;
  95         struct snd_card                         *card;
  96         struct snd_pcm                          *pcm;
  97
  98         void __iomem                            *regs;
  99         unsigned long                           flags;
 100         unsigned int                            rates[MAX_NUM_RATES];
 101         unsigned int                            rates_num;
 102         int                                     irq;
 103 };
 104
 105 #define get_dac(card) ((struct atmel_abdac *)(card)->private_data)
 106
 107 /* This function is called by the DMA driver. */
 108 static void atmel_abdac_dma_period_done(void *arg)
 109 {
 110         struct atmel_abdac *dac = arg;
 111         snd_pcm_period_elapsed(dac->substream);
 112 }
 113
 114 static int atmel_abdac_prepare_dma(struct atmel_abdac *dac,
 115                 struct snd_pcm_substream *substream,
 116                 enum dma_data_direction direction)
 117 {
 118         struct dma_chan                 *chan = dac->dma.chan;
 119         struct dw_cyclic_desc           *cdesc;
 120         struct snd_pcm_runtime          *runtime = substream->runtime;
 121         unsigned long                   buffer_len, period_len;
 122
 123         /*
 124          * We don't do DMA on "complex" transfers, i.e. with
 125          * non-halfword-aligned buffers or lengths.
 126          */
 127         if (runtime->dma_addr & 1 || runtime->buffer_size & 1) {
 128                 dev_dbg(&dac->pdev->dev, "too complex transfer\n");
 129                 return -EINVAL;
 130         }
 131
 132         buffer_len = frames_to_bytes(runtime, runtime->buffer_size);
 133         period_len = frames_to_bytes(runtime, runtime->period_size);
 134
 135         cdesc = dw_dma_cyclic_prep(chan, runtime->dma_addr, buffer_len,
 136                         period_len, DMA_TO_DEVICE);
 137         if (IS_ERR(cdesc)) {
 138                 dev_dbg(&dac->pdev->dev, "could not prepare cyclic DMA\n");
 139                 return PTR_ERR(cdesc);
 140         }
 141
 142         cdesc->period_callback = atmel_abdac_dma_period_done;
 143         cdesc->period_callback_param = dac;
 144
 145         dac->dma.cdesc = cdesc;
 146
 147         set_bit(DMA_READY, &dac->flags);
 148
 149         return 0;
 150 }
 151
 152 static struct snd_pcm_hardware atmel_abdac_hw = {
 153         .info                   = (SNDRV_PCM_INFO_MMAP
 154                                   | SNDRV_PCM_INFO_MMAP_VALID
 155                                   | SNDRV_PCM_INFO_INTERLEAVED
 156                                   | SNDRV_PCM_INFO_BLOCK_TRANSFER
 157                                   | SNDRV_PCM_INFO_RESUME
 158                                   | SNDRV_PCM_INFO_PAUSE),
 159         .formats                = (SNDRV_PCM_FMTBIT_S16_BE),
 160         .rates                  = (SNDRV_PCM_RATE_KNOT),
 161         .rate_min               = RATE_MIN,
 162         .rate_max               = RATE_MAX,
 163         .channels_min           = 2,
 164         .channels_max           = 2,
 165         .buffer_bytes_max       = 64 * 4096,
 166         .period_bytes_min       = 4096,
 167         .period_bytes_max       = 4096,
 168         .periods_min            = 4,
 169         .periods_max            = 64,
 170 };
 171
 172 static int atmel_abdac_open(struct snd_pcm_substream *substream)
 173 {
 174         struct atmel_abdac *dac = snd_pcm_substream_chip(substream);
 175
 176         dac->substream = substream;
 177         atmel_abdac_hw.rate_max = dac->rates[dac->rates_num - 1];
 178         atmel_abdac_hw.rate_min = dac->rates[0];
 179         substream->runtime->hw = atmel_abdac_hw;
 180
 181         return snd_pcm_hw_constraint_list(substream->runtime, 0,
 182                         SNDRV_PCM_HW_PARAM_RATE, &dac->constraints_rates);
 183 }
 184
 185 static int atmel_abdac_close(struct snd_pcm_substream *substream)
 186 {
 187         struct atmel_abdac *dac = snd_pcm_substream_chip(substream);
 188         dac->substream = NULL;
 189         return 0;
 190 }
 191
 192 static int atmel_abdac_hw_params(struct snd_pcm_substream *substream,
 193                 struct snd_pcm_hw_params *hw_params)
 194 {
 195         struct atmel_abdac *dac = snd_pcm_substream_chip(substream);
 196         int retval;
 197
 198         retval = snd_pcm_lib_malloc_pages(substream,
 199                         params_buffer_bytes(hw_params));
 200         if (retval < 0)
 201                 return retval;
 202         /* snd_pcm_lib_malloc_pages returns 1 if buffer is changed. */
 203         if (retval == 1)
 204                 if (test_and_clear_bit(DMA_READY, &dac->flags))
 205                         dw_dma_cyclic_free(dac->dma.chan);
 206
 207         return retval;
 208 }
 209
 210 static int atmel_abdac_hw_free(struct snd_pcm_substream *substream)
 211 {
 212         struct atmel_abdac *dac = snd_pcm_substream_chip(substream);
 213         if (test_and_clear_bit(DMA_READY, &dac->flags))
 214                 dw_dma_cyclic_free(dac->dma.chan);
 215         return snd_pcm_lib_free_pages(substream);
 216 }
 217
 218 static int atmel_abdac_prepare(struct snd_pcm_substream *substream)
 219 {
 220         struct atmel_abdac *dac = snd_pcm_substream_chip(substream);
 221         int retval;
 222
 223         retval = clk_set_rate(dac->sample_clk, 256 * substream->runtime->rate);
 224         if (retval)
 225                 return retval;
 226
 227         if (!test_bit(DMA_READY, &dac->flags))
 228                 retval = atmel_abdac_prepare_dma(dac, substream, DMA_TO_DEVICE);
 229
 230         return retval;
 231 }
 232
 233 static int atmel_abdac_trigger(struct snd_pcm_substream *substream, int cmd)
 234 {
 235         struct atmel_abdac *dac = snd_pcm_substream_chip(substream);
 236         int retval = 0;
 237
 238         switch (cmd) {
 239         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: /* fall through */
 240         case SNDRV_PCM_TRIGGER_RESUME: /* fall through */
 241         case SNDRV_PCM_TRIGGER_START:
 242                 clk_enable(dac->sample_clk);
 243                 retval = dw_dma_cyclic_start(dac->dma.chan);
 244                 if (retval)
 245                         goto out;
 246                 dac_writel(dac, CTRL, DAC_BIT(EN));
 247                 break;
 248         case SNDRV_PCM_TRIGGER_PAUSE_PUSH: /* fall through */
 249         case SNDRV_PCM_TRIGGER_SUSPEND: /* fall through */
 250         case SNDRV_PCM_TRIGGER_STOP:
 251                 dw_dma_cyclic_stop(dac->dma.chan);
 252                 dac_writel(dac, DATA, 0);
 253                 dac_writel(dac, CTRL, 0);
 254                 clk_disable(dac->sample_clk);
 255                 break;
 256         default:
 257                 retval = -EINVAL;
 258                 break;
 259         }
 260 out:
 261         return retval;
 262 }
 263
 264 static snd_pcm_uframes_t
 265 atmel_abdac_pointer(struct snd_pcm_substream *substream)
 266 {
 267         struct atmel_abdac      *dac = snd_pcm_substream_chip(substream);
 268         struct snd_pcm_runtime  *runtime = substream->runtime;
 269         snd_pcm_uframes_t       frames;
 270         unsigned long           bytes;
 271
 272         bytes = dw_dma_get_src_addr(dac->dma.chan);
 273         bytes -= runtime->dma_addr;
 274
 275         frames = bytes_to_frames(runtime, bytes);
 276         if (frames >= runtime->buffer_size)
 277                 frames -= runtime->buffer_size;
 278
 279         return frames;
 280 }
 281
 282 static irqreturn_t abdac_interrupt(int irq, void *dev_id)
 283 {
 284         struct atmel_abdac *dac = dev_id;
 285         u32 status;
 286
 287         status = dac_readl(dac, INT_STATUS);
 288         if (status & DAC_BIT(UNDERRUN)) {
 289                 dev_err(&dac->pdev->dev, "underrun detected\n");
 290                 dac_writel(dac, INT_CLR, DAC_BIT(UNDERRUN));
 291         } else {
 292                 dev_err(&dac->pdev->dev, "spurious interrupt (status=0x%x)\n",
 293                         status);
 294                 dac_writel(dac, INT_CLR, status);
 295         }
 296
 297         return IRQ_HANDLED;
 298 }
 299
 300 static struct snd_pcm_ops atmel_abdac_ops = {
 301         .open           = atmel_abdac_open,
 302         .close          = atmel_abdac_close,
 303         .ioctl          = snd_pcm_lib_ioctl,
 304         .hw_params      = atmel_abdac_hw_params,
 305         .hw_free        = atmel_abdac_hw_free,
 306         .prepare        = atmel_abdac_prepare,
 307         .trigger        = atmel_abdac_trigger,
 308         .pointer        = atmel_abdac_pointer,
 309 };
 310
 311 static int __devinit atmel_abdac_pcm_new(struct atmel_abdac *dac)
 312 {
 313         struct snd_pcm_hardware hw = atmel_abdac_hw;
 314         struct snd_pcm *pcm;
 315         int retval;
 316
 317         retval = snd_pcm_new(dac->card, dac->card->shortname,
 318                         dac->pdev->id, 1, 0, &pcm);
 319         if (retval)
 320                 return retval;
 321
 322         strcpy(pcm->name, dac->card->shortname);
 323         pcm->private_data = dac;
 324         pcm->info_flags = 0;
 325         dac->pcm = pcm;
 326
 327         snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &atmel_abdac_ops);
 328
 329         retval = snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV,
 330                         &dac->pdev->dev, hw.periods_min * hw.period_bytes_min,
 331                         hw.buffer_bytes_max);
 332
 333         return retval;
 334 }
 335
 336 static bool filter(struct dma_chan *chan, void *slave)
 337 {
 338         struct dw_dma_slave *dws = slave;
 339
 340         if (dws->dma_dev == chan->device->dev) {
 341                 chan->private = dws;
 342                 return true;
 343         } else
 344                 return false;
 345 }
 346
 347 static int set_sample_rates(struct atmel_abdac *dac)
 348 {
 349         long new_rate = RATE_MAX;
 350         int retval = -EINVAL;
 351         int index = 0;
 352
 353         /* we start at 192 kHz and work our way down to 5112 Hz */
 354         while (new_rate >= RATE_MIN && index < (MAX_NUM_RATES + 1)) {
 355                 new_rate = clk_round_rate(dac->sample_clk, 256 * new_rate);
 356                 if (new_rate < 0)
 357                         break;
 358                 /* make sure we are below the ABDAC clock */
 359                 if (new_rate <= clk_get_rate(dac->pclk)) {
 360                         dac->rates[index] = new_rate / 256;
 361                         index++;
 362                 }
 363                 /* divide by 256 and then by two to get next rate */
 364                 new_rate /= 256 * 2;
 365         }
 366
 367         if (index) {
 368                 int i;
 369
 370                 /* reverse array, smallest go first */
 371                 for (i = 0; i < (index / 2); i++) {
 372                         unsigned int tmp = dac->rates[index - 1 - i];
 373                         dac->rates[index - 1 - i] = dac->rates[i];
 374                         dac->rates[i] = tmp;
 375                 }
 376
 377                 dac->constraints_rates.count = index;
 378                 dac->constraints_rates.list = dac->rates;
 379                 dac->constraints_rates.mask = 0;
 380                 dac->rates_num = index;
 381
 382                 retval = 0;
 383         }
 384
 385         return retval;
 386 }
 387
 388 static int __devinit atmel_abdac_probe(struct platform_device *pdev)
 389 {
 390         struct snd_card         *card;
 391         struct atmel_abdac      *dac;
 392         struct resource         *regs;
 393         struct atmel_abdac_pdata        *pdata;
 394         struct clk              *pclk;
 395         struct clk              *sample_clk;
 396         int                     retval;
 397         int                     irq;
 398
 399         regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 400         if (!regs) {
 401                 dev_dbg(&pdev->dev, "no memory resource\n");
 402                 return -ENXIO;
 403         }
 404
 405         irq = platform_get_irq(pdev, 0);
 406         if (irq < 0) {
 407                 dev_dbg(&pdev->dev, "could not get IRQ number\n");
 408                 return irq;
 409         }
 410
 411         pdata = pdev->dev.platform_data;
 412         if (!pdata) {
 413                 dev_dbg(&pdev->dev, "no platform data\n");
 414                 return -ENXIO;
 415         }
 416
 417         pclk = clk_get(&pdev->dev, "pclk");
 418         if (IS_ERR(pclk)) {
 419                 dev_dbg(&pdev->dev, "no peripheral clock\n");
 420                 return PTR_ERR(pclk);
 421         }
 422         sample_clk = clk_get(&pdev->dev, "sample_clk");
 423         if (IS_ERR(pclk)) {
 424                 dev_dbg(&pdev->dev, "no sample clock\n");
 425                 retval = PTR_ERR(pclk);
 426                 goto out_put_pclk;
 427         }
 428         clk_enable(pclk);
 429
 430         retval = snd_card_create(SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1,
 431                         THIS_MODULE, sizeof(struct atmel_abdac), &card);
 432         if (retval) {
 433                 dev_dbg(&pdev->dev, "could not create sound card device\n");
 434                 goto out_put_sample_clk;
 435         }
 436
 437         dac = get_dac(card);
 438
 439         dac->irq = irq;
 440         dac->card = card;
 441         dac->pclk = pclk;
 442         dac->sample_clk = sample_clk;
 443         dac->pdev = pdev;
 444
 445         retval = set_sample_rates(dac);
 446         if (retval < 0) {
 447                 dev_dbg(&pdev->dev, "could not set supported rates\n");
 448                 goto out_free_card;
 449         }
 450
 451         dac->regs = ioremap(regs->start, regs->end - regs->start + 1);
 452         if (!dac->regs) {
 453                 dev_dbg(&pdev->dev, "could not remap register memory\n");
 454                 goto out_free_card;
 455         }
 456
 457         /* make sure the DAC is silent and disabled */
 458         dac_writel(dac, DATA, 0);
 459         dac_writel(dac, CTRL, 0);
 460
 461         retval = request_irq(irq, abdac_interrupt, 0, "abdac", dac);
 462         if (retval) {
 463                 dev_dbg(&pdev->dev, "could not request irq\n");
 464                 goto out_unmap_regs;
 465         }
 466
 467         snd_card_set_dev(card, &pdev->dev);
 468
 469         if (pdata->dws.dma_dev) {
 470                 struct dw_dma_slave *dws = &pdata->dws;
 471                 dma_cap_mask_t mask;
 472
 473                 dws->tx_reg = regs->start + DAC_DATA;
 474
 475                 dma_cap_zero(mask);
 476                 dma_cap_set(DMA_SLAVE, mask);
 477
 478                 dac->dma.chan = dma_request_channel(mask, filter, dws);
 479         }
 480         if (!pdata->dws.dma_dev || !dac->dma.chan) {
 481                 dev_dbg(&pdev->dev, "DMA not available\n");
 482                 retval = -ENODEV;
 483                 goto out_unset_card_dev;
 484         }
 485
 486         strcpy(card->driver, "Atmel ABDAC");
 487         strcpy(card->shortname, "Atmel ABDAC");
 488         sprintf(card->longname, "Atmel Audio Bitstream DAC");
 489
 490         retval = atmel_abdac_pcm_new(dac);
 491         if (retval) {
 492                 dev_dbg(&pdev->dev, "could not register ABDAC pcm device\n");
 493                 goto out_release_dma;
 494         }
 495
 496         retval = snd_card_register(card);
 497         if (retval) {
 498                 dev_dbg(&pdev->dev, "could not register sound card\n");
 499                 goto out_release_dma;
 500         }
 501
 502         platform_set_drvdata(pdev, card);
 503
 504         dev_info(&pdev->dev, "Atmel ABDAC at 0x%p using %s\n",
 505                         dac->regs, dac->dma.chan->dev->device.bus_id);
 506
 507         return retval;
 508
 509 out_release_dma:
 510         dma_release_channel(dac->dma.chan);
 511         dac->dma.chan = NULL;
 512 out_unset_card_dev:
 513         snd_card_set_dev(card, NULL);
 514         free_irq(irq, dac);
 515 out_unmap_regs:
 516         iounmap(dac->regs);
 517 out_free_card:
 518         snd_card_free(card);
 519 out_put_sample_clk:
 520         clk_put(sample_clk);
 521         clk_disable(pclk);
 522 out_put_pclk:
 523         clk_put(pclk);
 524         return retval;
 525 }
 526
 527 #ifdef CONFIG_PM
 528 static int atmel_abdac_suspend(struct platform_device *pdev, pm_message_t msg)
 529 {
 530         struct snd_card *card = platform_get_drvdata(pdev);
 531         struct atmel_abdac *dac = card->private_data;
 532
 533         dw_dma_cyclic_stop(dac->dma.chan);
 534         clk_disable(dac->sample_clk);
 535         clk_disable(dac->pclk);
 536
 537         return 0;
 538 }
 539
 540 static int atmel_abdac_resume(struct platform_device *pdev)
 541 {
 542         struct snd_card *card = platform_get_drvdata(pdev);
 543         struct atmel_abdac *dac = card->private_data;
 544
 545         clk_enable(dac->pclk);
 546         clk_enable(dac->sample_clk);
 547         if (test_bit(DMA_READY, &dac->flags))
 548                 dw_dma_cyclic_start(dac->dma.chan);
 549
 550         return 0;
 551 }
 552 #else
 553 #define atmel_abdac_suspend NULL
 554 #define atmel_abdac_resume NULL
 555 #endif
 556
 557 static int __devexit atmel_abdac_remove(struct platform_device *pdev)
 558 {
 559         struct snd_card *card = platform_get_drvdata(pdev);
 560         struct atmel_abdac *dac = get_dac(card);
 561
 562         clk_put(dac->sample_clk);
 563         clk_disable(dac->pclk);
 564         clk_put(dac->pclk);
 565
 566         dma_release_channel(dac->dma.chan);
 567         dac->dma.chan = NULL;
 568         snd_card_set_dev(card, NULL);
 569         iounmap(dac->regs);
 570         free_irq(dac->irq, dac);
 571         snd_card_free(card);
 572
 573         platform_set_drvdata(pdev, NULL);
 574
 575         return 0;
 576 }
 577
 578 static struct platform_driver atmel_abdac_driver = {
 579         .remove         = __devexit_p(atmel_abdac_remove),
 580         .driver         = {
 581                 .name   = "atmel_abdac",
 582         },
 583         .suspend        = atmel_abdac_suspend,
 584         .resume         = atmel_abdac_resume,
 585 };
 586
 587 static int __init atmel_abdac_init(void)
 588 {
 589         return platform_driver_probe(&atmel_abdac_driver,
 590                         atmel_abdac_probe);
 591 }
 592 module_init(atmel_abdac_init);
 593
 594 static void __exit atmel_abdac_exit(void)
 595 {
 596         platform_driver_unregister(&atmel_abdac_driver);
 597 }
 598 module_exit(atmel_abdac_exit);
 599
 600 MODULE_LICENSE("GPL");
 601 MODULE_DESCRIPTION("Driver for Atmel Audio Bitstream DAC (ABDAC)");
 602 MODULE_AUTHOR("Hans-Christian Egtvedt <hans-christian.egtvedt@atmel.com>");