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/module.h>
16 #include <linux/platform_device.h>
17 #include <linux/mutex.h>
18 #include <linux/types.h>
19 #include <linux/io.h>
20 #include <linux/of.h>
21 #include <linux/of_device.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/memalloc.h>
29
30 #include "ac97c.h"
31
32 /* Serialize access to opened variable */
33 static DEFINE_MUTEX(opened_mutex);
34
35 struct atmel_ac97c {
36 struct clk *pclk;
37 struct platform_device *pdev;
38
39 struct snd_pcm_substream *playback_substream;
40 struct snd_pcm_substream *capture_substream;
41 struct snd_card *card;
42 struct snd_pcm *pcm;
43 struct snd_ac97 *ac97;
44 struct snd_ac97_bus *ac97_bus;
45
46 u64 cur_format;
47 unsigned int cur_rate;
48 int playback_period, capture_period;
49 /* Serialize access to opened variable */
50 spinlock_t lock;
51 void __iomem *regs;
52 int irq;
53 int opened;
54 struct gpio_desc *reset_pin;
55 };
56
57 #define get_chip(card) ((struct atmel_ac97c *)(card)->private_data)
58
59 #define ac97c_writel(chip, reg, val) \
60 __raw_writel((val), (chip)->regs + AC97C_##reg)
61 #define ac97c_readl(chip, reg) \
62 __raw_readl((chip)->regs + AC97C_##reg)
63
64 static const struct snd_pcm_hardware atmel_ac97c_hw = {
65 .info = (SNDRV_PCM_INFO_MMAP
66 | SNDRV_PCM_INFO_MMAP_VALID
67 | SNDRV_PCM_INFO_INTERLEAVED
68 | SNDRV_PCM_INFO_BLOCK_TRANSFER
69 | SNDRV_PCM_INFO_JOINT_DUPLEX
70 | SNDRV_PCM_INFO_RESUME
71 | SNDRV_PCM_INFO_PAUSE),
72 .formats = (SNDRV_PCM_FMTBIT_S16_BE
73 | SNDRV_PCM_FMTBIT_S16_LE),
74 .rates = (SNDRV_PCM_RATE_CONTINUOUS),
75 .rate_min = 4000,
76 .rate_max = 48000,
77 .channels_min = 1,
78 .channels_max = 2,
79 .buffer_bytes_max = 2 * 2 * 64 * 2048,
80 .period_bytes_min = 4096,
81 .period_bytes_max = 4096,
82 .periods_min = 6,
83 .periods_max = 64,
84 };
85
atmel_ac97c_playback_open(struct snd_pcm_substream * substream)86 static int atmel_ac97c_playback_open(struct snd_pcm_substream *substream)
87 {
88 struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
89 struct snd_pcm_runtime *runtime = substream->runtime;
90
91 mutex_lock(&opened_mutex);
92 chip->opened++;
93 runtime->hw = atmel_ac97c_hw;
94 if (chip->cur_rate) {
95 runtime->hw.rate_min = chip->cur_rate;
96 runtime->hw.rate_max = chip->cur_rate;
97 }
98 if (chip->cur_format)
99 runtime->hw.formats = pcm_format_to_bits(chip->cur_format);
100 mutex_unlock(&opened_mutex);
101 chip->playback_substream = substream;
102 return 0;
103 }
104
atmel_ac97c_capture_open(struct snd_pcm_substream * substream)105 static int atmel_ac97c_capture_open(struct snd_pcm_substream *substream)
106 {
107 struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
108 struct snd_pcm_runtime *runtime = substream->runtime;
109
110 mutex_lock(&opened_mutex);
111 chip->opened++;
112 runtime->hw = atmel_ac97c_hw;
113 if (chip->cur_rate) {
114 runtime->hw.rate_min = chip->cur_rate;
115 runtime->hw.rate_max = chip->cur_rate;
116 }
117 if (chip->cur_format)
118 runtime->hw.formats = pcm_format_to_bits(chip->cur_format);
119 mutex_unlock(&opened_mutex);
120 chip->capture_substream = substream;
121 return 0;
122 }
123
atmel_ac97c_playback_close(struct snd_pcm_substream * substream)124 static int atmel_ac97c_playback_close(struct snd_pcm_substream *substream)
125 {
126 struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
127
128 mutex_lock(&opened_mutex);
129 chip->opened--;
130 if (!chip->opened) {
131 chip->cur_rate = 0;
132 chip->cur_format = 0;
133 }
134 mutex_unlock(&opened_mutex);
135
136 chip->playback_substream = NULL;
137
138 return 0;
139 }
140
atmel_ac97c_capture_close(struct snd_pcm_substream * substream)141 static int atmel_ac97c_capture_close(struct snd_pcm_substream *substream)
142 {
143 struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
144
145 mutex_lock(&opened_mutex);
146 chip->opened--;
147 if (!chip->opened) {
148 chip->cur_rate = 0;
149 chip->cur_format = 0;
150 }
151 mutex_unlock(&opened_mutex);
152
153 chip->capture_substream = NULL;
154
155 return 0;
156 }
157
atmel_ac97c_playback_hw_params(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * hw_params)158 static int atmel_ac97c_playback_hw_params(struct snd_pcm_substream *substream,
159 struct snd_pcm_hw_params *hw_params)
160 {
161 struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
162
163 /* Set restrictions to params. */
164 mutex_lock(&opened_mutex);
165 chip->cur_rate = params_rate(hw_params);
166 chip->cur_format = params_format(hw_params);
167 mutex_unlock(&opened_mutex);
168
169 return 0;
170 }
171
atmel_ac97c_capture_hw_params(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * hw_params)172 static int atmel_ac97c_capture_hw_params(struct snd_pcm_substream *substream,
173 struct snd_pcm_hw_params *hw_params)
174 {
175 struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
176
177 /* Set restrictions to params. */
178 mutex_lock(&opened_mutex);
179 chip->cur_rate = params_rate(hw_params);
180 chip->cur_format = params_format(hw_params);
181 mutex_unlock(&opened_mutex);
182
183 return 0;
184 }
185
atmel_ac97c_playback_prepare(struct snd_pcm_substream * substream)186 static int atmel_ac97c_playback_prepare(struct snd_pcm_substream *substream)
187 {
188 struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
189 struct snd_pcm_runtime *runtime = substream->runtime;
190 int block_size = frames_to_bytes(runtime, runtime->period_size);
191 unsigned long word = ac97c_readl(chip, OCA);
192 int retval;
193
194 chip->playback_period = 0;
195 word &= ~(AC97C_CH_MASK(PCM_LEFT) | AC97C_CH_MASK(PCM_RIGHT));
196
197 /* assign channels to AC97C channel A */
198 switch (runtime->channels) {
199 case 1:
200 word |= AC97C_CH_ASSIGN(PCM_LEFT, A);
201 break;
202 case 2:
203 word |= AC97C_CH_ASSIGN(PCM_LEFT, A)
204 | AC97C_CH_ASSIGN(PCM_RIGHT, A);
205 break;
206 default:
207 /* TODO: support more than two channels */
208 return -EINVAL;
209 }
210 ac97c_writel(chip, OCA, word);
211
212 /* configure sample format and size */
213 word = ac97c_readl(chip, CAMR);
214 if (chip->opened <= 1)
215 word = AC97C_CMR_DMAEN | AC97C_CMR_SIZE_16;
216 else
217 word |= AC97C_CMR_DMAEN | AC97C_CMR_SIZE_16;
218
219 switch (runtime->format) {
220 case SNDRV_PCM_FORMAT_S16_LE:
221 break;
222 case SNDRV_PCM_FORMAT_S16_BE:
223 word &= ~(AC97C_CMR_CEM_LITTLE);
224 break;
225 default:
226 word = ac97c_readl(chip, OCA);
227 word &= ~(AC97C_CH_MASK(PCM_LEFT) | AC97C_CH_MASK(PCM_RIGHT));
228 ac97c_writel(chip, OCA, word);
229 return -EINVAL;
230 }
231
232 /* Enable underrun interrupt on channel A */
233 word |= AC97C_CSR_UNRUN;
234
235 ac97c_writel(chip, CAMR, word);
236
237 /* Enable channel A event interrupt */
238 word = ac97c_readl(chip, IMR);
239 word |= AC97C_SR_CAEVT;
240 ac97c_writel(chip, IER, word);
241
242 /* set variable rate if needed */
243 if (runtime->rate != 48000) {
244 word = ac97c_readl(chip, MR);
245 word |= AC97C_MR_VRA;
246 ac97c_writel(chip, MR, word);
247 } else {
248 word = ac97c_readl(chip, MR);
249 word &= ~(AC97C_MR_VRA);
250 ac97c_writel(chip, MR, word);
251 }
252
253 retval = snd_ac97_set_rate(chip->ac97, AC97_PCM_FRONT_DAC_RATE,
254 runtime->rate);
255 if (retval)
256 dev_dbg(&chip->pdev->dev, "could not set rate %d Hz\n",
257 runtime->rate);
258
259 /* Initialize and start the PDC */
260 writel(runtime->dma_addr, chip->regs + ATMEL_PDC_TPR);
261 writel(block_size / 2, chip->regs + ATMEL_PDC_TCR);
262 writel(runtime->dma_addr + block_size, chip->regs + ATMEL_PDC_TNPR);
263 writel(block_size / 2, chip->regs + ATMEL_PDC_TNCR);
264
265 return retval;
266 }
267
atmel_ac97c_capture_prepare(struct snd_pcm_substream * substream)268 static int atmel_ac97c_capture_prepare(struct snd_pcm_substream *substream)
269 {
270 struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
271 struct snd_pcm_runtime *runtime = substream->runtime;
272 int block_size = frames_to_bytes(runtime, runtime->period_size);
273 unsigned long word = ac97c_readl(chip, ICA);
274 int retval;
275
276 chip->capture_period = 0;
277 word &= ~(AC97C_CH_MASK(PCM_LEFT) | AC97C_CH_MASK(PCM_RIGHT));
278
279 /* assign channels to AC97C channel A */
280 switch (runtime->channels) {
281 case 1:
282 word |= AC97C_CH_ASSIGN(PCM_LEFT, A);
283 break;
284 case 2:
285 word |= AC97C_CH_ASSIGN(PCM_LEFT, A)
286 | AC97C_CH_ASSIGN(PCM_RIGHT, A);
287 break;
288 default:
289 /* TODO: support more than two channels */
290 return -EINVAL;
291 }
292 ac97c_writel(chip, ICA, word);
293
294 /* configure sample format and size */
295 word = ac97c_readl(chip, CAMR);
296 if (chip->opened <= 1)
297 word = AC97C_CMR_DMAEN | AC97C_CMR_SIZE_16;
298 else
299 word |= AC97C_CMR_DMAEN | AC97C_CMR_SIZE_16;
300
301 switch (runtime->format) {
302 case SNDRV_PCM_FORMAT_S16_LE:
303 break;
304 case SNDRV_PCM_FORMAT_S16_BE:
305 word &= ~(AC97C_CMR_CEM_LITTLE);
306 break;
307 default:
308 word = ac97c_readl(chip, ICA);
309 word &= ~(AC97C_CH_MASK(PCM_LEFT) | AC97C_CH_MASK(PCM_RIGHT));
310 ac97c_writel(chip, ICA, word);
311 return -EINVAL;
312 }
313
314 /* Enable overrun interrupt on channel A */
315 word |= AC97C_CSR_OVRUN;
316
317 ac97c_writel(chip, CAMR, word);
318
319 /* Enable channel A event interrupt */
320 word = ac97c_readl(chip, IMR);
321 word |= AC97C_SR_CAEVT;
322 ac97c_writel(chip, IER, word);
323
324 /* set variable rate if needed */
325 if (runtime->rate != 48000) {
326 word = ac97c_readl(chip, MR);
327 word |= AC97C_MR_VRA;
328 ac97c_writel(chip, MR, word);
329 } else {
330 word = ac97c_readl(chip, MR);
331 word &= ~(AC97C_MR_VRA);
332 ac97c_writel(chip, MR, word);
333 }
334
335 retval = snd_ac97_set_rate(chip->ac97, AC97_PCM_LR_ADC_RATE,
336 runtime->rate);
337 if (retval)
338 dev_dbg(&chip->pdev->dev, "could not set rate %d Hz\n",
339 runtime->rate);
340
341 /* Initialize and start the PDC */
342 writel(runtime->dma_addr, chip->regs + ATMEL_PDC_RPR);
343 writel(block_size / 2, chip->regs + ATMEL_PDC_RCR);
344 writel(runtime->dma_addr + block_size, chip->regs + ATMEL_PDC_RNPR);
345 writel(block_size / 2, chip->regs + ATMEL_PDC_RNCR);
346
347 return retval;
348 }
349
350 static int
atmel_ac97c_playback_trigger(struct snd_pcm_substream * substream,int cmd)351 atmel_ac97c_playback_trigger(struct snd_pcm_substream *substream, int cmd)
352 {
353 struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
354 unsigned long camr, ptcr = 0;
355
356 camr = ac97c_readl(chip, CAMR);
357
358 switch (cmd) {
359 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
360 case SNDRV_PCM_TRIGGER_RESUME:
361 case SNDRV_PCM_TRIGGER_START:
362 ptcr = ATMEL_PDC_TXTEN;
363 camr |= AC97C_CMR_CENA | AC97C_CSR_ENDTX;
364 break;
365 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
366 case SNDRV_PCM_TRIGGER_SUSPEND:
367 case SNDRV_PCM_TRIGGER_STOP:
368 ptcr |= ATMEL_PDC_TXTDIS;
369 if (chip->opened <= 1)
370 camr &= ~AC97C_CMR_CENA;
371 break;
372 default:
373 return -EINVAL;
374 }
375
376 ac97c_writel(chip, CAMR, camr);
377 writel(ptcr, chip->regs + ATMEL_PDC_PTCR);
378 return 0;
379 }
380
381 static int
atmel_ac97c_capture_trigger(struct snd_pcm_substream * substream,int cmd)382 atmel_ac97c_capture_trigger(struct snd_pcm_substream *substream, int cmd)
383 {
384 struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
385 unsigned long camr, ptcr = 0;
386
387 camr = ac97c_readl(chip, CAMR);
388 ptcr = readl(chip->regs + ATMEL_PDC_PTSR);
389
390 switch (cmd) {
391 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
392 case SNDRV_PCM_TRIGGER_RESUME:
393 case SNDRV_PCM_TRIGGER_START:
394 ptcr = ATMEL_PDC_RXTEN;
395 camr |= AC97C_CMR_CENA | AC97C_CSR_ENDRX;
396 break;
397 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
398 case SNDRV_PCM_TRIGGER_SUSPEND:
399 case SNDRV_PCM_TRIGGER_STOP:
400 ptcr |= ATMEL_PDC_RXTDIS;
401 if (chip->opened <= 1)
402 camr &= ~AC97C_CMR_CENA;
403 break;
404 default:
405 return -EINVAL;
406 }
407
408 ac97c_writel(chip, CAMR, camr);
409 writel(ptcr, chip->regs + ATMEL_PDC_PTCR);
410 return 0;
411 }
412
413 static snd_pcm_uframes_t
atmel_ac97c_playback_pointer(struct snd_pcm_substream * substream)414 atmel_ac97c_playback_pointer(struct snd_pcm_substream *substream)
415 {
416 struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
417 struct snd_pcm_runtime *runtime = substream->runtime;
418 snd_pcm_uframes_t frames;
419 unsigned long bytes;
420
421 bytes = readl(chip->regs + ATMEL_PDC_TPR);
422 bytes -= runtime->dma_addr;
423
424 frames = bytes_to_frames(runtime, bytes);
425 if (frames >= runtime->buffer_size)
426 frames -= runtime->buffer_size;
427 return frames;
428 }
429
430 static snd_pcm_uframes_t
atmel_ac97c_capture_pointer(struct snd_pcm_substream * substream)431 atmel_ac97c_capture_pointer(struct snd_pcm_substream *substream)
432 {
433 struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
434 struct snd_pcm_runtime *runtime = substream->runtime;
435 snd_pcm_uframes_t frames;
436 unsigned long bytes;
437
438 bytes = readl(chip->regs + ATMEL_PDC_RPR);
439 bytes -= runtime->dma_addr;
440
441 frames = bytes_to_frames(runtime, bytes);
442 if (frames >= runtime->buffer_size)
443 frames -= runtime->buffer_size;
444 return frames;
445 }
446
447 static const struct snd_pcm_ops atmel_ac97_playback_ops = {
448 .open = atmel_ac97c_playback_open,
449 .close = atmel_ac97c_playback_close,
450 .hw_params = atmel_ac97c_playback_hw_params,
451 .prepare = atmel_ac97c_playback_prepare,
452 .trigger = atmel_ac97c_playback_trigger,
453 .pointer = atmel_ac97c_playback_pointer,
454 };
455
456 static const struct snd_pcm_ops atmel_ac97_capture_ops = {
457 .open = atmel_ac97c_capture_open,
458 .close = atmel_ac97c_capture_close,
459 .hw_params = atmel_ac97c_capture_hw_params,
460 .prepare = atmel_ac97c_capture_prepare,
461 .trigger = atmel_ac97c_capture_trigger,
462 .pointer = atmel_ac97c_capture_pointer,
463 };
464
atmel_ac97c_interrupt(int irq,void * dev)465 static irqreturn_t atmel_ac97c_interrupt(int irq, void *dev)
466 {
467 struct atmel_ac97c *chip = (struct atmel_ac97c *)dev;
468 irqreturn_t retval = IRQ_NONE;
469 u32 sr = ac97c_readl(chip, SR);
470 u32 casr = ac97c_readl(chip, CASR);
471 u32 cosr = ac97c_readl(chip, COSR);
472 u32 camr = ac97c_readl(chip, CAMR);
473
474 if (sr & AC97C_SR_CAEVT) {
475 struct snd_pcm_runtime *runtime;
476 int offset, next_period, block_size;
477 dev_dbg(&chip->pdev->dev, "channel A event%s%s%s%s%s%s\n",
478 (casr & AC97C_CSR_OVRUN) ? " OVRUN" : "",
479 (casr & AC97C_CSR_RXRDY) ? " RXRDY" : "",
480 (casr & AC97C_CSR_UNRUN) ? " UNRUN" : "",
481 (casr & AC97C_CSR_TXEMPTY) ? " TXEMPTY" : "",
482 (casr & AC97C_CSR_TXRDY) ? " TXRDY" : "",
483 !casr ? " NONE" : "");
484 if ((casr & camr) & AC97C_CSR_ENDTX) {
485 runtime = chip->playback_substream->runtime;
486 block_size = frames_to_bytes(runtime, runtime->period_size);
487 chip->playback_period++;
488
489 if (chip->playback_period == runtime->periods)
490 chip->playback_period = 0;
491 next_period = chip->playback_period + 1;
492 if (next_period == runtime->periods)
493 next_period = 0;
494
495 offset = block_size * next_period;
496
497 writel(runtime->dma_addr + offset, chip->regs + ATMEL_PDC_TNPR);
498 writel(block_size / 2, chip->regs + ATMEL_PDC_TNCR);
499
500 snd_pcm_period_elapsed(chip->playback_substream);
501 }
502 if ((casr & camr) & AC97C_CSR_ENDRX) {
503 runtime = chip->capture_substream->runtime;
504 block_size = frames_to_bytes(runtime, runtime->period_size);
505 chip->capture_period++;
506
507 if (chip->capture_period == runtime->periods)
508 chip->capture_period = 0;
509 next_period = chip->capture_period + 1;
510 if (next_period == runtime->periods)
511 next_period = 0;
512
513 offset = block_size * next_period;
514
515 writel(runtime->dma_addr + offset, chip->regs + ATMEL_PDC_RNPR);
516 writel(block_size / 2, chip->regs + ATMEL_PDC_RNCR);
517 snd_pcm_period_elapsed(chip->capture_substream);
518 }
519 retval = IRQ_HANDLED;
520 }
521
522 if (sr & AC97C_SR_COEVT) {
523 dev_info(&chip->pdev->dev, "codec channel event%s%s%s%s%s\n",
524 (cosr & AC97C_CSR_OVRUN) ? " OVRUN" : "",
525 (cosr & AC97C_CSR_RXRDY) ? " RXRDY" : "",
526 (cosr & AC97C_CSR_TXEMPTY) ? " TXEMPTY" : "",
527 (cosr & AC97C_CSR_TXRDY) ? " TXRDY" : "",
528 !cosr ? " NONE" : "");
529 retval = IRQ_HANDLED;
530 }
531
532 if (retval == IRQ_NONE) {
533 dev_err(&chip->pdev->dev, "spurious interrupt sr 0x%08x "
534 "casr 0x%08x cosr 0x%08x\n", sr, casr, cosr);
535 }
536
537 return retval;
538 }
539
540 static const struct ac97_pcm at91_ac97_pcm_defs[] = {
541 /* Playback */
542 {
543 .exclusive = 1,
544 .r = { {
545 .slots = ((1 << AC97_SLOT_PCM_LEFT)
546 | (1 << AC97_SLOT_PCM_RIGHT)),
547 } },
548 },
549 /* PCM in */
550 {
551 .stream = 1,
552 .exclusive = 1,
553 .r = { {
554 .slots = ((1 << AC97_SLOT_PCM_LEFT)
555 | (1 << AC97_SLOT_PCM_RIGHT)),
556 } }
557 },
558 /* Mic in */
559 {
560 .stream = 1,
561 .exclusive = 1,
562 .r = { {
563 .slots = (1<<AC97_SLOT_MIC),
564 } }
565 },
566 };
567
atmel_ac97c_pcm_new(struct atmel_ac97c * chip)568 static int atmel_ac97c_pcm_new(struct atmel_ac97c *chip)
569 {
570 struct snd_pcm *pcm;
571 struct snd_pcm_hardware hw = atmel_ac97c_hw;
572 int retval;
573
574 retval = snd_ac97_pcm_assign(chip->ac97_bus,
575 ARRAY_SIZE(at91_ac97_pcm_defs),
576 at91_ac97_pcm_defs);
577 if (retval)
578 return retval;
579
580 retval = snd_pcm_new(chip->card, chip->card->shortname, 0, 1, 1, &pcm);
581 if (retval)
582 return retval;
583
584 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &atmel_ac97_capture_ops);
585 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &atmel_ac97_playback_ops);
586
587 snd_pcm_set_managed_buffer_all(pcm, SNDRV_DMA_TYPE_DEV,
588 &chip->pdev->dev, hw.periods_min * hw.period_bytes_min,
589 hw.buffer_bytes_max);
590
591 pcm->private_data = chip;
592 pcm->info_flags = 0;
593 strcpy(pcm->name, chip->card->shortname);
594 chip->pcm = pcm;
595
596 return 0;
597 }
598
atmel_ac97c_mixer_new(struct atmel_ac97c * chip)599 static int atmel_ac97c_mixer_new(struct atmel_ac97c *chip)
600 {
601 struct snd_ac97_template template;
602 memset(&template, 0, sizeof(template));
603 template.private_data = chip;
604 return snd_ac97_mixer(chip->ac97_bus, &template, &chip->ac97);
605 }
606
atmel_ac97c_write(struct snd_ac97 * ac97,unsigned short reg,unsigned short val)607 static void atmel_ac97c_write(struct snd_ac97 *ac97, unsigned short reg,
608 unsigned short val)
609 {
610 struct atmel_ac97c *chip = get_chip(ac97);
611 unsigned long word;
612 int timeout = 40;
613
614 word = (reg & 0x7f) << 16 | val;
615
616 do {
617 if (ac97c_readl(chip, COSR) & AC97C_CSR_TXRDY) {
618 ac97c_writel(chip, COTHR, word);
619 return;
620 }
621 udelay(1);
622 } while (--timeout);
623
624 dev_dbg(&chip->pdev->dev, "codec write timeout\n");
625 }
626
atmel_ac97c_read(struct snd_ac97 * ac97,unsigned short reg)627 static unsigned short atmel_ac97c_read(struct snd_ac97 *ac97,
628 unsigned short reg)
629 {
630 struct atmel_ac97c *chip = get_chip(ac97);
631 unsigned long word;
632 int timeout = 40;
633 int write = 10;
634
635 word = (0x80 | (reg & 0x7f)) << 16;
636
637 if ((ac97c_readl(chip, COSR) & AC97C_CSR_RXRDY) != 0)
638 ac97c_readl(chip, CORHR);
639
640 retry_write:
641 timeout = 40;
642
643 do {
644 if ((ac97c_readl(chip, COSR) & AC97C_CSR_TXRDY) != 0) {
645 ac97c_writel(chip, COTHR, word);
646 goto read_reg;
647 }
648 udelay(10);
649 } while (--timeout);
650
651 if (!--write)
652 goto timed_out;
653 goto retry_write;
654
655 read_reg:
656 do {
657 if ((ac97c_readl(chip, COSR) & AC97C_CSR_RXRDY) != 0) {
658 unsigned short val = ac97c_readl(chip, CORHR);
659 return val;
660 }
661 udelay(10);
662 } while (--timeout);
663
664 if (!--write)
665 goto timed_out;
666 goto retry_write;
667
668 timed_out:
669 dev_dbg(&chip->pdev->dev, "codec read timeout\n");
670 return 0xffff;
671 }
672
atmel_ac97c_reset(struct atmel_ac97c * chip)673 static void atmel_ac97c_reset(struct atmel_ac97c *chip)
674 {
675 ac97c_writel(chip, MR, 0);
676 ac97c_writel(chip, MR, AC97C_MR_ENA);
677 ac97c_writel(chip, CAMR, 0);
678 ac97c_writel(chip, COMR, 0);
679
680 if (!IS_ERR(chip->reset_pin)) {
681 gpiod_set_value(chip->reset_pin, 0);
682 /* AC97 v2.2 specifications says minimum 1 us. */
683 udelay(2);
684 gpiod_set_value(chip->reset_pin, 1);
685 } else {
686 ac97c_writel(chip, MR, AC97C_MR_WRST | AC97C_MR_ENA);
687 udelay(2);
688 ac97c_writel(chip, MR, AC97C_MR_ENA);
689 }
690 }
691
692 static const struct of_device_id atmel_ac97c_dt_ids[] = {
693 { .compatible = "atmel,at91sam9263-ac97c", },
694 { }
695 };
696 MODULE_DEVICE_TABLE(of, atmel_ac97c_dt_ids);
697
atmel_ac97c_probe(struct platform_device * pdev)698 static int atmel_ac97c_probe(struct platform_device *pdev)
699 {
700 struct device *dev = &pdev->dev;
701 struct snd_card *card;
702 struct atmel_ac97c *chip;
703 struct resource *regs;
704 struct clk *pclk;
705 static const struct snd_ac97_bus_ops ops = {
706 .write = atmel_ac97c_write,
707 .read = atmel_ac97c_read,
708 };
709 int retval;
710 int irq;
711
712 regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);
713 if (!regs) {
714 dev_dbg(&pdev->dev, "no memory resource\n");
715 return -ENXIO;
716 }
717
718 irq = platform_get_irq(pdev, 0);
719 if (irq < 0) {
720 dev_dbg(&pdev->dev, "could not get irq: %d\n", irq);
721 return irq;
722 }
723
724 pclk = clk_get(&pdev->dev, "ac97_clk");
725 if (IS_ERR(pclk)) {
726 dev_dbg(&pdev->dev, "no peripheral clock\n");
727 return PTR_ERR(pclk);
728 }
729 retval = clk_prepare_enable(pclk);
730 if (retval)
731 goto err_prepare_enable;
732
733 retval = snd_card_new(&pdev->dev, SNDRV_DEFAULT_IDX1,
734 SNDRV_DEFAULT_STR1, THIS_MODULE,
735 sizeof(struct atmel_ac97c), &card);
736 if (retval) {
737 dev_dbg(&pdev->dev, "could not create sound card device\n");
738 goto err_snd_card_new;
739 }
740
741 chip = get_chip(card);
742
743 retval = request_irq(irq, atmel_ac97c_interrupt, 0, "AC97C", chip);
744 if (retval) {
745 dev_dbg(&pdev->dev, "unable to request irq %d\n", irq);
746 goto err_request_irq;
747 }
748 chip->irq = irq;
749
750 spin_lock_init(&chip->lock);
751
752 strcpy(card->driver, "Atmel AC97C");
753 strcpy(card->shortname, "Atmel AC97C");
754 sprintf(card->longname, "Atmel AC97 controller");
755
756 chip->card = card;
757 chip->pclk = pclk;
758 chip->pdev = pdev;
759 chip->regs = ioremap(regs->start, resource_size(regs));
760
761 if (!chip->regs) {
762 dev_dbg(&pdev->dev, "could not remap register memory\n");
763 retval = -ENOMEM;
764 goto err_ioremap;
765 }
766
767 chip->reset_pin = devm_gpiod_get_index(dev, "ac97", 2, GPIOD_OUT_HIGH);
768 if (IS_ERR(chip->reset_pin))
769 dev_dbg(dev, "reset pin not available\n");
770
771 atmel_ac97c_reset(chip);
772
773 /* Enable overrun interrupt from codec channel */
774 ac97c_writel(chip, COMR, AC97C_CSR_OVRUN);
775 ac97c_writel(chip, IER, ac97c_readl(chip, IMR) | AC97C_SR_COEVT);
776
777 retval = snd_ac97_bus(card, 0, &ops, chip, &chip->ac97_bus);
778 if (retval) {
779 dev_dbg(&pdev->dev, "could not register on ac97 bus\n");
780 goto err_ac97_bus;
781 }
782
783 retval = atmel_ac97c_mixer_new(chip);
784 if (retval) {
785 dev_dbg(&pdev->dev, "could not register ac97 mixer\n");
786 goto err_ac97_bus;
787 }
788
789 retval = atmel_ac97c_pcm_new(chip);
790 if (retval) {
791 dev_dbg(&pdev->dev, "could not register ac97 pcm device\n");
792 goto err_ac97_bus;
793 }
794
795 retval = snd_card_register(card);
796 if (retval) {
797 dev_dbg(&pdev->dev, "could not register sound card\n");
798 goto err_ac97_bus;
799 }
800
801 platform_set_drvdata(pdev, card);
802
803 dev_info(&pdev->dev, "Atmel AC97 controller at 0x%p, irq = %d\n",
804 chip->regs, irq);
805
806 return 0;
807
808 err_ac97_bus:
809 iounmap(chip->regs);
810 err_ioremap:
811 free_irq(irq, chip);
812 err_request_irq:
813 snd_card_free(card);
814 err_snd_card_new:
815 clk_disable_unprepare(pclk);
816 err_prepare_enable:
817 clk_put(pclk);
818 return retval;
819 }
820
821 #ifdef CONFIG_PM_SLEEP
atmel_ac97c_suspend(struct device * pdev)822 static int atmel_ac97c_suspend(struct device *pdev)
823 {
824 struct snd_card *card = dev_get_drvdata(pdev);
825 struct atmel_ac97c *chip = card->private_data;
826
827 clk_disable_unprepare(chip->pclk);
828 return 0;
829 }
830
atmel_ac97c_resume(struct device * pdev)831 static int atmel_ac97c_resume(struct device *pdev)
832 {
833 struct snd_card *card = dev_get_drvdata(pdev);
834 struct atmel_ac97c *chip = card->private_data;
835 int ret = clk_prepare_enable(chip->pclk);
836
837 return ret;
838 }
839
840 static SIMPLE_DEV_PM_OPS(atmel_ac97c_pm, atmel_ac97c_suspend, atmel_ac97c_resume);
841 #define ATMEL_AC97C_PM_OPS &atmel_ac97c_pm
842 #else
843 #define ATMEL_AC97C_PM_OPS NULL
844 #endif
845
atmel_ac97c_remove(struct platform_device * pdev)846 static int atmel_ac97c_remove(struct platform_device *pdev)
847 {
848 struct snd_card *card = platform_get_drvdata(pdev);
849 struct atmel_ac97c *chip = get_chip(card);
850
851 ac97c_writel(chip, CAMR, 0);
852 ac97c_writel(chip, COMR, 0);
853 ac97c_writel(chip, MR, 0);
854
855 clk_disable_unprepare(chip->pclk);
856 clk_put(chip->pclk);
857 iounmap(chip->regs);
858 free_irq(chip->irq, chip);
859
860 snd_card_free(card);
861
862 return 0;
863 }
864
865 static struct platform_driver atmel_ac97c_driver = {
866 .probe = atmel_ac97c_probe,
867 .remove = atmel_ac97c_remove,
868 .driver = {
869 .name = "atmel_ac97c",
870 .pm = ATMEL_AC97C_PM_OPS,
871 .of_match_table = atmel_ac97c_dt_ids,
872 },
873 };
874 module_platform_driver(atmel_ac97c_driver);
875
876 MODULE_LICENSE("GPL");
877 MODULE_DESCRIPTION("Driver for Atmel AC97 controller");
878 MODULE_AUTHOR("Hans-Christian Egtvedt <egtvedt@samfundet.no>");
879