ALSA: atmel: set "channel A event" output to debug
[safe/jmp/linux-2.6] / sound / atmel / ac97c.c
1 /*
2  * Driver for Atmel AC97C
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/device.h>
14 #include <linux/dmaengine.h>
15 #include <linux/dma-mapping.h>
16 #include <linux/atmel_pdc.h>
17 #include <linux/init.h>
18 #include <linux/interrupt.h>
19 #include <linux/module.h>
20 #include <linux/platform_device.h>
21 #include <linux/mutex.h>
22 #include <linux/gpio.h>
23 #include <linux/io.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/ac97_codec.h>
30 #include <sound/atmel-ac97c.h>
31 #include <sound/memalloc.h>
32
33 #include <linux/dw_dmac.h>
34
35 #include <mach/cpu.h>
36 #include <mach/hardware.h>
37 #include <mach/gpio.h>
38
39 #include "ac97c.h"
40
41 enum {
42         DMA_TX_READY = 0,
43         DMA_RX_READY,
44         DMA_TX_CHAN_PRESENT,
45         DMA_RX_CHAN_PRESENT,
46 };
47
48 /* Serialize access to opened variable */
49 static DEFINE_MUTEX(opened_mutex);
50
51 struct atmel_ac97c_dma {
52         struct dma_chan                 *rx_chan;
53         struct dma_chan                 *tx_chan;
54 };
55
56 struct atmel_ac97c {
57         struct clk                      *pclk;
58         struct platform_device          *pdev;
59         struct atmel_ac97c_dma          dma;
60
61         struct snd_pcm_substream        *playback_substream;
62         struct snd_pcm_substream        *capture_substream;
63         struct snd_card                 *card;
64         struct snd_pcm                  *pcm;
65         struct snd_ac97                 *ac97;
66         struct snd_ac97_bus             *ac97_bus;
67
68         u64                             cur_format;
69         unsigned int                    cur_rate;
70         unsigned long                   flags;
71         int                             playback_period, capture_period;
72         /* Serialize access to opened variable */
73         spinlock_t                      lock;
74         void __iomem                    *regs;
75         int                             irq;
76         int                             opened;
77         int                             reset_pin;
78 };
79
80 #define get_chip(card) ((struct atmel_ac97c *)(card)->private_data)
81
82 #define ac97c_writel(chip, reg, val)                    \
83         __raw_writel((val), (chip)->regs + AC97C_##reg)
84 #define ac97c_readl(chip, reg)                          \
85         __raw_readl((chip)->regs + AC97C_##reg)
86
87 /* This function is called by the DMA driver. */
88 static void atmel_ac97c_dma_playback_period_done(void *arg)
89 {
90         struct atmel_ac97c *chip = arg;
91         snd_pcm_period_elapsed(chip->playback_substream);
92 }
93
94 static void atmel_ac97c_dma_capture_period_done(void *arg)
95 {
96         struct atmel_ac97c *chip = arg;
97         snd_pcm_period_elapsed(chip->capture_substream);
98 }
99
100 static int atmel_ac97c_prepare_dma(struct atmel_ac97c *chip,
101                 struct snd_pcm_substream *substream,
102                 enum dma_data_direction direction)
103 {
104         struct dma_chan                 *chan;
105         struct dw_cyclic_desc           *cdesc;
106         struct snd_pcm_runtime          *runtime = substream->runtime;
107         unsigned long                   buffer_len, period_len;
108
109         /*
110          * We don't do DMA on "complex" transfers, i.e. with
111          * non-halfword-aligned buffers or lengths.
112          */
113         if (runtime->dma_addr & 1 || runtime->buffer_size & 1) {
114                 dev_dbg(&chip->pdev->dev, "too complex transfer\n");
115                 return -EINVAL;
116         }
117
118         if (direction == DMA_TO_DEVICE)
119                 chan = chip->dma.tx_chan;
120         else
121                 chan = chip->dma.rx_chan;
122
123         buffer_len = frames_to_bytes(runtime, runtime->buffer_size);
124         period_len = frames_to_bytes(runtime, runtime->period_size);
125
126         cdesc = dw_dma_cyclic_prep(chan, runtime->dma_addr, buffer_len,
127                         period_len, direction);
128         if (IS_ERR(cdesc)) {
129                 dev_dbg(&chip->pdev->dev, "could not prepare cyclic DMA\n");
130                 return PTR_ERR(cdesc);
131         }
132
133         if (direction == DMA_TO_DEVICE) {
134                 cdesc->period_callback = atmel_ac97c_dma_playback_period_done;
135                 set_bit(DMA_TX_READY, &chip->flags);
136         } else {
137                 cdesc->period_callback = atmel_ac97c_dma_capture_period_done;
138                 set_bit(DMA_RX_READY, &chip->flags);
139         }
140
141         cdesc->period_callback_param = chip;
142
143         return 0;
144 }
145
146 static struct snd_pcm_hardware atmel_ac97c_hw = {
147         .info                   = (SNDRV_PCM_INFO_MMAP
148                                   | SNDRV_PCM_INFO_MMAP_VALID
149                                   | SNDRV_PCM_INFO_INTERLEAVED
150                                   | SNDRV_PCM_INFO_BLOCK_TRANSFER
151                                   | SNDRV_PCM_INFO_JOINT_DUPLEX
152                                   | SNDRV_PCM_INFO_RESUME
153                                   | SNDRV_PCM_INFO_PAUSE),
154         .formats                = (SNDRV_PCM_FMTBIT_S16_BE
155                                   | SNDRV_PCM_FMTBIT_S16_LE),
156         .rates                  = (SNDRV_PCM_RATE_CONTINUOUS),
157         .rate_min               = 4000,
158         .rate_max               = 48000,
159         .channels_min           = 1,
160         .channels_max           = 2,
161         .buffer_bytes_max       = 2 * 2 * 64 * 2048,
162         .period_bytes_min       = 4096,
163         .period_bytes_max       = 4096,
164         .periods_min            = 6,
165         .periods_max            = 64,
166 };
167
168 static int atmel_ac97c_playback_open(struct snd_pcm_substream *substream)
169 {
170         struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
171         struct snd_pcm_runtime *runtime = substream->runtime;
172
173         mutex_lock(&opened_mutex);
174         chip->opened++;
175         runtime->hw = atmel_ac97c_hw;
176         if (chip->cur_rate) {
177                 runtime->hw.rate_min = chip->cur_rate;
178                 runtime->hw.rate_max = chip->cur_rate;
179         }
180         if (chip->cur_format)
181                 runtime->hw.formats = (1ULL << chip->cur_format);
182         mutex_unlock(&opened_mutex);
183         chip->playback_substream = substream;
184         return 0;
185 }
186
187 static int atmel_ac97c_capture_open(struct snd_pcm_substream *substream)
188 {
189         struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
190         struct snd_pcm_runtime *runtime = substream->runtime;
191
192         mutex_lock(&opened_mutex);
193         chip->opened++;
194         runtime->hw = atmel_ac97c_hw;
195         if (chip->cur_rate) {
196                 runtime->hw.rate_min = chip->cur_rate;
197                 runtime->hw.rate_max = chip->cur_rate;
198         }
199         if (chip->cur_format)
200                 runtime->hw.formats = (1ULL << chip->cur_format);
201         mutex_unlock(&opened_mutex);
202         chip->capture_substream = substream;
203         return 0;
204 }
205
206 static int atmel_ac97c_playback_close(struct snd_pcm_substream *substream)
207 {
208         struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
209
210         mutex_lock(&opened_mutex);
211         chip->opened--;
212         if (!chip->opened) {
213                 chip->cur_rate = 0;
214                 chip->cur_format = 0;
215         }
216         mutex_unlock(&opened_mutex);
217
218         chip->playback_substream = NULL;
219
220         return 0;
221 }
222
223 static int atmel_ac97c_capture_close(struct snd_pcm_substream *substream)
224 {
225         struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
226
227         mutex_lock(&opened_mutex);
228         chip->opened--;
229         if (!chip->opened) {
230                 chip->cur_rate = 0;
231                 chip->cur_format = 0;
232         }
233         mutex_unlock(&opened_mutex);
234
235         chip->capture_substream = NULL;
236
237         return 0;
238 }
239
240 static int atmel_ac97c_playback_hw_params(struct snd_pcm_substream *substream,
241                 struct snd_pcm_hw_params *hw_params)
242 {
243         struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
244         int retval;
245
246         retval = snd_pcm_lib_malloc_pages(substream,
247                                         params_buffer_bytes(hw_params));
248         if (retval < 0)
249                 return retval;
250         /* snd_pcm_lib_malloc_pages returns 1 if buffer is changed. */
251         if (cpu_is_at32ap7000()) {
252                 /* snd_pcm_lib_malloc_pages returns 1 if buffer is changed. */
253                 if (retval == 1)
254                         if (test_and_clear_bit(DMA_TX_READY, &chip->flags))
255                                 dw_dma_cyclic_free(chip->dma.tx_chan);
256         }
257         /* Set restrictions to params. */
258         mutex_lock(&opened_mutex);
259         chip->cur_rate = params_rate(hw_params);
260         chip->cur_format = params_format(hw_params);
261         mutex_unlock(&opened_mutex);
262
263         return retval;
264 }
265
266 static int atmel_ac97c_capture_hw_params(struct snd_pcm_substream *substream,
267                 struct snd_pcm_hw_params *hw_params)
268 {
269         struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
270         int retval;
271
272         retval = snd_pcm_lib_malloc_pages(substream,
273                                         params_buffer_bytes(hw_params));
274         if (retval < 0)
275                 return retval;
276         /* snd_pcm_lib_malloc_pages returns 1 if buffer is changed. */
277         if (cpu_is_at32ap7000()) {
278                 if (retval < 0)
279                         return retval;
280                 /* snd_pcm_lib_malloc_pages returns 1 if buffer is changed. */
281                 if (retval == 1)
282                         if (test_and_clear_bit(DMA_RX_READY, &chip->flags))
283                                 dw_dma_cyclic_free(chip->dma.rx_chan);
284         }
285
286         /* Set restrictions to params. */
287         mutex_lock(&opened_mutex);
288         chip->cur_rate = params_rate(hw_params);
289         chip->cur_format = params_format(hw_params);
290         mutex_unlock(&opened_mutex);
291
292         return retval;
293 }
294
295 static int atmel_ac97c_playback_hw_free(struct snd_pcm_substream *substream)
296 {
297         struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
298         if (cpu_is_at32ap7000()) {
299                 if (test_and_clear_bit(DMA_TX_READY, &chip->flags))
300                         dw_dma_cyclic_free(chip->dma.tx_chan);
301         }
302         return snd_pcm_lib_free_pages(substream);
303 }
304
305 static int atmel_ac97c_capture_hw_free(struct snd_pcm_substream *substream)
306 {
307         struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
308         if (cpu_is_at32ap7000()) {
309                 if (test_and_clear_bit(DMA_RX_READY, &chip->flags))
310                         dw_dma_cyclic_free(chip->dma.rx_chan);
311         }
312         return snd_pcm_lib_free_pages(substream);
313 }
314
315 static int atmel_ac97c_playback_prepare(struct snd_pcm_substream *substream)
316 {
317         struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
318         struct snd_pcm_runtime *runtime = substream->runtime;
319         int block_size = frames_to_bytes(runtime, runtime->period_size);
320         unsigned long word = ac97c_readl(chip, OCA);
321         int retval;
322
323         chip->playback_period = 0;
324         word &= ~(AC97C_CH_MASK(PCM_LEFT) | AC97C_CH_MASK(PCM_RIGHT));
325
326         /* assign channels to AC97C channel A */
327         switch (runtime->channels) {
328         case 1:
329                 word |= AC97C_CH_ASSIGN(PCM_LEFT, A);
330                 break;
331         case 2:
332                 word |= AC97C_CH_ASSIGN(PCM_LEFT, A)
333                         | AC97C_CH_ASSIGN(PCM_RIGHT, A);
334                 break;
335         default:
336                 /* TODO: support more than two channels */
337                 return -EINVAL;
338         }
339         ac97c_writel(chip, OCA, word);
340
341         /* configure sample format and size */
342         word = ac97c_readl(chip, CAMR);
343         if (chip->opened <= 1)
344                 word = AC97C_CMR_DMAEN | AC97C_CMR_SIZE_16;
345         else
346                 word |= AC97C_CMR_DMAEN | AC97C_CMR_SIZE_16;
347
348         switch (runtime->format) {
349         case SNDRV_PCM_FORMAT_S16_LE:
350                 if (cpu_is_at32ap7000())
351                         word |= AC97C_CMR_CEM_LITTLE;
352                 break;
353         case SNDRV_PCM_FORMAT_S16_BE: /* fall through */
354                 word &= ~(AC97C_CMR_CEM_LITTLE);
355                 break;
356         default:
357                 word = ac97c_readl(chip, OCA);
358                 word &= ~(AC97C_CH_MASK(PCM_LEFT) | AC97C_CH_MASK(PCM_RIGHT));
359                 ac97c_writel(chip, OCA, word);
360                 return -EINVAL;
361         }
362
363         /* Enable underrun interrupt on channel A */
364         word |= AC97C_CSR_UNRUN;
365
366         ac97c_writel(chip, CAMR, word);
367
368         /* Enable channel A event interrupt */
369         word = ac97c_readl(chip, IMR);
370         word |= AC97C_SR_CAEVT;
371         ac97c_writel(chip, IER, word);
372
373         /* set variable rate if needed */
374         if (runtime->rate != 48000) {
375                 word = ac97c_readl(chip, MR);
376                 word |= AC97C_MR_VRA;
377                 ac97c_writel(chip, MR, word);
378         } else {
379                 word = ac97c_readl(chip, MR);
380                 word &= ~(AC97C_MR_VRA);
381                 ac97c_writel(chip, MR, word);
382         }
383
384         retval = snd_ac97_set_rate(chip->ac97, AC97_PCM_FRONT_DAC_RATE,
385                         runtime->rate);
386         if (retval)
387                 dev_dbg(&chip->pdev->dev, "could not set rate %d Hz\n",
388                                 runtime->rate);
389
390         if (cpu_is_at32ap7000()) {
391                 if (!test_bit(DMA_TX_READY, &chip->flags))
392                         retval = atmel_ac97c_prepare_dma(chip, substream,
393                                         DMA_TO_DEVICE);
394         } else {
395                 /* Initialize and start the PDC */
396                 writel(runtime->dma_addr, chip->regs + ATMEL_PDC_TPR);
397                 writel(block_size / 2, chip->regs + ATMEL_PDC_TCR);
398                 writel(runtime->dma_addr + block_size,
399                                 chip->regs + ATMEL_PDC_TNPR);
400                 writel(block_size / 2, chip->regs + ATMEL_PDC_TNCR);
401         }
402
403         return retval;
404 }
405
406 static int atmel_ac97c_capture_prepare(struct snd_pcm_substream *substream)
407 {
408         struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
409         struct snd_pcm_runtime *runtime = substream->runtime;
410         int block_size = frames_to_bytes(runtime, runtime->period_size);
411         unsigned long word = ac97c_readl(chip, ICA);
412         int retval;
413
414         chip->capture_period = 0;
415         word &= ~(AC97C_CH_MASK(PCM_LEFT) | AC97C_CH_MASK(PCM_RIGHT));
416
417         /* assign channels to AC97C channel A */
418         switch (runtime->channels) {
419         case 1:
420                 word |= AC97C_CH_ASSIGN(PCM_LEFT, A);
421                 break;
422         case 2:
423                 word |= AC97C_CH_ASSIGN(PCM_LEFT, A)
424                         | AC97C_CH_ASSIGN(PCM_RIGHT, A);
425                 break;
426         default:
427                 /* TODO: support more than two channels */
428                 return -EINVAL;
429         }
430         ac97c_writel(chip, ICA, word);
431
432         /* configure sample format and size */
433         word = ac97c_readl(chip, CAMR);
434         if (chip->opened <= 1)
435                 word = AC97C_CMR_DMAEN | AC97C_CMR_SIZE_16;
436         else
437                 word |= AC97C_CMR_DMAEN | AC97C_CMR_SIZE_16;
438
439         switch (runtime->format) {
440         case SNDRV_PCM_FORMAT_S16_LE:
441                 if (cpu_is_at32ap7000())
442                         word |= AC97C_CMR_CEM_LITTLE;
443                 break;
444         case SNDRV_PCM_FORMAT_S16_BE: /* fall through */
445                 word &= ~(AC97C_CMR_CEM_LITTLE);
446                 break;
447         default:
448                 word = ac97c_readl(chip, ICA);
449                 word &= ~(AC97C_CH_MASK(PCM_LEFT) | AC97C_CH_MASK(PCM_RIGHT));
450                 ac97c_writel(chip, ICA, word);
451                 return -EINVAL;
452         }
453
454         /* Enable overrun interrupt on channel A */
455         word |= AC97C_CSR_OVRUN;
456
457         ac97c_writel(chip, CAMR, word);
458
459         /* Enable channel A event interrupt */
460         word = ac97c_readl(chip, IMR);
461         word |= AC97C_SR_CAEVT;
462         ac97c_writel(chip, IER, word);
463
464         /* set variable rate if needed */
465         if (runtime->rate != 48000) {
466                 word = ac97c_readl(chip, MR);
467                 word |= AC97C_MR_VRA;
468                 ac97c_writel(chip, MR, word);
469         } else {
470                 word = ac97c_readl(chip, MR);
471                 word &= ~(AC97C_MR_VRA);
472                 ac97c_writel(chip, MR, word);
473         }
474
475         retval = snd_ac97_set_rate(chip->ac97, AC97_PCM_LR_ADC_RATE,
476                         runtime->rate);
477         if (retval)
478                 dev_dbg(&chip->pdev->dev, "could not set rate %d Hz\n",
479                                 runtime->rate);
480
481         if (cpu_is_at32ap7000()) {
482                 if (!test_bit(DMA_RX_READY, &chip->flags))
483                         retval = atmel_ac97c_prepare_dma(chip, substream,
484                                         DMA_FROM_DEVICE);
485         } else {
486                 /* Initialize and start the PDC */
487                 writel(runtime->dma_addr, chip->regs + ATMEL_PDC_RPR);
488                 writel(block_size / 2, chip->regs + ATMEL_PDC_RCR);
489                 writel(runtime->dma_addr + block_size,
490                                 chip->regs + ATMEL_PDC_RNPR);
491                 writel(block_size / 2, chip->regs + ATMEL_PDC_RNCR);
492         }
493
494         return retval;
495 }
496
497 static int
498 atmel_ac97c_playback_trigger(struct snd_pcm_substream *substream, int cmd)
499 {
500         struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
501         unsigned long camr, ptcr = 0;
502         int retval = 0;
503
504         camr = ac97c_readl(chip, CAMR);
505
506         switch (cmd) {
507         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: /* fall through */
508         case SNDRV_PCM_TRIGGER_RESUME: /* fall through */
509         case SNDRV_PCM_TRIGGER_START:
510                 if (cpu_is_at32ap7000()) {
511                         retval = dw_dma_cyclic_start(chip->dma.tx_chan);
512                         if (retval)
513                                 goto out;
514                 } else {
515                         ptcr = ATMEL_PDC_TXTEN;
516                 }
517                 camr |= AC97C_CMR_CENA | AC97C_CSR_ENDTX;
518                 break;
519         case SNDRV_PCM_TRIGGER_PAUSE_PUSH: /* fall through */
520         case SNDRV_PCM_TRIGGER_SUSPEND: /* fall through */
521         case SNDRV_PCM_TRIGGER_STOP:
522                 if (cpu_is_at32ap7000())
523                         dw_dma_cyclic_stop(chip->dma.tx_chan);
524                 else
525                         ptcr |= ATMEL_PDC_TXTDIS;
526                 if (chip->opened <= 1)
527                         camr &= ~AC97C_CMR_CENA;
528                 break;
529         default:
530                 retval = -EINVAL;
531                 goto out;
532         }
533
534         ac97c_writel(chip, CAMR, camr);
535         if (!cpu_is_at32ap7000())
536                 writel(ptcr, chip->regs + ATMEL_PDC_PTCR);
537 out:
538         return retval;
539 }
540
541 static int
542 atmel_ac97c_capture_trigger(struct snd_pcm_substream *substream, int cmd)
543 {
544         struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
545         unsigned long camr, ptcr = 0;
546         int retval = 0;
547
548         camr = ac97c_readl(chip, CAMR);
549         ptcr = readl(chip->regs + ATMEL_PDC_PTSR);
550
551         switch (cmd) {
552         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: /* fall through */
553         case SNDRV_PCM_TRIGGER_RESUME: /* fall through */
554         case SNDRV_PCM_TRIGGER_START:
555                 if (cpu_is_at32ap7000()) {
556                         retval = dw_dma_cyclic_start(chip->dma.rx_chan);
557                         if (retval)
558                                 goto out;
559                 } else {
560                         ptcr = ATMEL_PDC_RXTEN;
561                 }
562                 camr |= AC97C_CMR_CENA | AC97C_CSR_ENDRX;
563                 break;
564         case SNDRV_PCM_TRIGGER_PAUSE_PUSH: /* fall through */
565         case SNDRV_PCM_TRIGGER_SUSPEND: /* fall through */
566         case SNDRV_PCM_TRIGGER_STOP:
567                 if (cpu_is_at32ap7000())
568                         dw_dma_cyclic_stop(chip->dma.rx_chan);
569                 else
570                         ptcr |= (ATMEL_PDC_RXTDIS);
571                 if (chip->opened <= 1)
572                         camr &= ~AC97C_CMR_CENA;
573                 break;
574         default:
575                 retval = -EINVAL;
576                 break;
577         }
578
579         ac97c_writel(chip, CAMR, camr);
580         if (!cpu_is_at32ap7000())
581                 writel(ptcr, chip->regs + ATMEL_PDC_PTCR);
582 out:
583         return retval;
584 }
585
586 static snd_pcm_uframes_t
587 atmel_ac97c_playback_pointer(struct snd_pcm_substream *substream)
588 {
589         struct atmel_ac97c      *chip = snd_pcm_substream_chip(substream);
590         struct snd_pcm_runtime  *runtime = substream->runtime;
591         snd_pcm_uframes_t       frames;
592         unsigned long           bytes;
593
594         if (cpu_is_at32ap7000())
595                 bytes = dw_dma_get_src_addr(chip->dma.tx_chan);
596         else
597                 bytes = readl(chip->regs + ATMEL_PDC_TPR);
598         bytes -= runtime->dma_addr;
599
600         frames = bytes_to_frames(runtime, bytes);
601         if (frames >= runtime->buffer_size)
602                 frames -= runtime->buffer_size;
603         return frames;
604 }
605
606 static snd_pcm_uframes_t
607 atmel_ac97c_capture_pointer(struct snd_pcm_substream *substream)
608 {
609         struct atmel_ac97c      *chip = snd_pcm_substream_chip(substream);
610         struct snd_pcm_runtime  *runtime = substream->runtime;
611         snd_pcm_uframes_t       frames;
612         unsigned long           bytes;
613
614         if (cpu_is_at32ap7000())
615                 bytes = dw_dma_get_dst_addr(chip->dma.rx_chan);
616         else
617                 bytes = readl(chip->regs + ATMEL_PDC_RPR);
618         bytes -= runtime->dma_addr;
619
620         frames = bytes_to_frames(runtime, bytes);
621         if (frames >= runtime->buffer_size)
622                 frames -= runtime->buffer_size;
623         return frames;
624 }
625
626 static struct snd_pcm_ops atmel_ac97_playback_ops = {
627         .open           = atmel_ac97c_playback_open,
628         .close          = atmel_ac97c_playback_close,
629         .ioctl          = snd_pcm_lib_ioctl,
630         .hw_params      = atmel_ac97c_playback_hw_params,
631         .hw_free        = atmel_ac97c_playback_hw_free,
632         .prepare        = atmel_ac97c_playback_prepare,
633         .trigger        = atmel_ac97c_playback_trigger,
634         .pointer        = atmel_ac97c_playback_pointer,
635 };
636
637 static struct snd_pcm_ops atmel_ac97_capture_ops = {
638         .open           = atmel_ac97c_capture_open,
639         .close          = atmel_ac97c_capture_close,
640         .ioctl          = snd_pcm_lib_ioctl,
641         .hw_params      = atmel_ac97c_capture_hw_params,
642         .hw_free        = atmel_ac97c_capture_hw_free,
643         .prepare        = atmel_ac97c_capture_prepare,
644         .trigger        = atmel_ac97c_capture_trigger,
645         .pointer        = atmel_ac97c_capture_pointer,
646 };
647
648 static irqreturn_t atmel_ac97c_interrupt(int irq, void *dev)
649 {
650         struct atmel_ac97c      *chip  = (struct atmel_ac97c *)dev;
651         irqreturn_t             retval = IRQ_NONE;
652         u32                     sr     = ac97c_readl(chip, SR);
653         u32                     casr   = ac97c_readl(chip, CASR);
654         u32                     cosr   = ac97c_readl(chip, COSR);
655         u32                     camr   = ac97c_readl(chip, CAMR);
656
657         if (sr & AC97C_SR_CAEVT) {
658                 struct snd_pcm_runtime *runtime;
659                 int offset, next_period, block_size;
660                 dev_dbg(&chip->pdev->dev, "channel A event%s%s%s%s%s%s\n",
661                                 casr & AC97C_CSR_OVRUN   ? " OVRUN"   : "",
662                                 casr & AC97C_CSR_RXRDY   ? " RXRDY"   : "",
663                                 casr & AC97C_CSR_UNRUN   ? " UNRUN"   : "",
664                                 casr & AC97C_CSR_TXEMPTY ? " TXEMPTY" : "",
665                                 casr & AC97C_CSR_TXRDY   ? " TXRDY"   : "",
666                                 !casr                    ? " NONE"    : "");
667                 if (!cpu_is_at32ap7000()) {
668                         if ((casr & camr) & AC97C_CSR_ENDTX) {
669                                 runtime = chip->playback_substream->runtime;
670                                 block_size = frames_to_bytes(runtime,
671                                                 runtime->period_size);
672                                 chip->playback_period++;
673
674                                 if (chip->playback_period == runtime->periods)
675                                         chip->playback_period = 0;
676                                 next_period = chip->playback_period + 1;
677                                 if (next_period == runtime->periods)
678                                         next_period = 0;
679
680                                 offset = block_size * next_period;
681
682                                 writel(runtime->dma_addr + offset,
683                                                 chip->regs + ATMEL_PDC_TNPR);
684                                 writel(block_size / 2,
685                                                 chip->regs + ATMEL_PDC_TNCR);
686
687                                 snd_pcm_period_elapsed(
688                                                 chip->playback_substream);
689                         }
690                         if ((casr & camr) & AC97C_CSR_ENDRX) {
691                                 runtime = chip->capture_substream->runtime;
692                                 block_size = frames_to_bytes(runtime,
693                                                 runtime->period_size);
694                                 chip->capture_period++;
695
696                                 if (chip->capture_period == runtime->periods)
697                                         chip->capture_period = 0;
698                                 next_period = chip->capture_period + 1;
699                                 if (next_period == runtime->periods)
700                                         next_period = 0;
701
702                                 offset = block_size * next_period;
703
704                                 writel(runtime->dma_addr + offset,
705                                                 chip->regs + ATMEL_PDC_RNPR);
706                                 writel(block_size / 2,
707                                                 chip->regs + ATMEL_PDC_RNCR);
708                                 snd_pcm_period_elapsed(chip->capture_substream);
709                         }
710                 }
711                 retval = IRQ_HANDLED;
712         }
713
714         if (sr & AC97C_SR_COEVT) {
715                 dev_info(&chip->pdev->dev, "codec channel event%s%s%s%s%s\n",
716                                 cosr & AC97C_CSR_OVRUN   ? " OVRUN"   : "",
717                                 cosr & AC97C_CSR_RXRDY   ? " RXRDY"   : "",
718                                 cosr & AC97C_CSR_TXEMPTY ? " TXEMPTY" : "",
719                                 cosr & AC97C_CSR_TXRDY   ? " TXRDY"   : "",
720                                 !cosr                    ? " NONE"    : "");
721                 retval = IRQ_HANDLED;
722         }
723
724         if (retval == IRQ_NONE) {
725                 dev_err(&chip->pdev->dev, "spurious interrupt sr 0x%08x "
726                                 "casr 0x%08x cosr 0x%08x\n", sr, casr, cosr);
727         }
728
729         return retval;
730 }
731
732 static struct ac97_pcm at91_ac97_pcm_defs[] __devinitdata = {
733         /* Playback */
734         {
735                 .exclusive = 1,
736                 .r = { {
737                         .slots = ((1 << AC97_SLOT_PCM_LEFT)
738                                   | (1 << AC97_SLOT_PCM_RIGHT)),
739                 } },
740         },
741         /* PCM in */
742         {
743                 .stream = 1,
744                 .exclusive = 1,
745                 .r = { {
746                         .slots = ((1 << AC97_SLOT_PCM_LEFT)
747                                         | (1 << AC97_SLOT_PCM_RIGHT)),
748                 } }
749         },
750         /* Mic in */
751         {
752                 .stream = 1,
753                 .exclusive = 1,
754                 .r = { {
755                         .slots = (1<<AC97_SLOT_MIC),
756                 } }
757         },
758 };
759
760 static int __devinit atmel_ac97c_pcm_new(struct atmel_ac97c *chip)
761 {
762         struct snd_pcm          *pcm;
763         struct snd_pcm_hardware hw = atmel_ac97c_hw;
764         int                     capture, playback, retval, err;
765
766         capture = test_bit(DMA_RX_CHAN_PRESENT, &chip->flags);
767         playback = test_bit(DMA_TX_CHAN_PRESENT, &chip->flags);
768
769         if (!cpu_is_at32ap7000()) {
770                 err = snd_ac97_pcm_assign(chip->ac97_bus,
771                                 ARRAY_SIZE(at91_ac97_pcm_defs),
772                                 at91_ac97_pcm_defs);
773                 if (err)
774                         return err;
775         }
776         retval = snd_pcm_new(chip->card, chip->card->shortname,
777                         chip->pdev->id, playback, capture, &pcm);
778         if (retval)
779                 return retval;
780
781         if (capture)
782                 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE,
783                                 &atmel_ac97_capture_ops);
784         if (playback)
785                 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK,
786                                 &atmel_ac97_playback_ops);
787
788         retval = snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV,
789                         &chip->pdev->dev, hw.periods_min * hw.period_bytes_min,
790                         hw.buffer_bytes_max);
791         if (retval)
792                 return retval;
793
794         pcm->private_data = chip;
795         pcm->info_flags = 0;
796         strcpy(pcm->name, chip->card->shortname);
797         chip->pcm = pcm;
798
799         return 0;
800 }
801
802 static int atmel_ac97c_mixer_new(struct atmel_ac97c *chip)
803 {
804         struct snd_ac97_template template;
805         memset(&template, 0, sizeof(template));
806         template.private_data = chip;
807         return snd_ac97_mixer(chip->ac97_bus, &template, &chip->ac97);
808 }
809
810 static void atmel_ac97c_write(struct snd_ac97 *ac97, unsigned short reg,
811                 unsigned short val)
812 {
813         struct atmel_ac97c *chip = get_chip(ac97);
814         unsigned long word;
815         int timeout = 40;
816
817         word = (reg & 0x7f) << 16 | val;
818
819         do {
820                 if (ac97c_readl(chip, COSR) & AC97C_CSR_TXRDY) {
821                         ac97c_writel(chip, COTHR, word);
822                         return;
823                 }
824                 udelay(1);
825         } while (--timeout);
826
827         dev_dbg(&chip->pdev->dev, "codec write timeout\n");
828 }
829
830 static unsigned short atmel_ac97c_read(struct snd_ac97 *ac97,
831                 unsigned short reg)
832 {
833         struct atmel_ac97c *chip = get_chip(ac97);
834         unsigned long word;
835         int timeout = 40;
836         int write = 10;
837
838         word = (0x80 | (reg & 0x7f)) << 16;
839
840         if ((ac97c_readl(chip, COSR) & AC97C_CSR_RXRDY) != 0)
841                 ac97c_readl(chip, CORHR);
842
843 retry_write:
844         timeout = 40;
845
846         do {
847                 if ((ac97c_readl(chip, COSR) & AC97C_CSR_TXRDY) != 0) {
848                         ac97c_writel(chip, COTHR, word);
849                         goto read_reg;
850                 }
851                 udelay(10);
852         } while (--timeout);
853
854         if (!--write)
855                 goto timed_out;
856         goto retry_write;
857
858 read_reg:
859         do {
860                 if ((ac97c_readl(chip, COSR) & AC97C_CSR_RXRDY) != 0) {
861                         unsigned short val = ac97c_readl(chip, CORHR);
862                         return val;
863                 }
864                 udelay(10);
865         } while (--timeout);
866
867         if (!--write)
868                 goto timed_out;
869         goto retry_write;
870
871 timed_out:
872         dev_dbg(&chip->pdev->dev, "codec read timeout\n");
873         return 0xffff;
874 }
875
876 static bool filter(struct dma_chan *chan, void *slave)
877 {
878         struct dw_dma_slave *dws = slave;
879
880         if (dws->dma_dev == chan->device->dev) {
881                 chan->private = dws;
882                 return true;
883         } else
884                 return false;
885 }
886
887 static void atmel_ac97c_reset(struct atmel_ac97c *chip)
888 {
889         ac97c_writel(chip, MR,   0);
890         ac97c_writel(chip, MR,   AC97C_MR_ENA);
891         ac97c_writel(chip, CAMR, 0);
892         ac97c_writel(chip, COMR, 0);
893
894         if (gpio_is_valid(chip->reset_pin)) {
895                 gpio_set_value(chip->reset_pin, 0);
896                 /* AC97 v2.2 specifications says minimum 1 us. */
897                 udelay(2);
898                 gpio_set_value(chip->reset_pin, 1);
899         }
900 }
901
902 static int __devinit atmel_ac97c_probe(struct platform_device *pdev)
903 {
904         struct snd_card                 *card;
905         struct atmel_ac97c              *chip;
906         struct resource                 *regs;
907         struct ac97c_platform_data      *pdata;
908         struct clk                      *pclk;
909         static struct snd_ac97_bus_ops  ops = {
910                 .write  = atmel_ac97c_write,
911                 .read   = atmel_ac97c_read,
912         };
913         int                             retval;
914         int                             irq;
915
916         regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);
917         if (!regs) {
918                 dev_dbg(&pdev->dev, "no memory resource\n");
919                 return -ENXIO;
920         }
921
922         pdata = pdev->dev.platform_data;
923         if (!pdata) {
924                 dev_dbg(&pdev->dev, "no platform data\n");
925                 return -ENXIO;
926         }
927
928         irq = platform_get_irq(pdev, 0);
929         if (irq < 0) {
930                 dev_dbg(&pdev->dev, "could not get irq\n");
931                 return -ENXIO;
932         }
933
934         if (cpu_is_at32ap7000()) {
935                 pclk = clk_get(&pdev->dev, "pclk");
936         } else {
937                 pclk = clk_get(&pdev->dev, "ac97_clk");
938         }
939
940         if (IS_ERR(pclk)) {
941                 dev_dbg(&pdev->dev, "no peripheral clock\n");
942                 return PTR_ERR(pclk);
943         }
944         clk_enable(pclk);
945
946         retval = snd_card_create(SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1,
947                         THIS_MODULE, sizeof(struct atmel_ac97c), &card);
948         if (retval) {
949                 dev_dbg(&pdev->dev, "could not create sound card device\n");
950                 goto err_snd_card_new;
951         }
952
953         chip = get_chip(card);
954
955         retval = request_irq(irq, atmel_ac97c_interrupt, 0, "AC97C", chip);
956         if (retval) {
957                 dev_dbg(&pdev->dev, "unable to request irq %d\n", irq);
958                 goto err_request_irq;
959         }
960         chip->irq = irq;
961
962         spin_lock_init(&chip->lock);
963
964         strcpy(card->driver, "Atmel AC97C");
965         strcpy(card->shortname, "Atmel AC97C");
966         sprintf(card->longname, "Atmel AC97 controller");
967
968         chip->card = card;
969         chip->pclk = pclk;
970         chip->pdev = pdev;
971         chip->regs = ioremap(regs->start, regs->end - regs->start + 1);
972
973         if (!chip->regs) {
974                 dev_dbg(&pdev->dev, "could not remap register memory\n");
975                 goto err_ioremap;
976         }
977
978         if (gpio_is_valid(pdata->reset_pin)) {
979                 if (gpio_request(pdata->reset_pin, "reset_pin")) {
980                         dev_dbg(&pdev->dev, "reset pin not available\n");
981                         chip->reset_pin = -ENODEV;
982                 } else {
983                         gpio_direction_output(pdata->reset_pin, 1);
984                         chip->reset_pin = pdata->reset_pin;
985                 }
986         }
987
988         snd_card_set_dev(card, &pdev->dev);
989
990         atmel_ac97c_reset(chip);
991
992         /* Enable overrun interrupt from codec channel */
993         ac97c_writel(chip, COMR, AC97C_CSR_OVRUN);
994         ac97c_writel(chip, IER, ac97c_readl(chip, IMR) | AC97C_SR_COEVT);
995
996         retval = snd_ac97_bus(card, 0, &ops, chip, &chip->ac97_bus);
997         if (retval) {
998                 dev_dbg(&pdev->dev, "could not register on ac97 bus\n");
999                 goto err_ac97_bus;
1000         }
1001
1002         retval = atmel_ac97c_mixer_new(chip);
1003         if (retval) {
1004                 dev_dbg(&pdev->dev, "could not register ac97 mixer\n");
1005                 goto err_ac97_bus;
1006         }
1007
1008         if (cpu_is_at32ap7000()) {
1009                 if (pdata->rx_dws.dma_dev) {
1010                         struct dw_dma_slave *dws = &pdata->rx_dws;
1011                         dma_cap_mask_t mask;
1012
1013                         dws->rx_reg = regs->start + AC97C_CARHR + 2;
1014
1015                         dma_cap_zero(mask);
1016                         dma_cap_set(DMA_SLAVE, mask);
1017
1018                         chip->dma.rx_chan = dma_request_channel(mask, filter,
1019                                                                 dws);
1020
1021                         dev_info(&chip->pdev->dev, "using %s for DMA RX\n",
1022                                 dev_name(&chip->dma.rx_chan->dev->device));
1023                         set_bit(DMA_RX_CHAN_PRESENT, &chip->flags);
1024                 }
1025
1026                 if (pdata->tx_dws.dma_dev) {
1027                         struct dw_dma_slave *dws = &pdata->tx_dws;
1028                         dma_cap_mask_t mask;
1029
1030                         dws->tx_reg = regs->start + AC97C_CATHR + 2;
1031
1032                         dma_cap_zero(mask);
1033                         dma_cap_set(DMA_SLAVE, mask);
1034
1035                         chip->dma.tx_chan = dma_request_channel(mask, filter,
1036                                                                 dws);
1037
1038                         dev_info(&chip->pdev->dev, "using %s for DMA TX\n",
1039                                 dev_name(&chip->dma.tx_chan->dev->device));
1040                         set_bit(DMA_TX_CHAN_PRESENT, &chip->flags);
1041                 }
1042
1043                 if (!test_bit(DMA_RX_CHAN_PRESENT, &chip->flags) &&
1044                                 !test_bit(DMA_TX_CHAN_PRESENT, &chip->flags)) {
1045                         dev_dbg(&pdev->dev, "DMA not available\n");
1046                         retval = -ENODEV;
1047                         goto err_dma;
1048                 }
1049         } else {
1050                 /* Just pretend that we have DMA channel(for at91 i is actually
1051                  * the PDC) */
1052                 set_bit(DMA_RX_CHAN_PRESENT, &chip->flags);
1053                 set_bit(DMA_TX_CHAN_PRESENT, &chip->flags);
1054         }
1055
1056         retval = atmel_ac97c_pcm_new(chip);
1057         if (retval) {
1058                 dev_dbg(&pdev->dev, "could not register ac97 pcm device\n");
1059                 goto err_dma;
1060         }
1061
1062         retval = snd_card_register(card);
1063         if (retval) {
1064                 dev_dbg(&pdev->dev, "could not register sound card\n");
1065                 goto err_dma;
1066         }
1067
1068         platform_set_drvdata(pdev, card);
1069
1070         dev_info(&pdev->dev, "Atmel AC97 controller at 0x%p, irq = %d\n",
1071                         chip->regs, irq);
1072
1073         return 0;
1074
1075 err_dma:
1076         if (cpu_is_at32ap7000()) {
1077                 if (test_bit(DMA_RX_CHAN_PRESENT, &chip->flags))
1078                         dma_release_channel(chip->dma.rx_chan);
1079                 if (test_bit(DMA_TX_CHAN_PRESENT, &chip->flags))
1080                         dma_release_channel(chip->dma.tx_chan);
1081                 clear_bit(DMA_RX_CHAN_PRESENT, &chip->flags);
1082                 clear_bit(DMA_TX_CHAN_PRESENT, &chip->flags);
1083                 chip->dma.rx_chan = NULL;
1084                 chip->dma.tx_chan = NULL;
1085         }
1086 err_ac97_bus:
1087         snd_card_set_dev(card, NULL);
1088
1089         if (gpio_is_valid(chip->reset_pin))
1090                 gpio_free(chip->reset_pin);
1091
1092         iounmap(chip->regs);
1093 err_ioremap:
1094         free_irq(irq, chip);
1095 err_request_irq:
1096         snd_card_free(card);
1097 err_snd_card_new:
1098         clk_disable(pclk);
1099         clk_put(pclk);
1100         return retval;
1101 }
1102
1103 #ifdef CONFIG_PM
1104 static int atmel_ac97c_suspend(struct platform_device *pdev, pm_message_t msg)
1105 {
1106         struct snd_card *card = platform_get_drvdata(pdev);
1107         struct atmel_ac97c *chip = card->private_data;
1108
1109         if (cpu_is_at32ap7000()) {
1110                 if (test_bit(DMA_RX_READY, &chip->flags))
1111                         dw_dma_cyclic_stop(chip->dma.rx_chan);
1112                 if (test_bit(DMA_TX_READY, &chip->flags))
1113                         dw_dma_cyclic_stop(chip->dma.tx_chan);
1114         }
1115         clk_disable(chip->pclk);
1116
1117         return 0;
1118 }
1119
1120 static int atmel_ac97c_resume(struct platform_device *pdev)
1121 {
1122         struct snd_card *card = platform_get_drvdata(pdev);
1123         struct atmel_ac97c *chip = card->private_data;
1124
1125         clk_enable(chip->pclk);
1126         if (cpu_is_at32ap7000()) {
1127                 if (test_bit(DMA_RX_READY, &chip->flags))
1128                         dw_dma_cyclic_start(chip->dma.rx_chan);
1129                 if (test_bit(DMA_TX_READY, &chip->flags))
1130                         dw_dma_cyclic_start(chip->dma.tx_chan);
1131         }
1132         return 0;
1133 }
1134 #else
1135 #define atmel_ac97c_suspend NULL
1136 #define atmel_ac97c_resume NULL
1137 #endif
1138
1139 static int __devexit atmel_ac97c_remove(struct platform_device *pdev)
1140 {
1141         struct snd_card *card = platform_get_drvdata(pdev);
1142         struct atmel_ac97c *chip = get_chip(card);
1143
1144         if (gpio_is_valid(chip->reset_pin))
1145                 gpio_free(chip->reset_pin);
1146
1147         ac97c_writel(chip, CAMR, 0);
1148         ac97c_writel(chip, COMR, 0);
1149         ac97c_writel(chip, MR,   0);
1150
1151         clk_disable(chip->pclk);
1152         clk_put(chip->pclk);
1153         iounmap(chip->regs);
1154         free_irq(chip->irq, chip);
1155
1156         if (cpu_is_at32ap7000()) {
1157                 if (test_bit(DMA_RX_CHAN_PRESENT, &chip->flags))
1158                         dma_release_channel(chip->dma.rx_chan);
1159                 if (test_bit(DMA_TX_CHAN_PRESENT, &chip->flags))
1160                         dma_release_channel(chip->dma.tx_chan);
1161                 clear_bit(DMA_RX_CHAN_PRESENT, &chip->flags);
1162                 clear_bit(DMA_TX_CHAN_PRESENT, &chip->flags);
1163                 chip->dma.rx_chan = NULL;
1164                 chip->dma.tx_chan = NULL;
1165         }
1166
1167         snd_card_set_dev(card, NULL);
1168         snd_card_free(card);
1169
1170         platform_set_drvdata(pdev, NULL);
1171
1172         return 0;
1173 }
1174
1175 static struct platform_driver atmel_ac97c_driver = {
1176         .remove         = __devexit_p(atmel_ac97c_remove),
1177         .driver         = {
1178                 .name   = "atmel_ac97c",
1179         },
1180         .suspend        = atmel_ac97c_suspend,
1181         .resume         = atmel_ac97c_resume,
1182 };
1183
1184 static int __init atmel_ac97c_init(void)
1185 {
1186         return platform_driver_probe(&atmel_ac97c_driver,
1187                         atmel_ac97c_probe);
1188 }
1189 module_init(atmel_ac97c_init);
1190
1191 static void __exit atmel_ac97c_exit(void)
1192 {
1193         platform_driver_unregister(&atmel_ac97c_driver);
1194 }
1195 module_exit(atmel_ac97c_exit);
1196
1197 MODULE_LICENSE("GPL");
1198 MODULE_DESCRIPTION("Driver for Atmel AC97 controller");
1199 MODULE_AUTHOR("Hans-Christian Egtvedt <hans-christian.egtvedt@atmel.com>");