?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
IPVS: skb defrag in L7 helpers
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / sound / atmel / ac97c.c
blob10c3a871a12d904bad20cff78dfce56e8373cb92
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>");
Linux 2.6 ibm-acpi/thinkpad-acpi driver git tree