drm/omap: Fix error handling path in 'omap_dmm_probe()'
[linux/fpc-iii.git] / sound / arm / pxa2xx-ac97-lib.c
blob39c3969ac1c7fc7d6b977fc3d65cb995ba208aee
1 /*
2 * Based on sound/arm/pxa2xx-ac97.c and sound/soc/pxa/pxa2xx-ac97.c
3 * which contain:
5 * Author: Nicolas Pitre
6 * Created: Dec 02, 2004
7 * Copyright: MontaVista Software Inc.
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License version 2 as
11 * published by the Free Software Foundation.
14 #include <linux/kernel.h>
15 #include <linux/platform_device.h>
16 #include <linux/interrupt.h>
17 #include <linux/clk.h>
18 #include <linux/delay.h>
19 #include <linux/module.h>
20 #include <linux/io.h>
21 #include <linux/gpio.h>
23 #include <sound/ac97_codec.h>
24 #include <sound/pxa2xx-lib.h>
26 #include <mach/irqs.h>
27 #include <mach/regs-ac97.h>
28 #include <mach/audio.h>
30 static DEFINE_MUTEX(car_mutex);
31 static DECLARE_WAIT_QUEUE_HEAD(gsr_wq);
32 static volatile long gsr_bits;
33 static struct clk *ac97_clk;
34 static struct clk *ac97conf_clk;
35 static int reset_gpio;
37 extern void pxa27x_configure_ac97reset(int reset_gpio, bool to_gpio);
40 * Beware PXA27x bugs:
42 * o Slot 12 read from modem space will hang controller.
43 * o CDONE, SDONE interrupt fails after any slot 12 IO.
45 * We therefore have an hybrid approach for waiting on SDONE (interrupt or
46 * 1 jiffy timeout if interrupt never comes).
49 unsigned short pxa2xx_ac97_read(struct snd_ac97 *ac97, unsigned short reg)
51 unsigned short val = -1;
52 volatile u32 *reg_addr;
54 mutex_lock(&car_mutex);
56 /* set up primary or secondary codec space */
57 if (cpu_is_pxa25x() && reg == AC97_GPIO_STATUS)
58 reg_addr = ac97->num ? &SMC_REG_BASE : &PMC_REG_BASE;
59 else
60 reg_addr = ac97->num ? &SAC_REG_BASE : &PAC_REG_BASE;
61 reg_addr += (reg >> 1);
63 /* start read access across the ac97 link */
64 GSR = GSR_CDONE | GSR_SDONE;
65 gsr_bits = 0;
66 val = *reg_addr;
67 if (reg == AC97_GPIO_STATUS)
68 goto out;
69 if (wait_event_timeout(gsr_wq, (GSR | gsr_bits) & GSR_SDONE, 1) <= 0 &&
70 !((GSR | gsr_bits) & GSR_SDONE)) {
71 printk(KERN_ERR "%s: read error (ac97_reg=%d GSR=%#lx)\n",
72 __func__, reg, GSR | gsr_bits);
73 val = -1;
74 goto out;
77 /* valid data now */
78 GSR = GSR_CDONE | GSR_SDONE;
79 gsr_bits = 0;
80 val = *reg_addr;
81 /* but we've just started another cycle... */
82 wait_event_timeout(gsr_wq, (GSR | gsr_bits) & GSR_SDONE, 1);
84 out: mutex_unlock(&car_mutex);
85 return val;
87 EXPORT_SYMBOL_GPL(pxa2xx_ac97_read);
89 void pxa2xx_ac97_write(struct snd_ac97 *ac97, unsigned short reg,
90 unsigned short val)
92 volatile u32 *reg_addr;
94 mutex_lock(&car_mutex);
96 /* set up primary or secondary codec space */
97 if (cpu_is_pxa25x() && reg == AC97_GPIO_STATUS)
98 reg_addr = ac97->num ? &SMC_REG_BASE : &PMC_REG_BASE;
99 else
100 reg_addr = ac97->num ? &SAC_REG_BASE : &PAC_REG_BASE;
101 reg_addr += (reg >> 1);
103 GSR = GSR_CDONE | GSR_SDONE;
104 gsr_bits = 0;
105 *reg_addr = val;
106 if (wait_event_timeout(gsr_wq, (GSR | gsr_bits) & GSR_CDONE, 1) <= 0 &&
107 !((GSR | gsr_bits) & GSR_CDONE))
108 printk(KERN_ERR "%s: write error (ac97_reg=%d GSR=%#lx)\n",
109 __func__, reg, GSR | gsr_bits);
111 mutex_unlock(&car_mutex);
113 EXPORT_SYMBOL_GPL(pxa2xx_ac97_write);
115 #ifdef CONFIG_PXA25x
116 static inline void pxa_ac97_warm_pxa25x(void)
118 gsr_bits = 0;
120 GCR |= GCR_WARM_RST;
123 static inline void pxa_ac97_cold_pxa25x(void)
125 GCR &= GCR_COLD_RST; /* clear everything but nCRST */
126 GCR &= ~GCR_COLD_RST; /* then assert nCRST */
128 gsr_bits = 0;
130 GCR = GCR_COLD_RST;
132 #endif
134 #ifdef CONFIG_PXA27x
135 static inline void pxa_ac97_warm_pxa27x(void)
137 gsr_bits = 0;
139 /* warm reset broken on Bulverde, so manually keep AC97 reset high */
140 pxa27x_configure_ac97reset(reset_gpio, true);
141 udelay(10);
142 GCR |= GCR_WARM_RST;
143 pxa27x_configure_ac97reset(reset_gpio, false);
144 udelay(500);
147 static inline void pxa_ac97_cold_pxa27x(void)
149 GCR &= GCR_COLD_RST; /* clear everything but nCRST */
150 GCR &= ~GCR_COLD_RST; /* then assert nCRST */
152 gsr_bits = 0;
154 /* PXA27x Developers Manual section 13.5.2.2.1 */
155 clk_prepare_enable(ac97conf_clk);
156 udelay(5);
157 clk_disable_unprepare(ac97conf_clk);
158 GCR = GCR_COLD_RST | GCR_WARM_RST;
160 #endif
162 #ifdef CONFIG_PXA3xx
163 static inline void pxa_ac97_warm_pxa3xx(void)
165 gsr_bits = 0;
167 /* Can't use interrupts */
168 GCR |= GCR_WARM_RST;
171 static inline void pxa_ac97_cold_pxa3xx(void)
173 /* Hold CLKBPB for 100us */
174 GCR = 0;
175 GCR = GCR_CLKBPB;
176 udelay(100);
177 GCR = 0;
179 GCR &= GCR_COLD_RST; /* clear everything but nCRST */
180 GCR &= ~GCR_COLD_RST; /* then assert nCRST */
182 gsr_bits = 0;
184 /* Can't use interrupts on PXA3xx */
185 GCR &= ~(GCR_PRIRDY_IEN|GCR_SECRDY_IEN);
187 GCR = GCR_WARM_RST | GCR_COLD_RST;
189 #endif
191 bool pxa2xx_ac97_try_warm_reset(struct snd_ac97 *ac97)
193 unsigned long gsr;
194 unsigned int timeout = 100;
196 #ifdef CONFIG_PXA25x
197 if (cpu_is_pxa25x())
198 pxa_ac97_warm_pxa25x();
199 else
200 #endif
201 #ifdef CONFIG_PXA27x
202 if (cpu_is_pxa27x())
203 pxa_ac97_warm_pxa27x();
204 else
205 #endif
206 #ifdef CONFIG_PXA3xx
207 if (cpu_is_pxa3xx())
208 pxa_ac97_warm_pxa3xx();
209 else
210 #endif
211 snd_BUG();
213 while (!((GSR | gsr_bits) & (GSR_PCR | GSR_SCR)) && timeout--)
214 mdelay(1);
216 gsr = GSR | gsr_bits;
217 if (!(gsr & (GSR_PCR | GSR_SCR))) {
218 printk(KERN_INFO "%s: warm reset timeout (GSR=%#lx)\n",
219 __func__, gsr);
221 return false;
224 return true;
226 EXPORT_SYMBOL_GPL(pxa2xx_ac97_try_warm_reset);
228 bool pxa2xx_ac97_try_cold_reset(struct snd_ac97 *ac97)
230 unsigned long gsr;
231 unsigned int timeout = 1000;
233 #ifdef CONFIG_PXA25x
234 if (cpu_is_pxa25x())
235 pxa_ac97_cold_pxa25x();
236 else
237 #endif
238 #ifdef CONFIG_PXA27x
239 if (cpu_is_pxa27x())
240 pxa_ac97_cold_pxa27x();
241 else
242 #endif
243 #ifdef CONFIG_PXA3xx
244 if (cpu_is_pxa3xx())
245 pxa_ac97_cold_pxa3xx();
246 else
247 #endif
248 snd_BUG();
250 while (!((GSR | gsr_bits) & (GSR_PCR | GSR_SCR)) && timeout--)
251 mdelay(1);
253 gsr = GSR | gsr_bits;
254 if (!(gsr & (GSR_PCR | GSR_SCR))) {
255 printk(KERN_INFO "%s: cold reset timeout (GSR=%#lx)\n",
256 __func__, gsr);
258 return false;
261 return true;
263 EXPORT_SYMBOL_GPL(pxa2xx_ac97_try_cold_reset);
266 void pxa2xx_ac97_finish_reset(struct snd_ac97 *ac97)
268 GCR &= ~(GCR_PRIRDY_IEN|GCR_SECRDY_IEN);
269 GCR |= GCR_SDONE_IE|GCR_CDONE_IE;
271 EXPORT_SYMBOL_GPL(pxa2xx_ac97_finish_reset);
273 static irqreturn_t pxa2xx_ac97_irq(int irq, void *dev_id)
275 long status;
277 status = GSR;
278 if (status) {
279 GSR = status;
280 gsr_bits |= status;
281 wake_up(&gsr_wq);
283 /* Although we don't use those we still need to clear them
284 since they tend to spuriously trigger when MMC is used
285 (hardware bug? go figure)... */
286 if (cpu_is_pxa27x()) {
287 MISR = MISR_EOC;
288 PISR = PISR_EOC;
289 MCSR = MCSR_EOC;
292 return IRQ_HANDLED;
295 return IRQ_NONE;
298 #ifdef CONFIG_PM
299 int pxa2xx_ac97_hw_suspend(void)
301 GCR |= GCR_ACLINK_OFF;
302 clk_disable_unprepare(ac97_clk);
303 return 0;
305 EXPORT_SYMBOL_GPL(pxa2xx_ac97_hw_suspend);
307 int pxa2xx_ac97_hw_resume(void)
309 clk_prepare_enable(ac97_clk);
310 return 0;
312 EXPORT_SYMBOL_GPL(pxa2xx_ac97_hw_resume);
313 #endif
315 int pxa2xx_ac97_hw_probe(struct platform_device *dev)
317 int ret;
318 pxa2xx_audio_ops_t *pdata = dev->dev.platform_data;
320 if (pdata) {
321 switch (pdata->reset_gpio) {
322 case 95:
323 case 113:
324 reset_gpio = pdata->reset_gpio;
325 break;
326 case 0:
327 reset_gpio = 113;
328 break;
329 case -1:
330 break;
331 default:
332 dev_err(&dev->dev, "Invalid reset GPIO %d\n",
333 pdata->reset_gpio);
335 } else {
336 if (cpu_is_pxa27x())
337 reset_gpio = 113;
340 if (cpu_is_pxa27x()) {
342 * This gpio is needed for a work-around to a bug in the ac97
343 * controller during warm reset. The direction and level is set
344 * here so that it is an output driven high when switching from
345 * AC97_nRESET alt function to generic gpio.
347 ret = gpio_request_one(reset_gpio, GPIOF_OUT_INIT_HIGH,
348 "pxa27x ac97 reset");
349 if (ret < 0) {
350 pr_err("%s: gpio_request_one() failed: %d\n",
351 __func__, ret);
352 goto err_conf;
354 pxa27x_configure_ac97reset(reset_gpio, false);
356 ac97conf_clk = clk_get(&dev->dev, "AC97CONFCLK");
357 if (IS_ERR(ac97conf_clk)) {
358 ret = PTR_ERR(ac97conf_clk);
359 ac97conf_clk = NULL;
360 goto err_conf;
364 ac97_clk = clk_get(&dev->dev, "AC97CLK");
365 if (IS_ERR(ac97_clk)) {
366 ret = PTR_ERR(ac97_clk);
367 ac97_clk = NULL;
368 goto err_clk;
371 ret = clk_prepare_enable(ac97_clk);
372 if (ret)
373 goto err_clk2;
375 ret = request_irq(IRQ_AC97, pxa2xx_ac97_irq, 0, "AC97", NULL);
376 if (ret < 0)
377 goto err_irq;
379 return 0;
381 err_irq:
382 GCR |= GCR_ACLINK_OFF;
383 err_clk2:
384 clk_put(ac97_clk);
385 ac97_clk = NULL;
386 err_clk:
387 if (ac97conf_clk) {
388 clk_put(ac97conf_clk);
389 ac97conf_clk = NULL;
391 err_conf:
392 return ret;
394 EXPORT_SYMBOL_GPL(pxa2xx_ac97_hw_probe);
396 void pxa2xx_ac97_hw_remove(struct platform_device *dev)
398 if (cpu_is_pxa27x())
399 gpio_free(reset_gpio);
400 GCR |= GCR_ACLINK_OFF;
401 free_irq(IRQ_AC97, NULL);
402 if (ac97conf_clk) {
403 clk_put(ac97conf_clk);
404 ac97conf_clk = NULL;
406 clk_disable_unprepare(ac97_clk);
407 clk_put(ac97_clk);
408 ac97_clk = NULL;
410 EXPORT_SYMBOL_GPL(pxa2xx_ac97_hw_remove);
412 MODULE_AUTHOR("Nicolas Pitre");
413 MODULE_DESCRIPTION("Intel/Marvell PXA sound library");
414 MODULE_LICENSE("GPL");