19c636342SDmitry Baryshkov /* 29c636342SDmitry Baryshkov * Based on sound/arm/pxa2xx-ac97.c and sound/soc/pxa/pxa2xx-ac97.c 39c636342SDmitry Baryshkov * which contain: 49c636342SDmitry Baryshkov * 59c636342SDmitry Baryshkov * Author: Nicolas Pitre 69c636342SDmitry Baryshkov * Created: Dec 02, 2004 79c636342SDmitry Baryshkov * Copyright: MontaVista Software Inc. 89c636342SDmitry Baryshkov * 99c636342SDmitry Baryshkov * This program is free software; you can redistribute it and/or modify 109c636342SDmitry Baryshkov * it under the terms of the GNU General Public License version 2 as 119c636342SDmitry Baryshkov * published by the Free Software Foundation. 129c636342SDmitry Baryshkov */ 139c636342SDmitry Baryshkov 149c636342SDmitry Baryshkov #include <linux/kernel.h> 159c636342SDmitry Baryshkov #include <linux/platform_device.h> 169c636342SDmitry Baryshkov #include <linux/interrupt.h> 179c636342SDmitry Baryshkov #include <linux/clk.h> 189c636342SDmitry Baryshkov #include <linux/delay.h> 19*da155d5bSPaul Gortmaker #include <linux/module.h> 209c636342SDmitry Baryshkov 219c636342SDmitry Baryshkov #include <sound/ac97_codec.h> 229c636342SDmitry Baryshkov #include <sound/pxa2xx-lib.h> 239c636342SDmitry Baryshkov 249c636342SDmitry Baryshkov #include <asm/irq.h> 251f017a99SEric Miao #include <mach/regs-ac97.h> 269c636342SDmitry Baryshkov #include <mach/audio.h> 279c636342SDmitry Baryshkov 289c636342SDmitry Baryshkov static DEFINE_MUTEX(car_mutex); 299c636342SDmitry Baryshkov static DECLARE_WAIT_QUEUE_HEAD(gsr_wq); 309c636342SDmitry Baryshkov static volatile long gsr_bits; 319c636342SDmitry Baryshkov static struct clk *ac97_clk; 329c636342SDmitry Baryshkov static struct clk *ac97conf_clk; 3326ade896SRobert Jarzmik static int reset_gpio; 349c636342SDmitry Baryshkov 35fb1bf8cdSEric Miao extern void pxa27x_assert_ac97reset(int reset_gpio, int on); 36fb1bf8cdSEric Miao 379c636342SDmitry Baryshkov /* 389c636342SDmitry Baryshkov * Beware PXA27x bugs: 399c636342SDmitry Baryshkov * 409c636342SDmitry Baryshkov * o Slot 12 read from modem space will hang controller. 419c636342SDmitry Baryshkov * o CDONE, SDONE interrupt fails after any slot 12 IO. 429c636342SDmitry Baryshkov * 439c636342SDmitry Baryshkov * We therefore have an hybrid approach for waiting on SDONE (interrupt or 449c636342SDmitry Baryshkov * 1 jiffy timeout if interrupt never comes). 459c636342SDmitry Baryshkov */ 469c636342SDmitry Baryshkov 479c636342SDmitry Baryshkov unsigned short pxa2xx_ac97_read(struct snd_ac97 *ac97, unsigned short reg) 489c636342SDmitry Baryshkov { 499c636342SDmitry Baryshkov unsigned short val = -1; 509c636342SDmitry Baryshkov volatile u32 *reg_addr; 519c636342SDmitry Baryshkov 529c636342SDmitry Baryshkov mutex_lock(&car_mutex); 539c636342SDmitry Baryshkov 549c636342SDmitry Baryshkov /* set up primary or secondary codec space */ 558825e8e8SMarc Zyngier if (cpu_is_pxa25x() && reg == AC97_GPIO_STATUS) 569c636342SDmitry Baryshkov reg_addr = ac97->num ? &SMC_REG_BASE : &PMC_REG_BASE; 579c636342SDmitry Baryshkov else 589c636342SDmitry Baryshkov reg_addr = ac97->num ? &SAC_REG_BASE : &PAC_REG_BASE; 599c636342SDmitry Baryshkov reg_addr += (reg >> 1); 609c636342SDmitry Baryshkov 619c636342SDmitry Baryshkov /* start read access across the ac97 link */ 629c636342SDmitry Baryshkov GSR = GSR_CDONE | GSR_SDONE; 639c636342SDmitry Baryshkov gsr_bits = 0; 649c636342SDmitry Baryshkov val = *reg_addr; 659c636342SDmitry Baryshkov if (reg == AC97_GPIO_STATUS) 669c636342SDmitry Baryshkov goto out; 679c636342SDmitry Baryshkov if (wait_event_timeout(gsr_wq, (GSR | gsr_bits) & GSR_SDONE, 1) <= 0 && 689c636342SDmitry Baryshkov !((GSR | gsr_bits) & GSR_SDONE)) { 699c636342SDmitry Baryshkov printk(KERN_ERR "%s: read error (ac97_reg=%d GSR=%#lx)\n", 709c636342SDmitry Baryshkov __func__, reg, GSR | gsr_bits); 719c636342SDmitry Baryshkov val = -1; 729c636342SDmitry Baryshkov goto out; 739c636342SDmitry Baryshkov } 749c636342SDmitry Baryshkov 759c636342SDmitry Baryshkov /* valid data now */ 769c636342SDmitry Baryshkov GSR = GSR_CDONE | GSR_SDONE; 779c636342SDmitry Baryshkov gsr_bits = 0; 789c636342SDmitry Baryshkov val = *reg_addr; 799c636342SDmitry Baryshkov /* but we've just started another cycle... */ 809c636342SDmitry Baryshkov wait_event_timeout(gsr_wq, (GSR | gsr_bits) & GSR_SDONE, 1); 819c636342SDmitry Baryshkov 829c636342SDmitry Baryshkov out: mutex_unlock(&car_mutex); 839c636342SDmitry Baryshkov return val; 849c636342SDmitry Baryshkov } 859c636342SDmitry Baryshkov EXPORT_SYMBOL_GPL(pxa2xx_ac97_read); 869c636342SDmitry Baryshkov 879c636342SDmitry Baryshkov void pxa2xx_ac97_write(struct snd_ac97 *ac97, unsigned short reg, 889c636342SDmitry Baryshkov unsigned short val) 899c636342SDmitry Baryshkov { 909c636342SDmitry Baryshkov volatile u32 *reg_addr; 919c636342SDmitry Baryshkov 929c636342SDmitry Baryshkov mutex_lock(&car_mutex); 939c636342SDmitry Baryshkov 949c636342SDmitry Baryshkov /* set up primary or secondary codec space */ 958825e8e8SMarc Zyngier if (cpu_is_pxa25x() && reg == AC97_GPIO_STATUS) 969c636342SDmitry Baryshkov reg_addr = ac97->num ? &SMC_REG_BASE : &PMC_REG_BASE; 979c636342SDmitry Baryshkov else 989c636342SDmitry Baryshkov reg_addr = ac97->num ? &SAC_REG_BASE : &PAC_REG_BASE; 999c636342SDmitry Baryshkov reg_addr += (reg >> 1); 1009c636342SDmitry Baryshkov 1019c636342SDmitry Baryshkov GSR = GSR_CDONE | GSR_SDONE; 1029c636342SDmitry Baryshkov gsr_bits = 0; 1039c636342SDmitry Baryshkov *reg_addr = val; 1049c636342SDmitry Baryshkov if (wait_event_timeout(gsr_wq, (GSR | gsr_bits) & GSR_CDONE, 1) <= 0 && 1059c636342SDmitry Baryshkov !((GSR | gsr_bits) & GSR_CDONE)) 1069c636342SDmitry Baryshkov printk(KERN_ERR "%s: write error (ac97_reg=%d GSR=%#lx)\n", 1079c636342SDmitry Baryshkov __func__, reg, GSR | gsr_bits); 1089c636342SDmitry Baryshkov 1099c636342SDmitry Baryshkov mutex_unlock(&car_mutex); 1109c636342SDmitry Baryshkov } 1119c636342SDmitry Baryshkov EXPORT_SYMBOL_GPL(pxa2xx_ac97_write); 1129c636342SDmitry Baryshkov 1139d1cf39bSDmitry Baryshkov #ifdef CONFIG_PXA25x 1149d1cf39bSDmitry Baryshkov static inline void pxa_ac97_warm_pxa25x(void) 1159c636342SDmitry Baryshkov { 1169c636342SDmitry Baryshkov gsr_bits = 0; 1179c636342SDmitry Baryshkov 1189d1cf39bSDmitry Baryshkov GCR |= GCR_WARM_RST | GCR_PRIRDY_IEN | GCR_SECRDY_IEN; 1199d1cf39bSDmitry Baryshkov wait_event_timeout(gsr_wq, gsr_bits & (GSR_PCR | GSR_SCR), 1); 1209d1cf39bSDmitry Baryshkov } 1219d1cf39bSDmitry Baryshkov 1229d1cf39bSDmitry Baryshkov static inline void pxa_ac97_cold_pxa25x(void) 1239d1cf39bSDmitry Baryshkov { 1249d1cf39bSDmitry Baryshkov GCR &= GCR_COLD_RST; /* clear everything but nCRST */ 1259d1cf39bSDmitry Baryshkov GCR &= ~GCR_COLD_RST; /* then assert nCRST */ 1269d1cf39bSDmitry Baryshkov 1279d1cf39bSDmitry Baryshkov gsr_bits = 0; 1289d1cf39bSDmitry Baryshkov 1299d1cf39bSDmitry Baryshkov GCR = GCR_COLD_RST; 1309d1cf39bSDmitry Baryshkov GCR |= GCR_CDONE_IE|GCR_SDONE_IE; 1319d1cf39bSDmitry Baryshkov wait_event_timeout(gsr_wq, gsr_bits & (GSR_PCR | GSR_SCR), 1); 1329d1cf39bSDmitry Baryshkov } 1339d1cf39bSDmitry Baryshkov #endif 1349d1cf39bSDmitry Baryshkov 1359c636342SDmitry Baryshkov #ifdef CONFIG_PXA27x 1369d1cf39bSDmitry Baryshkov static inline void pxa_ac97_warm_pxa27x(void) 1379d1cf39bSDmitry Baryshkov { 1389d1cf39bSDmitry Baryshkov gsr_bits = 0; 1399d1cf39bSDmitry Baryshkov 140fb1bf8cdSEric Miao /* warm reset broken on Bulverde, so manually keep AC97 reset high */ 141fb1bf8cdSEric Miao pxa27x_assert_ac97reset(reset_gpio, 1); 1429c636342SDmitry Baryshkov udelay(10); 1439c636342SDmitry Baryshkov GCR |= GCR_WARM_RST; 144fb1bf8cdSEric Miao pxa27x_assert_ac97reset(reset_gpio, 0); 1459c636342SDmitry Baryshkov udelay(500); 1469d1cf39bSDmitry Baryshkov } 1479d1cf39bSDmitry Baryshkov 1489d1cf39bSDmitry Baryshkov static inline void pxa_ac97_cold_pxa27x(void) 1499d1cf39bSDmitry Baryshkov { 1509d1cf39bSDmitry Baryshkov GCR &= GCR_COLD_RST; /* clear everything but nCRST */ 1519d1cf39bSDmitry Baryshkov GCR &= ~GCR_COLD_RST; /* then assert nCRST */ 1529d1cf39bSDmitry Baryshkov 1539d1cf39bSDmitry Baryshkov gsr_bits = 0; 1549d1cf39bSDmitry Baryshkov 1559d1cf39bSDmitry Baryshkov /* PXA27x Developers Manual section 13.5.2.2.1 */ 1569d1cf39bSDmitry Baryshkov clk_enable(ac97conf_clk); 1579d1cf39bSDmitry Baryshkov udelay(5); 1589d1cf39bSDmitry Baryshkov clk_disable(ac97conf_clk); 1599d1cf39bSDmitry Baryshkov GCR = GCR_COLD_RST; 1609d1cf39bSDmitry Baryshkov udelay(50); 1619d1cf39bSDmitry Baryshkov } 1629d1cf39bSDmitry Baryshkov #endif 1639d1cf39bSDmitry Baryshkov 1649d1cf39bSDmitry Baryshkov #ifdef CONFIG_PXA3xx 1659d1cf39bSDmitry Baryshkov static inline void pxa_ac97_warm_pxa3xx(void) 1669d1cf39bSDmitry Baryshkov { 1679d1cf39bSDmitry Baryshkov int timeout = 100; 1689d1cf39bSDmitry Baryshkov 1699d1cf39bSDmitry Baryshkov gsr_bits = 0; 1709d1cf39bSDmitry Baryshkov 1719c636342SDmitry Baryshkov /* Can't use interrupts */ 1729c636342SDmitry Baryshkov GCR |= GCR_WARM_RST; 1739c636342SDmitry Baryshkov while (!((GSR | gsr_bits) & (GSR_PCR | GSR_SCR)) && timeout--) 1749c636342SDmitry Baryshkov mdelay(1); 1759d1cf39bSDmitry Baryshkov } 1769d1cf39bSDmitry Baryshkov 1779d1cf39bSDmitry Baryshkov static inline void pxa_ac97_cold_pxa3xx(void) 1789d1cf39bSDmitry Baryshkov { 1799d1cf39bSDmitry Baryshkov int timeout = 1000; 1809d1cf39bSDmitry Baryshkov 1819d1cf39bSDmitry Baryshkov /* Hold CLKBPB for 100us */ 1829d1cf39bSDmitry Baryshkov GCR = 0; 1839d1cf39bSDmitry Baryshkov GCR = GCR_CLKBPB; 1849d1cf39bSDmitry Baryshkov udelay(100); 1859d1cf39bSDmitry Baryshkov GCR = 0; 1869d1cf39bSDmitry Baryshkov 1879d1cf39bSDmitry Baryshkov GCR &= GCR_COLD_RST; /* clear everything but nCRST */ 1889d1cf39bSDmitry Baryshkov GCR &= ~GCR_COLD_RST; /* then assert nCRST */ 1899d1cf39bSDmitry Baryshkov 1909d1cf39bSDmitry Baryshkov gsr_bits = 0; 1919d1cf39bSDmitry Baryshkov 1929d1cf39bSDmitry Baryshkov /* Can't use interrupts on PXA3xx */ 1939d1cf39bSDmitry Baryshkov GCR &= ~(GCR_PRIRDY_IEN|GCR_SECRDY_IEN); 1949d1cf39bSDmitry Baryshkov 1959d1cf39bSDmitry Baryshkov GCR = GCR_WARM_RST | GCR_COLD_RST; 1969d1cf39bSDmitry Baryshkov while (!(GSR & (GSR_PCR | GSR_SCR)) && timeout--) 1979d1cf39bSDmitry Baryshkov mdelay(10); 1989d1cf39bSDmitry Baryshkov } 1999c636342SDmitry Baryshkov #endif 2009c636342SDmitry Baryshkov 2019d1cf39bSDmitry Baryshkov bool pxa2xx_ac97_try_warm_reset(struct snd_ac97 *ac97) 2029d1cf39bSDmitry Baryshkov { 203057de50cSLuotao Fu unsigned long gsr; 204057de50cSLuotao Fu 2059d1cf39bSDmitry Baryshkov #ifdef CONFIG_PXA25x 2068825e8e8SMarc Zyngier if (cpu_is_pxa25x()) 2079d1cf39bSDmitry Baryshkov pxa_ac97_warm_pxa25x(); 2089d1cf39bSDmitry Baryshkov else 2099d1cf39bSDmitry Baryshkov #endif 2109d1cf39bSDmitry Baryshkov #ifdef CONFIG_PXA27x 2119d1cf39bSDmitry Baryshkov if (cpu_is_pxa27x()) 2129d1cf39bSDmitry Baryshkov pxa_ac97_warm_pxa27x(); 2139d1cf39bSDmitry Baryshkov else 2149d1cf39bSDmitry Baryshkov #endif 2159d1cf39bSDmitry Baryshkov #ifdef CONFIG_PXA3xx 2169d1cf39bSDmitry Baryshkov if (cpu_is_pxa3xx()) 2179d1cf39bSDmitry Baryshkov pxa_ac97_warm_pxa3xx(); 2189d1cf39bSDmitry Baryshkov else 2199d1cf39bSDmitry Baryshkov #endif 2209d1cf39bSDmitry Baryshkov BUG(); 221057de50cSLuotao Fu gsr = GSR | gsr_bits; 222057de50cSLuotao Fu if (!(gsr & (GSR_PCR | GSR_SCR))) { 2239c636342SDmitry Baryshkov printk(KERN_INFO "%s: warm reset timeout (GSR=%#lx)\n", 224057de50cSLuotao Fu __func__, gsr); 2259c636342SDmitry Baryshkov 2269c636342SDmitry Baryshkov return false; 2279c636342SDmitry Baryshkov } 2289c636342SDmitry Baryshkov 2299c636342SDmitry Baryshkov return true; 2309c636342SDmitry Baryshkov } 2319c636342SDmitry Baryshkov EXPORT_SYMBOL_GPL(pxa2xx_ac97_try_warm_reset); 2329c636342SDmitry Baryshkov 2339c636342SDmitry Baryshkov bool pxa2xx_ac97_try_cold_reset(struct snd_ac97 *ac97) 2349c636342SDmitry Baryshkov { 235057de50cSLuotao Fu unsigned long gsr; 236057de50cSLuotao Fu 2379d1cf39bSDmitry Baryshkov #ifdef CONFIG_PXA25x 2388825e8e8SMarc Zyngier if (cpu_is_pxa25x()) 2399d1cf39bSDmitry Baryshkov pxa_ac97_cold_pxa25x(); 2409d1cf39bSDmitry Baryshkov else 2419c636342SDmitry Baryshkov #endif 2429c636342SDmitry Baryshkov #ifdef CONFIG_PXA27x 2439d1cf39bSDmitry Baryshkov if (cpu_is_pxa27x()) 2449d1cf39bSDmitry Baryshkov pxa_ac97_cold_pxa27x(); 2459d1cf39bSDmitry Baryshkov else 2469c636342SDmitry Baryshkov #endif 2479d1cf39bSDmitry Baryshkov #ifdef CONFIG_PXA3xx 2489d1cf39bSDmitry Baryshkov if (cpu_is_pxa3xx()) 2499d1cf39bSDmitry Baryshkov pxa_ac97_cold_pxa3xx(); 2509d1cf39bSDmitry Baryshkov else 2519d1cf39bSDmitry Baryshkov #endif 2529d1cf39bSDmitry Baryshkov BUG(); 2539c636342SDmitry Baryshkov 254057de50cSLuotao Fu gsr = GSR | gsr_bits; 255057de50cSLuotao Fu if (!(gsr & (GSR_PCR | GSR_SCR))) { 2569c636342SDmitry Baryshkov printk(KERN_INFO "%s: cold reset timeout (GSR=%#lx)\n", 257057de50cSLuotao Fu __func__, gsr); 2589c636342SDmitry Baryshkov 2599c636342SDmitry Baryshkov return false; 2609c636342SDmitry Baryshkov } 2619c636342SDmitry Baryshkov 2629c636342SDmitry Baryshkov return true; 2639c636342SDmitry Baryshkov } 2649c636342SDmitry Baryshkov EXPORT_SYMBOL_GPL(pxa2xx_ac97_try_cold_reset); 2659c636342SDmitry Baryshkov 2669c636342SDmitry Baryshkov 2679c636342SDmitry Baryshkov void pxa2xx_ac97_finish_reset(struct snd_ac97 *ac97) 2689c636342SDmitry Baryshkov { 2699c636342SDmitry Baryshkov GCR &= ~(GCR_PRIRDY_IEN|GCR_SECRDY_IEN); 2709c636342SDmitry Baryshkov GCR |= GCR_SDONE_IE|GCR_CDONE_IE; 2719c636342SDmitry Baryshkov } 2729c636342SDmitry Baryshkov EXPORT_SYMBOL_GPL(pxa2xx_ac97_finish_reset); 2739c636342SDmitry Baryshkov 2749c636342SDmitry Baryshkov static irqreturn_t pxa2xx_ac97_irq(int irq, void *dev_id) 2759c636342SDmitry Baryshkov { 2769c636342SDmitry Baryshkov long status; 2779c636342SDmitry Baryshkov 2789c636342SDmitry Baryshkov status = GSR; 2799c636342SDmitry Baryshkov if (status) { 2809c636342SDmitry Baryshkov GSR = status; 2819c636342SDmitry Baryshkov gsr_bits |= status; 2829c636342SDmitry Baryshkov wake_up(&gsr_wq); 2839c636342SDmitry Baryshkov 2849c636342SDmitry Baryshkov /* Although we don't use those we still need to clear them 2859c636342SDmitry Baryshkov since they tend to spuriously trigger when MMC is used 2869c636342SDmitry Baryshkov (hardware bug? go figure)... */ 2879d1cf39bSDmitry Baryshkov if (cpu_is_pxa27x()) { 2889c636342SDmitry Baryshkov MISR = MISR_EOC; 2899c636342SDmitry Baryshkov PISR = PISR_EOC; 2909c636342SDmitry Baryshkov MCSR = MCSR_EOC; 2919d1cf39bSDmitry Baryshkov } 2929c636342SDmitry Baryshkov 2939c636342SDmitry Baryshkov return IRQ_HANDLED; 2949c636342SDmitry Baryshkov } 2959c636342SDmitry Baryshkov 2969c636342SDmitry Baryshkov return IRQ_NONE; 2979c636342SDmitry Baryshkov } 2989c636342SDmitry Baryshkov 2999c636342SDmitry Baryshkov #ifdef CONFIG_PM 3009c636342SDmitry Baryshkov int pxa2xx_ac97_hw_suspend(void) 3019c636342SDmitry Baryshkov { 3029c636342SDmitry Baryshkov GCR |= GCR_ACLINK_OFF; 3039c636342SDmitry Baryshkov clk_disable(ac97_clk); 3049c636342SDmitry Baryshkov return 0; 3059c636342SDmitry Baryshkov } 3069c636342SDmitry Baryshkov EXPORT_SYMBOL_GPL(pxa2xx_ac97_hw_suspend); 3079c636342SDmitry Baryshkov 3089c636342SDmitry Baryshkov int pxa2xx_ac97_hw_resume(void) 3099c636342SDmitry Baryshkov { 3109c636342SDmitry Baryshkov clk_enable(ac97_clk); 3119c636342SDmitry Baryshkov return 0; 3129c636342SDmitry Baryshkov } 3139c636342SDmitry Baryshkov EXPORT_SYMBOL_GPL(pxa2xx_ac97_hw_resume); 3149c636342SDmitry Baryshkov #endif 3159c636342SDmitry Baryshkov 3169c636342SDmitry Baryshkov int __devinit pxa2xx_ac97_hw_probe(struct platform_device *dev) 3179c636342SDmitry Baryshkov { 3189c636342SDmitry Baryshkov int ret; 319eae17754SMark Brown pxa2xx_audio_ops_t *pdata = dev->dev.platform_data; 32026ade896SRobert Jarzmik 32126ade896SRobert Jarzmik if (pdata) { 32226ade896SRobert Jarzmik switch (pdata->reset_gpio) { 32326ade896SRobert Jarzmik case 95: 32426ade896SRobert Jarzmik case 113: 32526ade896SRobert Jarzmik reset_gpio = pdata->reset_gpio; 32626ade896SRobert Jarzmik break; 32726ade896SRobert Jarzmik case 0: 32826ade896SRobert Jarzmik reset_gpio = 113; 32926ade896SRobert Jarzmik break; 33026ade896SRobert Jarzmik case -1: 33126ade896SRobert Jarzmik break; 33226ade896SRobert Jarzmik default: 3331f218695STakashi Iwai dev_err(&dev->dev, "Invalid reset GPIO %d\n", 33426ade896SRobert Jarzmik pdata->reset_gpio); 33526ade896SRobert Jarzmik } 33626ade896SRobert Jarzmik } else { 33726ade896SRobert Jarzmik if (cpu_is_pxa27x()) 33826ade896SRobert Jarzmik reset_gpio = 113; 33926ade896SRobert Jarzmik } 3409c636342SDmitry Baryshkov 3419d1cf39bSDmitry Baryshkov if (cpu_is_pxa27x()) { 3429c636342SDmitry Baryshkov /* Use GPIO 113 as AC97 Reset on Bulverde */ 343fb1bf8cdSEric Miao pxa27x_assert_ac97reset(reset_gpio, 0); 3449c636342SDmitry Baryshkov ac97conf_clk = clk_get(&dev->dev, "AC97CONFCLK"); 3459c636342SDmitry Baryshkov if (IS_ERR(ac97conf_clk)) { 3469c636342SDmitry Baryshkov ret = PTR_ERR(ac97conf_clk); 3479c636342SDmitry Baryshkov ac97conf_clk = NULL; 34879612336SDmitry Baryshkov goto err_conf; 3499c636342SDmitry Baryshkov } 3509d1cf39bSDmitry Baryshkov } 3519c636342SDmitry Baryshkov 3529c636342SDmitry Baryshkov ac97_clk = clk_get(&dev->dev, "AC97CLK"); 3539c636342SDmitry Baryshkov if (IS_ERR(ac97_clk)) { 3549c636342SDmitry Baryshkov ret = PTR_ERR(ac97_clk); 3559c636342SDmitry Baryshkov ac97_clk = NULL; 35679612336SDmitry Baryshkov goto err_clk; 3579c636342SDmitry Baryshkov } 3589c636342SDmitry Baryshkov 35979612336SDmitry Baryshkov ret = clk_enable(ac97_clk); 36079612336SDmitry Baryshkov if (ret) 36179612336SDmitry Baryshkov goto err_clk2; 36279612336SDmitry Baryshkov 36388e24c3aSYong Zhang ret = request_irq(IRQ_AC97, pxa2xx_ac97_irq, 0, "AC97", NULL); 36479612336SDmitry Baryshkov if (ret < 0) 36579612336SDmitry Baryshkov goto err_irq; 36679612336SDmitry Baryshkov 36779612336SDmitry Baryshkov return 0; 3689c636342SDmitry Baryshkov 3699c636342SDmitry Baryshkov err_irq: 3709c636342SDmitry Baryshkov GCR |= GCR_ACLINK_OFF; 37179612336SDmitry Baryshkov err_clk2: 37279612336SDmitry Baryshkov clk_put(ac97_clk); 37379612336SDmitry Baryshkov ac97_clk = NULL; 37479612336SDmitry Baryshkov err_clk: 3759c636342SDmitry Baryshkov if (ac97conf_clk) { 3769c636342SDmitry Baryshkov clk_put(ac97conf_clk); 3779c636342SDmitry Baryshkov ac97conf_clk = NULL; 3789c636342SDmitry Baryshkov } 37979612336SDmitry Baryshkov err_conf: 3809c636342SDmitry Baryshkov return ret; 3819c636342SDmitry Baryshkov } 3829c636342SDmitry Baryshkov EXPORT_SYMBOL_GPL(pxa2xx_ac97_hw_probe); 3839c636342SDmitry Baryshkov 3849c636342SDmitry Baryshkov void pxa2xx_ac97_hw_remove(struct platform_device *dev) 3859c636342SDmitry Baryshkov { 3869c636342SDmitry Baryshkov GCR |= GCR_ACLINK_OFF; 3879c636342SDmitry Baryshkov free_irq(IRQ_AC97, NULL); 3889d1cf39bSDmitry Baryshkov if (ac97conf_clk) { 3899c636342SDmitry Baryshkov clk_put(ac97conf_clk); 3909c636342SDmitry Baryshkov ac97conf_clk = NULL; 3919d1cf39bSDmitry Baryshkov } 3929c636342SDmitry Baryshkov clk_disable(ac97_clk); 3939c636342SDmitry Baryshkov clk_put(ac97_clk); 3949c636342SDmitry Baryshkov ac97_clk = NULL; 3959c636342SDmitry Baryshkov } 3969c636342SDmitry Baryshkov EXPORT_SYMBOL_GPL(pxa2xx_ac97_hw_remove); 3979c636342SDmitry Baryshkov 3989c636342SDmitry Baryshkov MODULE_AUTHOR("Nicolas Pitre"); 3999c636342SDmitry Baryshkov MODULE_DESCRIPTION("Intel/Marvell PXA sound library"); 4009c636342SDmitry Baryshkov MODULE_LICENSE("GPL"); 4019c636342SDmitry Baryshkov 402