Blame view

sound/soc/nuc900/nuc900-ac97.c 9.82 KB
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
  /*
   * Copyright (c) 2009-2010 Nuvoton technology corporation.
   *
   * Wan ZongShun <mcuos.com@gmail.com>
   *
   * This program is free software; you can redistribute it and/or modify
   * it under the terms of the GNU General Public License as published by
   * the Free Software Foundation;version 2 of the License.
   *
   */
  
  #include <linux/init.h>
  #include <linux/module.h>
  #include <linux/slab.h>
  #include <linux/device.h>
  #include <linux/delay.h>
  #include <linux/mutex.h>
  #include <linux/suspend.h>
  #include <sound/core.h>
  #include <sound/pcm.h>
  #include <sound/initval.h>
  #include <sound/soc.h>
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
23
24
25
  #include <linux/clk.h>
  
  #include <mach/mfp.h>
0dc3b4420   Wan ZongShun   ASoC: nuc900: fix...
26
  #include "nuc900-audio.h"
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
  
  static DEFINE_MUTEX(ac97_mutex);
  struct nuc900_audio *nuc900_ac97_data;
  
  static int nuc900_checkready(void)
  {
  	struct nuc900_audio *nuc900_audio = nuc900_ac97_data;
  
  	if (!(AUDIO_READ(nuc900_audio->mmio + ACTL_ACIS0) & CODEC_READY))
  		return -EPERM;
  
  	return 0;
  }
  
  /* AC97 controller reads codec register */
  static unsigned short nuc900_ac97_read(struct snd_ac97 *ac97,
  					unsigned short reg)
  {
  	struct nuc900_audio *nuc900_audio = nuc900_ac97_data;
  	unsigned long timeout = 0x10000, val;
  
  	mutex_lock(&ac97_mutex);
  
  	val = nuc900_checkready();
3f90e5028   Axel Lin   ASoC: Remove unne...
51
  	if (val) {
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
  		dev_err(nuc900_audio->dev, "AC97 codec is not ready
  ");
  		goto out;
  	}
  
  	/* set the R_WB bit and write register index */
  	AUDIO_WRITE(nuc900_audio->mmio + ACTL_ACOS1, R_WB | reg);
  
  	/* set the valid frame bit and valid slots */
  	val = AUDIO_READ(nuc900_audio->mmio + ACTL_ACOS0);
  	val |= (VALID_FRAME | SLOT1_VALID);
  	AUDIO_WRITE(nuc900_audio->mmio + ACTL_ACOS0, val);
  
  	udelay(100);
  
  	/* polling the AC_R_FINISH */
8dfb0c781   Wan ZongShun   ASoC: nuc900: fix...
68
69
  	while (!(AUDIO_READ(nuc900_audio->mmio + ACTL_ACCON) & AC_R_FINISH)
  								&& timeout--)
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
  		mdelay(1);
  
  	if (!timeout) {
  		dev_err(nuc900_audio->dev, "AC97 read register time out !
  ");
  		val = -EPERM;
  		goto out;
  	}
  
  	val = AUDIO_READ(nuc900_audio->mmio + ACTL_ACOS0) ;
  	val &= ~SLOT1_VALID;
  	AUDIO_WRITE(nuc900_audio->mmio + ACTL_ACOS0, val);
  
  	if (AUDIO_READ(nuc900_audio->mmio + ACTL_ACIS1) >> 2 != reg) {
  		dev_err(nuc900_audio->dev,
  				"R_INDEX of REG_ACTL_ACIS1 not match!
  ");
  	}
  
  	udelay(100);
  	val = (AUDIO_READ(nuc900_audio->mmio + ACTL_ACIS2) & 0xFFFF);
  
  out:
  	mutex_unlock(&ac97_mutex);
  	return val;
  }
  
  /* AC97 controller writes to codec register */
  static void nuc900_ac97_write(struct snd_ac97 *ac97, unsigned short reg,
  				unsigned short val)
  {
  	struct nuc900_audio *nuc900_audio = nuc900_ac97_data;
  	unsigned long tmp, timeout = 0x10000;
  
  	mutex_lock(&ac97_mutex);
  
  	tmp = nuc900_checkready();
3f90e5028   Axel Lin   ASoC: Remove unne...
107
  	if (tmp)
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
  		dev_err(nuc900_audio->dev, "AC97 codec is not ready
  ");
  
  	/* clear the R_WB bit and write register index */
  	AUDIO_WRITE(nuc900_audio->mmio + ACTL_ACOS1, reg);
  
  	/* write register value */
  	AUDIO_WRITE(nuc900_audio->mmio + ACTL_ACOS2, val);
  
  	/* set the valid frame bit and valid slots */
  	tmp = AUDIO_READ(nuc900_audio->mmio + ACTL_ACOS0);
  	tmp |= SLOT1_VALID | SLOT2_VALID | VALID_FRAME;
  	AUDIO_WRITE(nuc900_audio->mmio + ACTL_ACOS0, tmp);
  
  	udelay(100);
  
  	/* polling the AC_W_FINISH */
8dfb0c781   Wan ZongShun   ASoC: nuc900: fix...
125
126
  	while ((AUDIO_READ(nuc900_audio->mmio + ACTL_ACCON) & AC_W_FINISH)
  								&& timeout--)
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
  		mdelay(1);
  
  	if (!timeout)
  		dev_err(nuc900_audio->dev, "AC97 write register time out !
  ");
  
  	tmp = AUDIO_READ(nuc900_audio->mmio + ACTL_ACOS0);
  	tmp &= ~(SLOT1_VALID | SLOT2_VALID);
  	AUDIO_WRITE(nuc900_audio->mmio + ACTL_ACOS0, tmp);
  
  	mutex_unlock(&ac97_mutex);
  
  }
  
  static void nuc900_ac97_warm_reset(struct snd_ac97 *ac97)
  {
  	struct nuc900_audio *nuc900_audio = nuc900_ac97_data;
  	unsigned long val;
  
  	mutex_lock(&ac97_mutex);
  
  	/* warm reset AC 97 */
  	val = AUDIO_READ(nuc900_audio->mmio + ACTL_ACCON);
  	val |= AC_W_RES;
  	AUDIO_WRITE(nuc900_audio->mmio + ACTL_ACCON, val);
08a0b7175   Wan ZongShun   ASoC: nuc900: pat...
152
  	udelay(100);
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
153
154
  
  	val = nuc900_checkready();
3f90e5028   Axel Lin   ASoC: Remove unne...
155
  	if (val)
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
  		dev_err(nuc900_audio->dev, "AC97 codec is not ready
  ");
  
  	mutex_unlock(&ac97_mutex);
  }
  
  static void nuc900_ac97_cold_reset(struct snd_ac97 *ac97)
  {
  	struct nuc900_audio *nuc900_audio = nuc900_ac97_data;
  	unsigned long val;
  
  	mutex_lock(&ac97_mutex);
  
  	/* reset Audio Controller */
  	val = AUDIO_READ(nuc900_audio->mmio + ACTL_RESET);
  	val |= ACTL_RESET_BIT;
  	AUDIO_WRITE(nuc900_audio->mmio + ACTL_RESET, val);
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
173
174
175
  	val = AUDIO_READ(nuc900_audio->mmio + ACTL_RESET);
  	val &= (~ACTL_RESET_BIT);
  	AUDIO_WRITE(nuc900_audio->mmio + ACTL_RESET, val);
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
176
177
178
179
180
  	/* reset AC-link interface */
  
  	val = AUDIO_READ(nuc900_audio->mmio + ACTL_RESET);
  	val |= AC_RESET;
  	AUDIO_WRITE(nuc900_audio->mmio + ACTL_RESET, val);
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
181
182
183
  	val = AUDIO_READ(nuc900_audio->mmio + ACTL_RESET);
  	val &= ~AC_RESET;
  	AUDIO_WRITE(nuc900_audio->mmio + ACTL_RESET, val);
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
184
185
186
187
  	/* cold reset AC 97 */
  	val = AUDIO_READ(nuc900_audio->mmio + ACTL_ACCON);
  	val |= AC_C_RES;
  	AUDIO_WRITE(nuc900_audio->mmio + ACTL_ACCON, val);
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
188
189
190
  	val = AUDIO_READ(nuc900_audio->mmio + ACTL_ACCON);
  	val &= (~AC_C_RES);
  	AUDIO_WRITE(nuc900_audio->mmio + ACTL_ACCON, val);
08a0b7175   Wan ZongShun   ASoC: nuc900: pat...
191
  	udelay(100);
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
  
  	mutex_unlock(&ac97_mutex);
  
  }
  
  /* AC97 controller operations */
  struct snd_ac97_bus_ops soc_ac97_ops = {
  	.read		= nuc900_ac97_read,
  	.write		= nuc900_ac97_write,
  	.reset		= nuc900_ac97_cold_reset,
  	.warm_reset	= nuc900_ac97_warm_reset,
  }
  EXPORT_SYMBOL_GPL(soc_ac97_ops);
  
  static int nuc900_ac97_trigger(struct snd_pcm_substream *substream,
  				int cmd, struct snd_soc_dai *dai)
  {
  	struct nuc900_audio *nuc900_audio = nuc900_ac97_data;
018334c04   Wan ZongShun   ASoC: nuc900: pat...
210
  	int ret;
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
211
212
213
214
215
216
217
218
  	unsigned long val, tmp;
  
  	ret = 0;
  
  	switch (cmd) {
  	case SNDRV_PCM_TRIGGER_START:
  	case SNDRV_PCM_TRIGGER_RESUME:
  		val = AUDIO_READ(nuc900_audio->mmio + ACTL_RESET);
018334c04   Wan ZongShun   ASoC: nuc900: pat...
219
  		if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
  			tmp = AUDIO_READ(nuc900_audio->mmio + ACTL_ACOS0);
  			tmp |= (SLOT3_VALID | SLOT4_VALID | VALID_FRAME);
  			AUDIO_WRITE(nuc900_audio->mmio + ACTL_ACOS0, tmp);
  
  			tmp = AUDIO_READ(nuc900_audio->mmio + ACTL_PSR);
  			tmp |= (P_DMA_END_IRQ | P_DMA_MIDDLE_IRQ);
  			AUDIO_WRITE(nuc900_audio->mmio + ACTL_PSR, tmp);
  			val |= AC_PLAY;
  		} else {
  			tmp = AUDIO_READ(nuc900_audio->mmio + ACTL_RSR);
  			tmp |= (R_DMA_END_IRQ | R_DMA_MIDDLE_IRQ);
  
  			AUDIO_WRITE(nuc900_audio->mmio + ACTL_RSR, tmp);
  			val |= AC_RECORD;
  		}
  
  		AUDIO_WRITE(nuc900_audio->mmio + ACTL_RESET, val);
  
  		break;
  	case SNDRV_PCM_TRIGGER_STOP:
  	case SNDRV_PCM_TRIGGER_SUSPEND:
  		val = AUDIO_READ(nuc900_audio->mmio + ACTL_RESET);
018334c04   Wan ZongShun   ASoC: nuc900: pat...
242
  		if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
  			tmp = AUDIO_READ(nuc900_audio->mmio + ACTL_ACOS0);
  			tmp &= ~(SLOT3_VALID | SLOT4_VALID);
  			AUDIO_WRITE(nuc900_audio->mmio + ACTL_ACOS0, tmp);
  
  			AUDIO_WRITE(nuc900_audio->mmio + ACTL_PSR, RESET_PRSR);
  			val &= ~AC_PLAY;
  		} else {
  			AUDIO_WRITE(nuc900_audio->mmio + ACTL_RSR, RESET_PRSR);
  			val &= ~AC_RECORD;
  		}
  
  		AUDIO_WRITE(nuc900_audio->mmio + ACTL_RESET, val);
  
  		break;
  	default:
  		ret = -EINVAL;
  	}
  
  	return ret;
  }
e3edefbd4   Axel Lin   ASoC: Fix prototy...
263
  static int nuc900_ac97_probe(struct snd_soc_dai *dai)
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
  {
  	struct nuc900_audio *nuc900_audio = nuc900_ac97_data;
  	unsigned long val;
  
  	mutex_lock(&ac97_mutex);
  
  	/* enable unit clock */
  	clk_enable(nuc900_audio->clk);
  
  	/* enable audio controller and AC-link interface */
  	val = AUDIO_READ(nuc900_audio->mmio + ACTL_CON);
  	val |= (IIS_AC_PIN_SEL | ACLINK_EN);
  	AUDIO_WRITE(nuc900_audio->mmio + ACTL_CON, val);
  
  	mutex_unlock(&ac97_mutex);
  
  	return 0;
  }
e3edefbd4   Axel Lin   ASoC: Fix prototy...
282
  static int nuc900_ac97_remove(struct snd_soc_dai *dai)
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
283
284
285
286
  {
  	struct nuc900_audio *nuc900_audio = nuc900_ac97_data;
  
  	clk_disable(nuc900_audio->clk);
e3edefbd4   Axel Lin   ASoC: Fix prototy...
287
  	return 0;
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
288
  }
85e7652d8   Lars-Peter Clausen   ASoC: Constify sn...
289
  static const struct snd_soc_dai_ops nuc900_ac97_dai_ops = {
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
290
291
  	.trigger	= nuc900_ac97_trigger,
  };
f0fba2ad1   Liam Girdwood   ASoC: multi-compo...
292
  static struct snd_soc_dai_driver nuc900_ac97_dai = {
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
  	.probe			= nuc900_ac97_probe,
  	.remove			= nuc900_ac97_remove,
  	.ac97_control		= 1,
  	.playback = {
  		.rates		= SNDRV_PCM_RATE_8000_48000,
  		.formats	= SNDRV_PCM_FMTBIT_S16_LE,
  		.channels_min	= 1,
  		.channels_max	= 2,
  	},
  	.capture = {
  		.rates		= SNDRV_PCM_RATE_8000_48000,
  		.formats	= SNDRV_PCM_FMTBIT_S16_LE,
  		.channels_min	= 1,
  		.channels_max	= 2,
  	},
  	.ops = &nuc900_ac97_dai_ops,
5a8f1d470   Axel Lin   ASoC: Fix compile...
309
  };
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
  
  static int __devinit nuc900_ac97_drvprobe(struct platform_device *pdev)
  {
  	struct nuc900_audio *nuc900_audio;
  	int ret;
  
  	if (nuc900_ac97_data)
  		return -EBUSY;
  
  	nuc900_audio = kzalloc(sizeof(struct nuc900_audio), GFP_KERNEL);
  	if (!nuc900_audio)
  		return -ENOMEM;
  
  	spin_lock_init(&nuc900_audio->lock);
  
  	nuc900_audio->res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  	if (!nuc900_audio->res) {
  		ret = -ENODEV;
  		goto out0;
  	}
  
  	if (!request_mem_region(nuc900_audio->res->start,
  			resource_size(nuc900_audio->res), pdev->name)) {
  		ret = -EBUSY;
  		goto out0;
  	}
  
  	nuc900_audio->mmio = ioremap(nuc900_audio->res->start,
  					resource_size(nuc900_audio->res));
  	if (!nuc900_audio->mmio) {
  		ret = -ENOMEM;
  		goto out1;
  	}
  
  	nuc900_audio->clk = clk_get(&pdev->dev, NULL);
  	if (IS_ERR(nuc900_audio->clk)) {
  		ret = PTR_ERR(nuc900_audio->clk);
  		goto out2;
  	}
  
  	nuc900_audio->irq_num = platform_get_irq(pdev, 0);
  	if (!nuc900_audio->irq_num) {
  		ret = -EBUSY;
a2dc56c8a   Julia Lawall   ASoC: add missing...
353
  		goto out3;
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
354
355
356
  	}
  
  	nuc900_ac97_data = nuc900_audio;
f0fba2ad1   Liam Girdwood   ASoC: multi-compo...
357
  	ret = snd_soc_register_dai(&pdev->dev, &nuc900_ac97_dai);
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
358
359
  	if (ret)
  		goto out3;
97371fa99   Axel Lin   ARM: 7175/1: add ...
360
  	/* enbale ac97 multifunction pin */
e37051dc7   Axel Lin   ARM: 7274/1: NUC9...
361
  	mfp_set_groupg(nuc900_audio->dev, NULL);
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
  
  	return 0;
  
  out3:
  	clk_put(nuc900_audio->clk);
  out2:
  	iounmap(nuc900_audio->mmio);
  out1:
  	release_mem_region(nuc900_audio->res->start,
  					resource_size(nuc900_audio->res));
  out0:
  	kfree(nuc900_audio);
  	return ret;
  }
  
  static int __devexit nuc900_ac97_drvremove(struct platform_device *pdev)
  {
f0fba2ad1   Liam Girdwood   ASoC: multi-compo...
379
  	snd_soc_unregister_dai(&pdev->dev);
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
380
381
382
383
384
  
  	clk_put(nuc900_ac97_data->clk);
  	iounmap(nuc900_ac97_data->mmio);
  	release_mem_region(nuc900_ac97_data->res->start,
  				resource_size(nuc900_ac97_data->res));
d6f443ae4   Axel Lin   ASoC: nuc900-ac97...
385
  	kfree(nuc900_ac97_data);
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
386
387
388
389
390
391
392
  	nuc900_ac97_data = NULL;
  
  	return 0;
  }
  
  static struct platform_driver nuc900_ac97_driver = {
  	.driver	= {
f0fba2ad1   Liam Girdwood   ASoC: multi-compo...
393
  		.name	= "nuc900-ac97",
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
394
395
396
397
398
  		.owner	= THIS_MODULE,
  	},
  	.probe		= nuc900_ac97_drvprobe,
  	.remove		= __devexit_p(nuc900_ac97_drvremove),
  };
d0efa6a27   Axel Lin   ASoC: Convert nuc...
399
  module_platform_driver(nuc900_ac97_driver);
1082e2703   Wan ZongShun   ASoC: NUC900/audi...
400
401
402
403
404
  
  MODULE_AUTHOR("Wan ZongShun <mcuos.com@gmail.com>");
  MODULE_DESCRIPTION("NUC900 AC97 SoC driver!");
  MODULE_LICENSE("GPL");
  MODULE_ALIAS("platform:nuc900-ac97");