SAFE public projects git trees. - safe/jmp/linux-2.6/blob - sound/atmel/ac97c.c

   1 /*
   2  * Driver for the Atmel AC97C controller
   3  *
   4  * Copyright (C) 2005-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/delay.h>
  12 #include <linux/bitmap.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/mutex.h>
  20 #include <linux/gpio.h>
  21 #include <linux/io.h>
  22
  23 #include <sound/core.h>
  24 #include <sound/initval.h>
  25 #include <sound/pcm.h>
  26 #include <sound/pcm_params.h>
  27 #include <sound/ac97_codec.h>
  28 #include <sound/atmel-ac97c.h>
  29 #include <sound/memalloc.h>
  30
  31 #include <linux/dw_dmac.h>
  32
  33 #include "ac97c.h"
  34
  35 enum {
  36         DMA_TX_READY = 0,
  37         DMA_RX_READY,
  38         DMA_TX_CHAN_PRESENT,
  39         DMA_RX_CHAN_PRESENT,
  40 };
  41
  42 /* Serialize access to opened variable */
  43 static DEFINE_MUTEX(opened_mutex);
  44
  45 struct atmel_ac97c_dma {
  46         struct dma_chan                 *rx_chan;
  47         struct dma_chan                 *tx_chan;
  48 };
  49
  50 struct atmel_ac97c {
  51         struct clk                      *pclk;
  52         struct platform_device          *pdev;
  53         struct atmel_ac97c_dma          dma;
  54
  55         struct snd_pcm_substream        *playback_substream;
  56         struct snd_pcm_substream        *capture_substream;
  57         struct snd_card                 *card;
  58         struct snd_pcm                  *pcm;
  59         struct snd_ac97                 *ac97;
  60         struct snd_ac97_bus             *ac97_bus;
  61
  62         u64                             cur_format;
  63         unsigned int                    cur_rate;
  64         unsigned long                   flags;
  65         /* Serialize access to opened variable */
  66         spinlock_t                      lock;
  67         void __iomem                    *regs;
  68         int                             opened;
  69         int                             reset_pin;
  70 };
  71
  72 #define get_chip(card) ((struct atmel_ac97c *)(card)->private_data)
  73
  74 #define ac97c_writel(chip, reg, val)                    \
  75         __raw_writel((val), (chip)->regs + AC97C_##reg)
  76 #define ac97c_readl(chip, reg)                          \
  77         __raw_readl((chip)->regs + AC97C_##reg)
  78
  79 /* This function is called by the DMA driver. */
  80 static void atmel_ac97c_dma_playback_period_done(void *arg)
  81 {
  82         struct atmel_ac97c *chip = arg;
  83         snd_pcm_period_elapsed(chip->playback_substream);
  84 }
  85
  86 static void atmel_ac97c_dma_capture_period_done(void *arg)
  87 {
  88         struct atmel_ac97c *chip = arg;
  89         snd_pcm_period_elapsed(chip->capture_substream);
  90 }
  91
  92 static int atmel_ac97c_prepare_dma(struct atmel_ac97c *chip,
  93                 struct snd_pcm_substream *substream,
  94                 enum dma_data_direction direction)
  95 {
  96         struct dma_chan                 *chan;
  97         struct dw_cyclic_desc           *cdesc;
  98         struct snd_pcm_runtime          *runtime = substream->runtime;
  99         unsigned long                   buffer_len, period_len;
 100
 101         /*
 102          * We don't do DMA on "complex" transfers, i.e. with
 103          * non-halfword-aligned buffers or lengths.
 104          */
 105         if (runtime->dma_addr & 1 || runtime->buffer_size & 1) {
 106                 dev_dbg(&chip->pdev->dev, "too complex transfer\n");
 107                 return -EINVAL;
 108         }
 109
 110         if (direction == DMA_TO_DEVICE)
 111                 chan = chip->dma.tx_chan;
 112         else
 113                 chan = chip->dma.rx_chan;
 114
 115         buffer_len = frames_to_bytes(runtime, runtime->buffer_size);
 116         period_len = frames_to_bytes(runtime, runtime->period_size);
 117
 118         cdesc = dw_dma_cyclic_prep(chan, runtime->dma_addr, buffer_len,
 119                         period_len, direction);
 120         if (IS_ERR(cdesc)) {
 121                 dev_dbg(&chip->pdev->dev, "could not prepare cyclic DMA\n");
 122                 return PTR_ERR(cdesc);
 123         }
 124
 125         if (direction == DMA_TO_DEVICE) {
 126                 cdesc->period_callback = atmel_ac97c_dma_playback_period_done;
 127                 set_bit(DMA_TX_READY, &chip->flags);
 128         } else {
 129                 cdesc->period_callback = atmel_ac97c_dma_capture_period_done;
 130                 set_bit(DMA_RX_READY, &chip->flags);
 131         }
 132
 133         cdesc->period_callback_param = chip;
 134
 135         return 0;
 136 }
 137
 138 static struct snd_pcm_hardware atmel_ac97c_hw = {
 139         .info                   = (SNDRV_PCM_INFO_MMAP
 140                                   | SNDRV_PCM_INFO_MMAP_VALID
 141                                   | SNDRV_PCM_INFO_INTERLEAVED
 142                                   | SNDRV_PCM_INFO_BLOCK_TRANSFER
 143                                   | SNDRV_PCM_INFO_JOINT_DUPLEX
 144                                   | SNDRV_PCM_INFO_RESUME
 145                                   | SNDRV_PCM_INFO_PAUSE),
 146         .formats                = (SNDRV_PCM_FMTBIT_S16_BE
 147                                   | SNDRV_PCM_FMTBIT_S16_LE),
 148         .rates                  = (SNDRV_PCM_RATE_CONTINUOUS),
 149         .rate_min               = 4000,
 150         .rate_max               = 48000,
 151         .channels_min           = 1,
 152         .channels_max           = 2,
 153         .buffer_bytes_max       = 64 * 4096,
 154         .period_bytes_min       = 4096,
 155         .period_bytes_max       = 4096,
 156         .periods_min            = 4,
 157         .periods_max            = 64,
 158 };
 159
 160 static int atmel_ac97c_playback_open(struct snd_pcm_substream *substream)
 161 {
 162         struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 163         struct snd_pcm_runtime *runtime = substream->runtime;
 164
 165         mutex_lock(&opened_mutex);
 166         chip->opened++;
 167         runtime->hw = atmel_ac97c_hw;
 168         if (chip->cur_rate) {
 169                 runtime->hw.rate_min = chip->cur_rate;
 170                 runtime->hw.rate_max = chip->cur_rate;
 171         }
 172         if (chip->cur_format)
 173                 runtime->hw.formats = (1ULL << chip->cur_format);
 174         mutex_unlock(&opened_mutex);
 175         chip->playback_substream = substream;
 176         return 0;
 177 }
 178
 179 static int atmel_ac97c_capture_open(struct snd_pcm_substream *substream)
 180 {
 181         struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 182         struct snd_pcm_runtime *runtime = substream->runtime;
 183
 184         mutex_lock(&opened_mutex);
 185         chip->opened++;
 186         runtime->hw = atmel_ac97c_hw;
 187         if (chip->cur_rate) {
 188                 runtime->hw.rate_min = chip->cur_rate;
 189                 runtime->hw.rate_max = chip->cur_rate;
 190         }
 191         if (chip->cur_format)
 192                 runtime->hw.formats = (1ULL << chip->cur_format);
 193         mutex_unlock(&opened_mutex);
 194         chip->capture_substream = substream;
 195         return 0;
 196 }
 197
 198 static int atmel_ac97c_playback_close(struct snd_pcm_substream *substream)
 199 {
 200         struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 201
 202         mutex_lock(&opened_mutex);
 203         chip->opened--;
 204         if (!chip->opened) {
 205                 chip->cur_rate = 0;
 206                 chip->cur_format = 0;
 207         }
 208         mutex_unlock(&opened_mutex);
 209
 210         chip->playback_substream = NULL;
 211
 212         return 0;
 213 }
 214
 215 static int atmel_ac97c_capture_close(struct snd_pcm_substream *substream)
 216 {
 217         struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 218
 219         mutex_lock(&opened_mutex);
 220         chip->opened--;
 221         if (!chip->opened) {
 222                 chip->cur_rate = 0;
 223                 chip->cur_format = 0;
 224         }
 225         mutex_unlock(&opened_mutex);
 226
 227         chip->capture_substream = NULL;
 228
 229         return 0;
 230 }
 231
 232 static int atmel_ac97c_playback_hw_params(struct snd_pcm_substream *substream,
 233                 struct snd_pcm_hw_params *hw_params)
 234 {
 235         struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 236         int retval;
 237
 238         retval = snd_pcm_lib_malloc_pages(substream,
 239                                         params_buffer_bytes(hw_params));
 240         if (retval < 0)
 241                 return retval;
 242         /* snd_pcm_lib_malloc_pages returns 1 if buffer is changed. */
 243         if (retval == 1)
 244                 if (test_and_clear_bit(DMA_TX_READY, &chip->flags))
 245                         dw_dma_cyclic_free(chip->dma.tx_chan);
 246
 247         /* Set restrictions to params. */
 248         mutex_lock(&opened_mutex);
 249         chip->cur_rate = params_rate(hw_params);
 250         chip->cur_format = params_format(hw_params);
 251         mutex_unlock(&opened_mutex);
 252
 253         return retval;
 254 }
 255
 256 static int atmel_ac97c_capture_hw_params(struct snd_pcm_substream *substream,
 257                 struct snd_pcm_hw_params *hw_params)
 258 {
 259         struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 260         int retval;
 261
 262         retval = snd_pcm_lib_malloc_pages(substream,
 263                                         params_buffer_bytes(hw_params));
 264         if (retval < 0)
 265                 return retval;
 266         /* snd_pcm_lib_malloc_pages returns 1 if buffer is changed. */
 267         if (retval == 1)
 268                 if (test_and_clear_bit(DMA_RX_READY, &chip->flags))
 269                         dw_dma_cyclic_free(chip->dma.rx_chan);
 270
 271         /* Set restrictions to params. */
 272         mutex_lock(&opened_mutex);
 273         chip->cur_rate = params_rate(hw_params);
 274         chip->cur_format = params_format(hw_params);
 275         mutex_unlock(&opened_mutex);
 276
 277         return retval;
 278 }
 279
 280 static int atmel_ac97c_playback_hw_free(struct snd_pcm_substream *substream)
 281 {
 282         struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 283         if (test_and_clear_bit(DMA_TX_READY, &chip->flags))
 284                 dw_dma_cyclic_free(chip->dma.tx_chan);
 285         return snd_pcm_lib_free_pages(substream);
 286 }
 287
 288 static int atmel_ac97c_capture_hw_free(struct snd_pcm_substream *substream)
 289 {
 290         struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 291         if (test_and_clear_bit(DMA_RX_READY, &chip->flags))
 292                 dw_dma_cyclic_free(chip->dma.rx_chan);
 293         return snd_pcm_lib_free_pages(substream);
 294 }
 295
 296 static int atmel_ac97c_playback_prepare(struct snd_pcm_substream *substream)
 297 {
 298         struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 299         struct snd_pcm_runtime *runtime = substream->runtime;
 300         unsigned long word = 0;
 301         int retval;
 302
 303         /* assign channels to AC97C channel A */
 304         switch (runtime->channels) {
 305         case 1:
 306                 word |= AC97C_CH_ASSIGN(PCM_LEFT, A);
 307                 break;
 308         case 2:
 309                 word |= AC97C_CH_ASSIGN(PCM_LEFT, A)
 310                         | AC97C_CH_ASSIGN(PCM_RIGHT, A);
 311                 break;
 312         default:
 313                 /* TODO: support more than two channels */
 314                 return -EINVAL;
 315                 break;
 316         }
 317         ac97c_writel(chip, OCA, word);
 318
 319         /* configure sample format and size */
 320         word = AC97C_CMR_DMAEN | AC97C_CMR_SIZE_16;
 321
 322         switch (runtime->format) {
 323         case SNDRV_PCM_FORMAT_S16_LE:
 324                 word |= AC97C_CMR_CEM_LITTLE;
 325                 break;
 326         case SNDRV_PCM_FORMAT_S16_BE: /* fall through */
 327         default:
 328                 word &= ~(AC97C_CMR_CEM_LITTLE);
 329                 break;
 330         }
 331
 332         ac97c_writel(chip, CAMR, word);
 333
 334         /* set variable rate if needed */
 335         if (runtime->rate != 48000) {
 336                 word = ac97c_readl(chip, MR);
 337                 word |= AC97C_MR_VRA;
 338                 ac97c_writel(chip, MR, word);
 339         } else {
 340                 word = ac97c_readl(chip, MR);
 341                 word &= ~(AC97C_MR_VRA);
 342                 ac97c_writel(chip, MR, word);
 343         }
 344
 345         retval = snd_ac97_set_rate(chip->ac97, AC97_PCM_FRONT_DAC_RATE,
 346                         runtime->rate);
 347         if (retval)
 348                 dev_dbg(&chip->pdev->dev, "could not set rate %d Hz\n",
 349                                 runtime->rate);
 350
 351         if (!test_bit(DMA_TX_READY, &chip->flags))
 352                 retval = atmel_ac97c_prepare_dma(chip, substream,
 353                                 DMA_TO_DEVICE);
 354
 355         return retval;
 356 }
 357
 358 static int atmel_ac97c_capture_prepare(struct snd_pcm_substream *substream)
 359 {
 360         struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 361         struct snd_pcm_runtime *runtime = substream->runtime;
 362         unsigned long word = 0;
 363         int retval;
 364
 365         /* assign channels to AC97C channel A */
 366         switch (runtime->channels) {
 367         case 1:
 368                 word |= AC97C_CH_ASSIGN(PCM_LEFT, A);
 369                 break;
 370         case 2:
 371                 word |= AC97C_CH_ASSIGN(PCM_LEFT, A)
 372                         | AC97C_CH_ASSIGN(PCM_RIGHT, A);
 373                 break;
 374         default:
 375                 /* TODO: support more than two channels */
 376                 return -EINVAL;
 377                 break;
 378         }
 379         ac97c_writel(chip, ICA, word);
 380
 381         /* configure sample format and size */
 382         word = AC97C_CMR_DMAEN | AC97C_CMR_SIZE_16;
 383
 384         switch (runtime->format) {
 385         case SNDRV_PCM_FORMAT_S16_LE:
 386                 word |= AC97C_CMR_CEM_LITTLE;
 387                 break;
 388         case SNDRV_PCM_FORMAT_S16_BE: /* fall through */
 389         default:
 390                 word &= ~(AC97C_CMR_CEM_LITTLE);
 391                 break;
 392         }
 393
 394         ac97c_writel(chip, CAMR, word);
 395
 396         /* set variable rate if needed */
 397         if (runtime->rate != 48000) {
 398                 word = ac97c_readl(chip, MR);
 399                 word |= AC97C_MR_VRA;
 400                 ac97c_writel(chip, MR, word);
 401         } else {
 402                 word = ac97c_readl(chip, MR);
 403                 word &= ~(AC97C_MR_VRA);
 404                 ac97c_writel(chip, MR, word);
 405         }
 406
 407         retval = snd_ac97_set_rate(chip->ac97, AC97_PCM_LR_ADC_RATE,
 408                         runtime->rate);
 409         if (retval)
 410                 dev_dbg(&chip->pdev->dev, "could not set rate %d Hz\n",
 411                                 runtime->rate);
 412
 413         if (!test_bit(DMA_RX_READY, &chip->flags))
 414                 retval = atmel_ac97c_prepare_dma(chip, substream,
 415                                 DMA_FROM_DEVICE);
 416
 417         return retval;
 418 }
 419
 420 static int
 421 atmel_ac97c_playback_trigger(struct snd_pcm_substream *substream, int cmd)
 422 {
 423         struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 424         unsigned long camr;
 425         int retval = 0;
 426
 427         camr = ac97c_readl(chip, CAMR);
 428
 429         switch (cmd) {
 430         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: /* fall through */
 431         case SNDRV_PCM_TRIGGER_RESUME: /* fall through */
 432         case SNDRV_PCM_TRIGGER_START:
 433                 retval = dw_dma_cyclic_start(chip->dma.tx_chan);
 434                 if (retval)
 435                         goto out;
 436                 camr |= AC97C_CMR_CENA;
 437                 break;
 438         case SNDRV_PCM_TRIGGER_PAUSE_PUSH: /* fall through */
 439         case SNDRV_PCM_TRIGGER_SUSPEND: /* fall through */
 440         case SNDRV_PCM_TRIGGER_STOP:
 441                 dw_dma_cyclic_stop(chip->dma.tx_chan);
 442                 if (chip->opened <= 1)
 443                         camr &= ~AC97C_CMR_CENA;
 444                 break;
 445         default:
 446                 retval = -EINVAL;
 447                 goto out;
 448         }
 449
 450         ac97c_writel(chip, CAMR, camr);
 451 out:
 452         return retval;
 453 }
 454
 455 static int
 456 atmel_ac97c_capture_trigger(struct snd_pcm_substream *substream, int cmd)
 457 {
 458         struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 459         unsigned long camr;
 460         int retval = 0;
 461
 462         camr = ac97c_readl(chip, CAMR);
 463
 464         switch (cmd) {
 465         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: /* fall through */
 466         case SNDRV_PCM_TRIGGER_RESUME: /* fall through */
 467         case SNDRV_PCM_TRIGGER_START:
 468                 retval = dw_dma_cyclic_start(chip->dma.rx_chan);
 469                 if (retval)
 470                         goto out;
 471                 camr |= AC97C_CMR_CENA;
 472                 break;
 473         case SNDRV_PCM_TRIGGER_PAUSE_PUSH: /* fall through */
 474         case SNDRV_PCM_TRIGGER_SUSPEND: /* fall through */
 475         case SNDRV_PCM_TRIGGER_STOP:
 476                 dw_dma_cyclic_stop(chip->dma.rx_chan);
 477                 if (chip->opened <= 1)
 478                         camr &= ~AC97C_CMR_CENA;
 479                 break;
 480         default:
 481                 retval = -EINVAL;
 482                 break;
 483         }
 484
 485         ac97c_writel(chip, CAMR, camr);
 486 out:
 487         return retval;
 488 }
 489
 490 static snd_pcm_uframes_t
 491 atmel_ac97c_playback_pointer(struct snd_pcm_substream *substream)
 492 {
 493         struct atmel_ac97c      *chip = snd_pcm_substream_chip(substream);
 494         struct snd_pcm_runtime  *runtime = substream->runtime;
 495         snd_pcm_uframes_t       frames;
 496         unsigned long           bytes;
 497
 498         bytes = dw_dma_get_src_addr(chip->dma.tx_chan);
 499         bytes -= runtime->dma_addr;
 500
 501         frames = bytes_to_frames(runtime, bytes);
 502         if (frames >= runtime->buffer_size)
 503                 frames -= runtime->buffer_size;
 504         return frames;
 505 }
 506
 507 static snd_pcm_uframes_t
 508 atmel_ac97c_capture_pointer(struct snd_pcm_substream *substream)
 509 {
 510         struct atmel_ac97c      *chip = snd_pcm_substream_chip(substream);
 511         struct snd_pcm_runtime  *runtime = substream->runtime;
 512         snd_pcm_uframes_t       frames;
 513         unsigned long           bytes;
 514
 515         bytes = dw_dma_get_dst_addr(chip->dma.rx_chan);
 516         bytes -= runtime->dma_addr;
 517
 518         frames = bytes_to_frames(runtime, bytes);
 519         if (frames >= runtime->buffer_size)
 520                 frames -= runtime->buffer_size;
 521         return frames;
 522 }
 523
 524 static struct snd_pcm_ops atmel_ac97_playback_ops = {
 525         .open           = atmel_ac97c_playback_open,
 526         .close          = atmel_ac97c_playback_close,
 527         .ioctl          = snd_pcm_lib_ioctl,
 528         .hw_params      = atmel_ac97c_playback_hw_params,
 529         .hw_free        = atmel_ac97c_playback_hw_free,
 530         .prepare        = atmel_ac97c_playback_prepare,
 531         .trigger        = atmel_ac97c_playback_trigger,
 532         .pointer        = atmel_ac97c_playback_pointer,
 533 };
 534
 535 static struct snd_pcm_ops atmel_ac97_capture_ops = {
 536         .open           = atmel_ac97c_capture_open,
 537         .close          = atmel_ac97c_capture_close,
 538         .ioctl          = snd_pcm_lib_ioctl,
 539         .hw_params      = atmel_ac97c_capture_hw_params,
 540         .hw_free        = atmel_ac97c_capture_hw_free,
 541         .prepare        = atmel_ac97c_capture_prepare,
 542         .trigger        = atmel_ac97c_capture_trigger,
 543         .pointer        = atmel_ac97c_capture_pointer,
 544 };
 545
 546 static int __devinit atmel_ac97c_pcm_new(struct atmel_ac97c *chip)
 547 {
 548         struct snd_pcm          *pcm;
 549         struct snd_pcm_hardware hw = atmel_ac97c_hw;
 550         int                     capture, playback, retval;
 551
 552         capture = test_bit(DMA_RX_CHAN_PRESENT, &chip->flags);
 553         playback = test_bit(DMA_TX_CHAN_PRESENT, &chip->flags);
 554
 555         retval = snd_pcm_new(chip->card, chip->card->shortname,
 556                         chip->pdev->id, playback, capture, &pcm);
 557         if (retval)
 558                 return retval;
 559
 560         if (capture)
 561                 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE,
 562                                 &atmel_ac97_capture_ops);
 563         if (playback)
 564                 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK,
 565                                 &atmel_ac97_playback_ops);
 566
 567         retval = snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV,
 568                         &chip->pdev->dev, hw.periods_min * hw.period_bytes_min,
 569                         hw.buffer_bytes_max);
 570         if (retval)
 571                 return retval;
 572
 573         pcm->private_data = chip;
 574         pcm->info_flags = 0;
 575         strcpy(pcm->name, chip->card->shortname);
 576         chip->pcm = pcm;
 577
 578         return 0;
 579 }
 580
 581 static int atmel_ac97c_mixer_new(struct atmel_ac97c *chip)
 582 {
 583         struct snd_ac97_template template;
 584         memset(&template, 0, sizeof(template));
 585         template.private_data = chip;
 586         return snd_ac97_mixer(chip->ac97_bus, &template, &chip->ac97);
 587 }
 588
 589 static void atmel_ac97c_write(struct snd_ac97 *ac97, unsigned short reg,
 590                 unsigned short val)
 591 {
 592         struct atmel_ac97c *chip = get_chip(ac97);
 593         unsigned long word;
 594         int timeout = 40;
 595
 596         word = (reg & 0x7f) << 16 | val;
 597
 598         do {
 599                 if (ac97c_readl(chip, COSR) & AC97C_CSR_TXRDY) {
 600                         ac97c_writel(chip, COTHR, word);
 601                         return;
 602                 }
 603                 udelay(1);
 604         } while (--timeout);
 605
 606         dev_dbg(&chip->pdev->dev, "codec write timeout\n");
 607 }
 608
 609 static unsigned short atmel_ac97c_read(struct snd_ac97 *ac97,
 610                 unsigned short reg)
 611 {
 612         struct atmel_ac97c *chip = get_chip(ac97);
 613         unsigned long word;
 614         int timeout = 40;
 615         int write = 10;
 616
 617         word = (0x80 | (reg & 0x7f)) << 16;
 618
 619         if ((ac97c_readl(chip, COSR) & AC97C_CSR_RXRDY) != 0)
 620                 ac97c_readl(chip, CORHR);
 621
 622 retry_write:
 623         timeout = 40;
 624
 625         do {
 626                 if ((ac97c_readl(chip, COSR) & AC97C_CSR_TXRDY) != 0) {
 627                         ac97c_writel(chip, COTHR, word);
 628                         goto read_reg;
 629                 }
 630                 udelay(10);
 631         } while (--timeout);
 632
 633         if (!--write)
 634                 goto timed_out;
 635         goto retry_write;
 636
 637 read_reg:
 638         do {
 639                 if ((ac97c_readl(chip, COSR) & AC97C_CSR_RXRDY) != 0) {
 640                         unsigned short val = ac97c_readl(chip, CORHR);
 641                         return val;
 642                 }
 643                 udelay(10);
 644         } while (--timeout);
 645
 646         if (!--write)
 647                 goto timed_out;
 648         goto retry_write;
 649
 650 timed_out:
 651         dev_dbg(&chip->pdev->dev, "codec read timeout\n");
 652         return 0xffff;
 653 }
 654
 655 static bool filter(struct dma_chan *chan, void *slave)
 656 {
 657         struct dw_dma_slave *dws = slave;
 658
 659         if (dws->dma_dev == chan->device->dev) {
 660                 chan->private = dws;
 661                 return true;
 662         } else
 663                 return false;
 664 }
 665
 666 static void atmel_ac97c_reset(struct atmel_ac97c *chip)
 667 {
 668         ac97c_writel(chip, MR, AC97C_MR_WRST);
 669
 670         if (gpio_is_valid(chip->reset_pin)) {
 671                 gpio_set_value(chip->reset_pin, 0);
 672                 /* AC97 v2.2 specifications says minimum 1 us. */
 673                 udelay(10);
 674                 gpio_set_value(chip->reset_pin, 1);
 675         }
 676
 677         udelay(1);
 678         ac97c_writel(chip, MR, AC97C_MR_ENA);
 679 }
 680
 681 static int __devinit atmel_ac97c_probe(struct platform_device *pdev)
 682 {
 683         struct snd_card                 *card;
 684         struct atmel_ac97c              *chip;
 685         struct resource                 *regs;
 686         struct ac97c_platform_data      *pdata;
 687         struct clk                      *pclk;
 688         static struct snd_ac97_bus_ops  ops = {
 689                 .write  = atmel_ac97c_write,
 690                 .read   = atmel_ac97c_read,
 691         };
 692         int                             retval;
 693
 694         regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 695         if (!regs) {
 696                 dev_dbg(&pdev->dev, "no memory resource\n");
 697                 return -ENXIO;
 698         }
 699
 700         pdata = pdev->dev.platform_data;
 701         if (!pdata) {
 702                 dev_dbg(&pdev->dev, "no platform data\n");
 703                 return -ENXIO;
 704         }
 705
 706         pclk = clk_get(&pdev->dev, "pclk");
 707         if (IS_ERR(pclk)) {
 708                 dev_dbg(&pdev->dev, "no peripheral clock\n");
 709                 return PTR_ERR(pclk);
 710         }
 711         clk_enable(pclk);
 712
 713         retval = snd_card_create(SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1,
 714                         THIS_MODULE, sizeof(struct atmel_ac97c), &card);
 715         if (retval) {
 716                 dev_dbg(&pdev->dev, "could not create sound card device\n");
 717                 goto err_snd_card_new;
 718         }
 719
 720         chip = get_chip(card);
 721
 722         spin_lock_init(&chip->lock);
 723
 724         strcpy(card->driver, "Atmel AC97C");
 725         strcpy(card->shortname, "Atmel AC97C");
 726         sprintf(card->longname, "Atmel AC97 controller");
 727
 728         chip->card = card;
 729         chip->pclk = pclk;
 730         chip->pdev = pdev;
 731         chip->regs = ioremap(regs->start, regs->end - regs->start + 1);
 732
 733         if (!chip->regs) {
 734                 dev_dbg(&pdev->dev, "could not remap register memory\n");
 735                 goto err_ioremap;
 736         }
 737
 738         if (gpio_is_valid(pdata->reset_pin)) {
 739                 if (gpio_request(pdata->reset_pin, "reset_pin")) {
 740                         dev_dbg(&pdev->dev, "reset pin not available\n");
 741                         chip->reset_pin = -ENODEV;
 742                 } else {
 743                         gpio_direction_output(pdata->reset_pin, 1);
 744                         chip->reset_pin = pdata->reset_pin;
 745                 }
 746         }
 747
 748         snd_card_set_dev(card, &pdev->dev);
 749
 750         retval = snd_ac97_bus(card, 0, &ops, chip, &chip->ac97_bus);
 751         if (retval) {
 752                 dev_dbg(&pdev->dev, "could not register on ac97 bus\n");
 753                 goto err_ac97_bus;
 754         }
 755
 756         atmel_ac97c_reset(chip);
 757
 758         retval = atmel_ac97c_mixer_new(chip);
 759         if (retval) {
 760                 dev_dbg(&pdev->dev, "could not register ac97 mixer\n");
 761                 goto err_ac97_bus;
 762         }
 763
 764         if (pdata->rx_dws.dma_dev) {
 765                 struct dw_dma_slave *dws = &pdata->rx_dws;
 766                 dma_cap_mask_t mask;
 767
 768                 dws->rx_reg = regs->start + AC97C_CARHR + 2;
 769
 770                 dma_cap_zero(mask);
 771                 dma_cap_set(DMA_SLAVE, mask);
 772
 773                 chip->dma.rx_chan = dma_request_channel(mask, filter, dws);
 774
 775                 dev_info(&chip->pdev->dev, "using %s for DMA RX\n",
 776                                         chip->dma.rx_chan->dev->device.bus_id);
 777                 set_bit(DMA_RX_CHAN_PRESENT, &chip->flags);
 778         }
 779
 780         if (pdata->tx_dws.dma_dev) {
 781                 struct dw_dma_slave *dws = &pdata->tx_dws;
 782                 dma_cap_mask_t mask;
 783
 784                 dws->tx_reg = regs->start + AC97C_CATHR + 2;
 785
 786                 dma_cap_zero(mask);
 787                 dma_cap_set(DMA_SLAVE, mask);
 788
 789                 chip->dma.tx_chan = dma_request_channel(mask, filter, dws);
 790
 791                 dev_info(&chip->pdev->dev, "using %s for DMA TX\n",
 792                                         chip->dma.tx_chan->dev->device.bus_id);
 793                 set_bit(DMA_TX_CHAN_PRESENT, &chip->flags);
 794         }
 795
 796         if (!test_bit(DMA_RX_CHAN_PRESENT, &chip->flags) &&
 797                         !test_bit(DMA_TX_CHAN_PRESENT, &chip->flags)) {
 798                 dev_dbg(&pdev->dev, "DMA not available\n");
 799                 retval = -ENODEV;
 800                 goto err_dma;
 801         }
 802
 803         retval = atmel_ac97c_pcm_new(chip);
 804         if (retval) {
 805                 dev_dbg(&pdev->dev, "could not register ac97 pcm device\n");
 806                 goto err_dma;
 807         }
 808
 809         retval = snd_card_register(card);
 810         if (retval) {
 811                 dev_dbg(&pdev->dev, "could not register sound card\n");
 812                 goto err_ac97_bus;
 813         }
 814
 815         platform_set_drvdata(pdev, card);
 816
 817         dev_info(&pdev->dev, "Atmel AC97 controller at 0x%p\n",
 818                         chip->regs);
 819
 820         return 0;
 821
 822 err_dma:
 823         if (test_bit(DMA_RX_CHAN_PRESENT, &chip->flags))
 824                 dma_release_channel(chip->dma.rx_chan);
 825         if (test_bit(DMA_TX_CHAN_PRESENT, &chip->flags))
 826                 dma_release_channel(chip->dma.tx_chan);
 827         clear_bit(DMA_RX_CHAN_PRESENT, &chip->flags);
 828         clear_bit(DMA_TX_CHAN_PRESENT, &chip->flags);
 829         chip->dma.rx_chan = NULL;
 830         chip->dma.tx_chan = NULL;
 831 err_ac97_bus:
 832         snd_card_set_dev(card, NULL);
 833
 834         if (gpio_is_valid(chip->reset_pin))
 835                 gpio_free(chip->reset_pin);
 836
 837         iounmap(chip->regs);
 838 err_ioremap:
 839         snd_card_free(card);
 840 err_snd_card_new:
 841         clk_disable(pclk);
 842         clk_put(pclk);
 843         return retval;
 844 }
 845
 846 #ifdef CONFIG_PM
 847 static int atmel_ac97c_suspend(struct platform_device *pdev, pm_message_t msg)
 848 {
 849         struct snd_card *card = platform_get_drvdata(pdev);
 850         struct atmel_ac97c *chip = card->private_data;
 851
 852         if (test_bit(DMA_RX_READY, &chip->flags))
 853                 dw_dma_cyclic_stop(chip->dma.rx_chan);
 854         if (test_bit(DMA_TX_READY, &chip->flags))
 855                 dw_dma_cyclic_stop(chip->dma.tx_chan);
 856         clk_disable(chip->pclk);
 857
 858         return 0;
 859 }
 860
 861 static int atmel_ac97c_resume(struct platform_device *pdev)
 862 {
 863         struct snd_card *card = platform_get_drvdata(pdev);
 864         struct atmel_ac97c *chip = card->private_data;
 865
 866         clk_enable(chip->pclk);
 867         if (test_bit(DMA_RX_READY, &chip->flags))
 868                 dw_dma_cyclic_start(chip->dma.rx_chan);
 869         if (test_bit(DMA_TX_READY, &chip->flags))
 870                 dw_dma_cyclic_start(chip->dma.tx_chan);
 871
 872         return 0;
 873 }
 874 #else
 875 #define atmel_ac97c_suspend NULL
 876 #define atmel_ac97c_resume NULL
 877 #endif
 878
 879 static int __devexit atmel_ac97c_remove(struct platform_device *pdev)
 880 {
 881         struct snd_card *card = platform_get_drvdata(pdev);
 882         struct atmel_ac97c *chip = get_chip(card);
 883
 884         if (gpio_is_valid(chip->reset_pin))
 885                 gpio_free(chip->reset_pin);
 886
 887         clk_disable(chip->pclk);
 888         clk_put(chip->pclk);
 889         iounmap(chip->regs);
 890
 891         if (test_bit(DMA_RX_CHAN_PRESENT, &chip->flags))
 892                 dma_release_channel(chip->dma.rx_chan);
 893         if (test_bit(DMA_TX_CHAN_PRESENT, &chip->flags))
 894                 dma_release_channel(chip->dma.tx_chan);
 895         clear_bit(DMA_RX_CHAN_PRESENT, &chip->flags);
 896         clear_bit(DMA_TX_CHAN_PRESENT, &chip->flags);
 897         chip->dma.rx_chan = NULL;
 898         chip->dma.tx_chan = NULL;
 899
 900         snd_card_set_dev(card, NULL);
 901         snd_card_free(card);
 902
 903         platform_set_drvdata(pdev, NULL);
 904
 905         return 0;
 906 }
 907
 908 static struct platform_driver atmel_ac97c_driver = {
 909         .remove         = __devexit_p(atmel_ac97c_remove),
 910         .driver         = {
 911                 .name   = "atmel_ac97c",
 912         },
 913         .suspend        = atmel_ac97c_suspend,
 914         .resume         = atmel_ac97c_resume,
 915 };
 916
 917 static int __init atmel_ac97c_init(void)
 918 {
 919         return platform_driver_probe(&atmel_ac97c_driver,
 920                         atmel_ac97c_probe);
 921 }
 922 module_init(atmel_ac97c_init);
 923
 924 static void __exit atmel_ac97c_exit(void)
 925 {
 926         platform_driver_unregister(&atmel_ac97c_driver);
 927 }
 928 module_exit(atmel_ac97c_exit);
 929
 930 MODULE_LICENSE("GPL");
 931 MODULE_DESCRIPTION("Driver for Atmel AC97 controller");
 932 MODULE_AUTHOR("Hans-Christian Egtvedt <hans-christian.egtvedt@atmel.com>");