forked from luck/tmp_suning_uos_patched
88ec7ae82d
BUG() used in the driver is just to spit the stack trace on buggy points, not really needed to stop the whole operation. For that purpose, it'd be more convenient to use snd_BUG() instead. Signed-off-by: Takashi Iwai <tiwai@suse.de>
416 lines
8.7 KiB
C
416 lines
8.7 KiB
C
/*
|
|
* Based on sound/arm/pxa2xx-ac97.c and sound/soc/pxa/pxa2xx-ac97.c
|
|
* which contain:
|
|
*
|
|
* Author: Nicolas Pitre
|
|
* Created: Dec 02, 2004
|
|
* Copyright: MontaVista Software Inc.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/clk.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/module.h>
|
|
#include <linux/io.h>
|
|
#include <linux/gpio.h>
|
|
|
|
#include <sound/ac97_codec.h>
|
|
#include <sound/pxa2xx-lib.h>
|
|
|
|
#include <mach/irqs.h>
|
|
#include <mach/regs-ac97.h>
|
|
#include <mach/audio.h>
|
|
|
|
static DEFINE_MUTEX(car_mutex);
|
|
static DECLARE_WAIT_QUEUE_HEAD(gsr_wq);
|
|
static volatile long gsr_bits;
|
|
static struct clk *ac97_clk;
|
|
static struct clk *ac97conf_clk;
|
|
static int reset_gpio;
|
|
|
|
extern void pxa27x_configure_ac97reset(int reset_gpio, bool to_gpio);
|
|
|
|
/*
|
|
* Beware PXA27x bugs:
|
|
*
|
|
* o Slot 12 read from modem space will hang controller.
|
|
* o CDONE, SDONE interrupt fails after any slot 12 IO.
|
|
*
|
|
* We therefore have an hybrid approach for waiting on SDONE (interrupt or
|
|
* 1 jiffy timeout if interrupt never comes).
|
|
*/
|
|
|
|
unsigned short pxa2xx_ac97_read(struct snd_ac97 *ac97, unsigned short reg)
|
|
{
|
|
unsigned short val = -1;
|
|
volatile u32 *reg_addr;
|
|
|
|
mutex_lock(&car_mutex);
|
|
|
|
/* set up primary or secondary codec space */
|
|
if (cpu_is_pxa25x() && reg == AC97_GPIO_STATUS)
|
|
reg_addr = ac97->num ? &SMC_REG_BASE : &PMC_REG_BASE;
|
|
else
|
|
reg_addr = ac97->num ? &SAC_REG_BASE : &PAC_REG_BASE;
|
|
reg_addr += (reg >> 1);
|
|
|
|
/* start read access across the ac97 link */
|
|
GSR = GSR_CDONE | GSR_SDONE;
|
|
gsr_bits = 0;
|
|
val = *reg_addr;
|
|
if (reg == AC97_GPIO_STATUS)
|
|
goto out;
|
|
if (wait_event_timeout(gsr_wq, (GSR | gsr_bits) & GSR_SDONE, 1) <= 0 &&
|
|
!((GSR | gsr_bits) & GSR_SDONE)) {
|
|
printk(KERN_ERR "%s: read error (ac97_reg=%d GSR=%#lx)\n",
|
|
__func__, reg, GSR | gsr_bits);
|
|
val = -1;
|
|
goto out;
|
|
}
|
|
|
|
/* valid data now */
|
|
GSR = GSR_CDONE | GSR_SDONE;
|
|
gsr_bits = 0;
|
|
val = *reg_addr;
|
|
/* but we've just started another cycle... */
|
|
wait_event_timeout(gsr_wq, (GSR | gsr_bits) & GSR_SDONE, 1);
|
|
|
|
out: mutex_unlock(&car_mutex);
|
|
return val;
|
|
}
|
|
EXPORT_SYMBOL_GPL(pxa2xx_ac97_read);
|
|
|
|
void pxa2xx_ac97_write(struct snd_ac97 *ac97, unsigned short reg,
|
|
unsigned short val)
|
|
{
|
|
volatile u32 *reg_addr;
|
|
|
|
mutex_lock(&car_mutex);
|
|
|
|
/* set up primary or secondary codec space */
|
|
if (cpu_is_pxa25x() && reg == AC97_GPIO_STATUS)
|
|
reg_addr = ac97->num ? &SMC_REG_BASE : &PMC_REG_BASE;
|
|
else
|
|
reg_addr = ac97->num ? &SAC_REG_BASE : &PAC_REG_BASE;
|
|
reg_addr += (reg >> 1);
|
|
|
|
GSR = GSR_CDONE | GSR_SDONE;
|
|
gsr_bits = 0;
|
|
*reg_addr = val;
|
|
if (wait_event_timeout(gsr_wq, (GSR | gsr_bits) & GSR_CDONE, 1) <= 0 &&
|
|
!((GSR | gsr_bits) & GSR_CDONE))
|
|
printk(KERN_ERR "%s: write error (ac97_reg=%d GSR=%#lx)\n",
|
|
__func__, reg, GSR | gsr_bits);
|
|
|
|
mutex_unlock(&car_mutex);
|
|
}
|
|
EXPORT_SYMBOL_GPL(pxa2xx_ac97_write);
|
|
|
|
#ifdef CONFIG_PXA25x
|
|
static inline void pxa_ac97_warm_pxa25x(void)
|
|
{
|
|
gsr_bits = 0;
|
|
|
|
GCR |= GCR_WARM_RST;
|
|
}
|
|
|
|
static inline void pxa_ac97_cold_pxa25x(void)
|
|
{
|
|
GCR &= GCR_COLD_RST; /* clear everything but nCRST */
|
|
GCR &= ~GCR_COLD_RST; /* then assert nCRST */
|
|
|
|
gsr_bits = 0;
|
|
|
|
GCR = GCR_COLD_RST;
|
|
}
|
|
#endif
|
|
|
|
#ifdef CONFIG_PXA27x
|
|
static inline void pxa_ac97_warm_pxa27x(void)
|
|
{
|
|
gsr_bits = 0;
|
|
|
|
/* warm reset broken on Bulverde, so manually keep AC97 reset high */
|
|
pxa27x_configure_ac97reset(reset_gpio, true);
|
|
udelay(10);
|
|
GCR |= GCR_WARM_RST;
|
|
pxa27x_configure_ac97reset(reset_gpio, false);
|
|
udelay(500);
|
|
}
|
|
|
|
static inline void pxa_ac97_cold_pxa27x(void)
|
|
{
|
|
GCR &= GCR_COLD_RST; /* clear everything but nCRST */
|
|
GCR &= ~GCR_COLD_RST; /* then assert nCRST */
|
|
|
|
gsr_bits = 0;
|
|
|
|
/* PXA27x Developers Manual section 13.5.2.2.1 */
|
|
clk_enable(ac97conf_clk);
|
|
udelay(5);
|
|
clk_disable(ac97conf_clk);
|
|
GCR = GCR_COLD_RST | GCR_WARM_RST;
|
|
}
|
|
#endif
|
|
|
|
#ifdef CONFIG_PXA3xx
|
|
static inline void pxa_ac97_warm_pxa3xx(void)
|
|
{
|
|
gsr_bits = 0;
|
|
|
|
/* Can't use interrupts */
|
|
GCR |= GCR_WARM_RST;
|
|
}
|
|
|
|
static inline void pxa_ac97_cold_pxa3xx(void)
|
|
{
|
|
/* Hold CLKBPB for 100us */
|
|
GCR = 0;
|
|
GCR = GCR_CLKBPB;
|
|
udelay(100);
|
|
GCR = 0;
|
|
|
|
GCR &= GCR_COLD_RST; /* clear everything but nCRST */
|
|
GCR &= ~GCR_COLD_RST; /* then assert nCRST */
|
|
|
|
gsr_bits = 0;
|
|
|
|
/* Can't use interrupts on PXA3xx */
|
|
GCR &= ~(GCR_PRIRDY_IEN|GCR_SECRDY_IEN);
|
|
|
|
GCR = GCR_WARM_RST | GCR_COLD_RST;
|
|
}
|
|
#endif
|
|
|
|
bool pxa2xx_ac97_try_warm_reset(struct snd_ac97 *ac97)
|
|
{
|
|
unsigned long gsr;
|
|
unsigned int timeout = 100;
|
|
|
|
#ifdef CONFIG_PXA25x
|
|
if (cpu_is_pxa25x())
|
|
pxa_ac97_warm_pxa25x();
|
|
else
|
|
#endif
|
|
#ifdef CONFIG_PXA27x
|
|
if (cpu_is_pxa27x())
|
|
pxa_ac97_warm_pxa27x();
|
|
else
|
|
#endif
|
|
#ifdef CONFIG_PXA3xx
|
|
if (cpu_is_pxa3xx())
|
|
pxa_ac97_warm_pxa3xx();
|
|
else
|
|
#endif
|
|
snd_BUG();
|
|
|
|
while (!((GSR | gsr_bits) & (GSR_PCR | GSR_SCR)) && timeout--)
|
|
mdelay(1);
|
|
|
|
gsr = GSR | gsr_bits;
|
|
if (!(gsr & (GSR_PCR | GSR_SCR))) {
|
|
printk(KERN_INFO "%s: warm reset timeout (GSR=%#lx)\n",
|
|
__func__, gsr);
|
|
|
|
return false;
|
|
}
|
|
|
|
return true;
|
|
}
|
|
EXPORT_SYMBOL_GPL(pxa2xx_ac97_try_warm_reset);
|
|
|
|
bool pxa2xx_ac97_try_cold_reset(struct snd_ac97 *ac97)
|
|
{
|
|
unsigned long gsr;
|
|
unsigned int timeout = 1000;
|
|
|
|
#ifdef CONFIG_PXA25x
|
|
if (cpu_is_pxa25x())
|
|
pxa_ac97_cold_pxa25x();
|
|
else
|
|
#endif
|
|
#ifdef CONFIG_PXA27x
|
|
if (cpu_is_pxa27x())
|
|
pxa_ac97_cold_pxa27x();
|
|
else
|
|
#endif
|
|
#ifdef CONFIG_PXA3xx
|
|
if (cpu_is_pxa3xx())
|
|
pxa_ac97_cold_pxa3xx();
|
|
else
|
|
#endif
|
|
snd_BUG();
|
|
|
|
while (!((GSR | gsr_bits) & (GSR_PCR | GSR_SCR)) && timeout--)
|
|
mdelay(1);
|
|
|
|
gsr = GSR | gsr_bits;
|
|
if (!(gsr & (GSR_PCR | GSR_SCR))) {
|
|
printk(KERN_INFO "%s: cold reset timeout (GSR=%#lx)\n",
|
|
__func__, gsr);
|
|
|
|
return false;
|
|
}
|
|
|
|
return true;
|
|
}
|
|
EXPORT_SYMBOL_GPL(pxa2xx_ac97_try_cold_reset);
|
|
|
|
|
|
void pxa2xx_ac97_finish_reset(struct snd_ac97 *ac97)
|
|
{
|
|
GCR &= ~(GCR_PRIRDY_IEN|GCR_SECRDY_IEN);
|
|
GCR |= GCR_SDONE_IE|GCR_CDONE_IE;
|
|
}
|
|
EXPORT_SYMBOL_GPL(pxa2xx_ac97_finish_reset);
|
|
|
|
static irqreturn_t pxa2xx_ac97_irq(int irq, void *dev_id)
|
|
{
|
|
long status;
|
|
|
|
status = GSR;
|
|
if (status) {
|
|
GSR = status;
|
|
gsr_bits |= status;
|
|
wake_up(&gsr_wq);
|
|
|
|
/* Although we don't use those we still need to clear them
|
|
since they tend to spuriously trigger when MMC is used
|
|
(hardware bug? go figure)... */
|
|
if (cpu_is_pxa27x()) {
|
|
MISR = MISR_EOC;
|
|
PISR = PISR_EOC;
|
|
MCSR = MCSR_EOC;
|
|
}
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
return IRQ_NONE;
|
|
}
|
|
|
|
#ifdef CONFIG_PM
|
|
int pxa2xx_ac97_hw_suspend(void)
|
|
{
|
|
GCR |= GCR_ACLINK_OFF;
|
|
clk_disable(ac97_clk);
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(pxa2xx_ac97_hw_suspend);
|
|
|
|
int pxa2xx_ac97_hw_resume(void)
|
|
{
|
|
clk_enable(ac97_clk);
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(pxa2xx_ac97_hw_resume);
|
|
#endif
|
|
|
|
int pxa2xx_ac97_hw_probe(struct platform_device *dev)
|
|
{
|
|
int ret;
|
|
pxa2xx_audio_ops_t *pdata = dev->dev.platform_data;
|
|
|
|
if (pdata) {
|
|
switch (pdata->reset_gpio) {
|
|
case 95:
|
|
case 113:
|
|
reset_gpio = pdata->reset_gpio;
|
|
break;
|
|
case 0:
|
|
reset_gpio = 113;
|
|
break;
|
|
case -1:
|
|
break;
|
|
default:
|
|
dev_err(&dev->dev, "Invalid reset GPIO %d\n",
|
|
pdata->reset_gpio);
|
|
}
|
|
} else {
|
|
if (cpu_is_pxa27x())
|
|
reset_gpio = 113;
|
|
}
|
|
|
|
if (cpu_is_pxa27x()) {
|
|
/*
|
|
* This gpio is needed for a work-around to a bug in the ac97
|
|
* controller during warm reset. The direction and level is set
|
|
* here so that it is an output driven high when switching from
|
|
* AC97_nRESET alt function to generic gpio.
|
|
*/
|
|
ret = gpio_request_one(reset_gpio, GPIOF_OUT_INIT_HIGH,
|
|
"pxa27x ac97 reset");
|
|
if (ret < 0) {
|
|
pr_err("%s: gpio_request_one() failed: %d\n",
|
|
__func__, ret);
|
|
goto err_conf;
|
|
}
|
|
pxa27x_configure_ac97reset(reset_gpio, false);
|
|
|
|
ac97conf_clk = clk_get(&dev->dev, "AC97CONFCLK");
|
|
if (IS_ERR(ac97conf_clk)) {
|
|
ret = PTR_ERR(ac97conf_clk);
|
|
ac97conf_clk = NULL;
|
|
goto err_conf;
|
|
}
|
|
}
|
|
|
|
ac97_clk = clk_get(&dev->dev, "AC97CLK");
|
|
if (IS_ERR(ac97_clk)) {
|
|
ret = PTR_ERR(ac97_clk);
|
|
ac97_clk = NULL;
|
|
goto err_clk;
|
|
}
|
|
|
|
ret = clk_enable(ac97_clk);
|
|
if (ret)
|
|
goto err_clk2;
|
|
|
|
ret = request_irq(IRQ_AC97, pxa2xx_ac97_irq, 0, "AC97", NULL);
|
|
if (ret < 0)
|
|
goto err_irq;
|
|
|
|
return 0;
|
|
|
|
err_irq:
|
|
GCR |= GCR_ACLINK_OFF;
|
|
err_clk2:
|
|
clk_put(ac97_clk);
|
|
ac97_clk = NULL;
|
|
err_clk:
|
|
if (ac97conf_clk) {
|
|
clk_put(ac97conf_clk);
|
|
ac97conf_clk = NULL;
|
|
}
|
|
err_conf:
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(pxa2xx_ac97_hw_probe);
|
|
|
|
void pxa2xx_ac97_hw_remove(struct platform_device *dev)
|
|
{
|
|
if (cpu_is_pxa27x())
|
|
gpio_free(reset_gpio);
|
|
GCR |= GCR_ACLINK_OFF;
|
|
free_irq(IRQ_AC97, NULL);
|
|
if (ac97conf_clk) {
|
|
clk_put(ac97conf_clk);
|
|
ac97conf_clk = NULL;
|
|
}
|
|
clk_disable(ac97_clk);
|
|
clk_put(ac97_clk);
|
|
ac97_clk = NULL;
|
|
}
|
|
EXPORT_SYMBOL_GPL(pxa2xx_ac97_hw_remove);
|
|
|
|
MODULE_AUTHOR("Nicolas Pitre");
|
|
MODULE_DESCRIPTION("Intel/Marvell PXA sound library");
|
|
MODULE_LICENSE("GPL");
|
|
|