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