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