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