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