Book a Demo!
CoCalc Logo Icon
StoreFeaturesDocsShareSupportNewsAboutPoliciesSign UpSign In
torvalds
GitHub Repository: torvalds/linux
Path: blob/master/sound/atmel/ac97c.c
26285 views
1
// SPDX-License-Identifier: GPL-2.0-only
2
/*
3
* Driver for Atmel AC97C
4
*
5
* Copyright (C) 2005-2009 Atmel Corporation
6
*/
7
#include <linux/clk.h>
8
#include <linux/delay.h>
9
#include <linux/bitmap.h>
10
#include <linux/device.h>
11
#include <linux/atmel_pdc.h>
12
#include <linux/gpio/consumer.h>
13
#include <linux/init.h>
14
#include <linux/interrupt.h>
15
#include <linux/mod_devicetable.h>
16
#include <linux/module.h>
17
#include <linux/platform_device.h>
18
#include <linux/mutex.h>
19
#include <linux/string.h>
20
#include <linux/types.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/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
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
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
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
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
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
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
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
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
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
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
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
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
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
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
strscpy(pcm->name, chip->card->shortname);
594
chip->pcm = pcm;
595
596
return 0;
597
}
598
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
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
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
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
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
strscpy(card->driver, "Atmel AC97C");
753
strscpy(card->shortname, "Atmel AC97C");
754
strscpy(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
static int atmel_ac97c_suspend(struct device *pdev)
822
{
823
struct snd_card *card = dev_get_drvdata(pdev);
824
struct atmel_ac97c *chip = card->private_data;
825
826
clk_disable_unprepare(chip->pclk);
827
return 0;
828
}
829
830
static int atmel_ac97c_resume(struct device *pdev)
831
{
832
struct snd_card *card = dev_get_drvdata(pdev);
833
struct atmel_ac97c *chip = card->private_data;
834
int ret = clk_prepare_enable(chip->pclk);
835
836
return ret;
837
}
838
839
static DEFINE_SIMPLE_DEV_PM_OPS(atmel_ac97c_pm, atmel_ac97c_suspend, atmel_ac97c_resume);
840
841
static void atmel_ac97c_remove(struct platform_device *pdev)
842
{
843
struct snd_card *card = platform_get_drvdata(pdev);
844
struct atmel_ac97c *chip = get_chip(card);
845
846
ac97c_writel(chip, CAMR, 0);
847
ac97c_writel(chip, COMR, 0);
848
ac97c_writel(chip, MR, 0);
849
850
clk_disable_unprepare(chip->pclk);
851
clk_put(chip->pclk);
852
iounmap(chip->regs);
853
free_irq(chip->irq, chip);
854
855
snd_card_free(card);
856
}
857
858
static struct platform_driver atmel_ac97c_driver = {
859
.probe = atmel_ac97c_probe,
860
.remove = atmel_ac97c_remove,
861
.driver = {
862
.name = "atmel_ac97c",
863
.pm = pm_ptr(&atmel_ac97c_pm),
864
.of_match_table = atmel_ac97c_dt_ids,
865
},
866
};
867
module_platform_driver(atmel_ac97c_driver);
868
869
MODULE_LICENSE("GPL");
870
MODULE_DESCRIPTION("Driver for Atmel AC97 controller");
871
MODULE_AUTHOR("Hans-Christian Egtvedt <[email protected]>");
872
873