aboutsummaryrefslogtreecommitdiffstats
path: root/sound/atmel/ac97c.c
diff options
context:
space:
mode:
authorHans-Christian Egtvedt <hans-christian.egtvedt@atmel.com>2009-02-05 07:11:00 -0500
committerTakashi Iwai <tiwai@suse.de>2009-02-05 09:08:51 -0500
commit4ede028f8716523fc31e0d3d01b81405613dfb8f (patch)
treebd8e9ebd0396e1e687f8bd5bd8b2b53f89a53ea1 /sound/atmel/ac97c.c
parente4967d6016b7785edafdb871e6d3e4426cb4bd1f (diff)
ALSA: Add ALSA driver for Atmel AC97 controller
This patch adds ALSA support for the AC97 controller found on Atmel AVR32 devices. Tested on ATSTK1006 + ATSTK1000 with a development board with a AC97 codec. Signed-off-by: Hans-Christian Egtvedt <hans-christian.egtvedt@atmel.com> Signed-off-by: Takashi Iwai <tiwai@suse.de>
Diffstat (limited to 'sound/atmel/ac97c.c')
-rw-r--r--sound/atmel/ac97c.c932
1 files changed, 932 insertions, 0 deletions
diff --git a/sound/atmel/ac97c.c b/sound/atmel/ac97c.c
new file mode 100644
index 000000000000..dd72e00e5ae1
--- /dev/null
+++ b/sound/atmel/ac97c.c
@@ -0,0 +1,932 @@
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
35enum {
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 */
43static DEFINE_MUTEX(opened_mutex);
44
45struct atmel_ac97c_dma {
46 struct dma_chan *rx_chan;
47 struct dma_chan *tx_chan;
48};
49
50struct 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. */
80static 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
86static 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
92static 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
138static 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
160static 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
179static 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
198static 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
215static 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
232static 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
256static 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
280static 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
288static 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
296static 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
358static 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
420static int
421atmel_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);
451out:
452 return retval;
453}
454
455static int
456atmel_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);
486out:
487 return retval;
488}
489
490static snd_pcm_uframes_t
491atmel_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
507static snd_pcm_uframes_t
508atmel_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
524static 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
535static 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
546static 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
581static 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
589static 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
609static 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
622retry_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
637read_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
650timed_out:
651 dev_dbg(&chip->pdev->dev, "codec read timeout\n");
652 return 0xffff;
653}
654
655static 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
666static 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
681static 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
822err_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;
831err_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);
838err_ioremap:
839 snd_card_free(card);
840err_snd_card_new:
841 clk_disable(pclk);
842 clk_put(pclk);
843 return retval;
844}
845
846#ifdef CONFIG_PM
847static 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
861static 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
879static 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
908static 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
917static int __init atmel_ac97c_init(void)
918{
919 return platform_driver_probe(&atmel_ac97c_driver,
920 atmel_ac97c_probe);
921}
922module_init(atmel_ac97c_init);
923
924static void __exit atmel_ac97c_exit(void)
925{
926 platform_driver_unregister(&atmel_ac97c_driver);
927}
928module_exit(atmel_ac97c_exit);
929
930MODULE_LICENSE("GPL");
931MODULE_DESCRIPTION("Driver for Atmel AC97 controller");
932MODULE_AUTHOR("Hans-Christian Egtvedt <hans-christian.egtvedt@atmel.com>");
generated by cgit v1.2.2 (git 2.25.0) at 2024-11-16 13:20:02 -0500