mirror of
git://git.openwrt.org/openwrt/openwrt.git
synced 2024-12-11 17:34:57 +00:00
ar71xx: optimize register access in irq.c
SVN-Revision: 20286
This commit is contained in:
parent
2438a03ce4
commit
1dedaf30a6
@ -23,10 +23,11 @@
|
|||||||
|
|
||||||
static void ar71xx_gpio_irq_dispatch(void)
|
static void ar71xx_gpio_irq_dispatch(void)
|
||||||
{
|
{
|
||||||
|
void __iomem *base = ar71xx_gpio_base;
|
||||||
u32 pending;
|
u32 pending;
|
||||||
|
|
||||||
pending = ar71xx_gpio_rr(GPIO_REG_INT_PENDING)
|
pending = __raw_readl(base + GPIO_REG_INT_PENDING) &
|
||||||
& ar71xx_gpio_rr(GPIO_REG_INT_ENABLE);
|
__raw_readl(base + GPIO_REG_INT_ENABLE);
|
||||||
|
|
||||||
if (pending)
|
if (pending)
|
||||||
do_IRQ(AR71XX_GPIO_IRQ_BASE + fls(pending) - 1);
|
do_IRQ(AR71XX_GPIO_IRQ_BASE + fls(pending) - 1);
|
||||||
@ -36,22 +37,30 @@ static void ar71xx_gpio_irq_dispatch(void)
|
|||||||
|
|
||||||
static void ar71xx_gpio_irq_unmask(unsigned int irq)
|
static void ar71xx_gpio_irq_unmask(unsigned int irq)
|
||||||
{
|
{
|
||||||
|
void __iomem *base = ar71xx_gpio_base;
|
||||||
|
u32 t;
|
||||||
|
|
||||||
irq -= AR71XX_GPIO_IRQ_BASE;
|
irq -= AR71XX_GPIO_IRQ_BASE;
|
||||||
ar71xx_gpio_wr(GPIO_REG_INT_ENABLE,
|
|
||||||
ar71xx_gpio_rr(GPIO_REG_INT_ENABLE) | (1 << irq));
|
t = __raw_readl(base + GPIO_REG_INT_ENABLE);
|
||||||
|
__raw_writel(t | (1 << irq), base + GPIO_REG_INT_ENABLE);
|
||||||
|
|
||||||
/* flush write */
|
/* flush write */
|
||||||
ar71xx_gpio_rr(GPIO_REG_INT_ENABLE);
|
(void) __raw_readl(base + GPIO_REG_INT_ENABLE);
|
||||||
}
|
}
|
||||||
|
|
||||||
static void ar71xx_gpio_irq_mask(unsigned int irq)
|
static void ar71xx_gpio_irq_mask(unsigned int irq)
|
||||||
{
|
{
|
||||||
|
void __iomem *base = ar71xx_gpio_base;
|
||||||
|
u32 t;
|
||||||
|
|
||||||
irq -= AR71XX_GPIO_IRQ_BASE;
|
irq -= AR71XX_GPIO_IRQ_BASE;
|
||||||
ar71xx_gpio_wr(GPIO_REG_INT_ENABLE,
|
|
||||||
ar71xx_gpio_rr(GPIO_REG_INT_ENABLE) & ~(1 << irq));
|
t = __raw_readl(base + GPIO_REG_INT_ENABLE);
|
||||||
|
__raw_writel(t & ~(1 << irq), base + GPIO_REG_INT_ENABLE);
|
||||||
|
|
||||||
/* flush write */
|
/* flush write */
|
||||||
ar71xx_gpio_rr(GPIO_REG_INT_ENABLE);
|
(void) __raw_readl(base + GPIO_REG_INT_ENABLE);
|
||||||
}
|
}
|
||||||
|
|
||||||
#if 0
|
#if 0
|
||||||
@ -82,16 +91,17 @@ static struct irqaction ar71xx_gpio_irqaction = {
|
|||||||
|
|
||||||
static void __init ar71xx_gpio_irq_init(void)
|
static void __init ar71xx_gpio_irq_init(void)
|
||||||
{
|
{
|
||||||
|
void __iomem *base = ar71xx_gpio_base;
|
||||||
int i;
|
int i;
|
||||||
|
|
||||||
ar71xx_gpio_wr(GPIO_REG_INT_ENABLE, 0);
|
__raw_writel(0, base + GPIO_REG_INT_ENABLE);
|
||||||
ar71xx_gpio_wr(GPIO_REG_INT_PENDING, 0);
|
__raw_writel(0, base + GPIO_REG_INT_PENDING);
|
||||||
|
|
||||||
/* setup type of all GPIO interrupts to level sensitive */
|
/* setup type of all GPIO interrupts to level sensitive */
|
||||||
ar71xx_gpio_wr(GPIO_REG_INT_TYPE, GPIO_INT_ALL);
|
__raw_writel(GPIO_INT_ALL, base + GPIO_REG_INT_TYPE);
|
||||||
|
|
||||||
/* setup polarity of all GPIO interrupts to active high */
|
/* setup polarity of all GPIO interrupts to active high */
|
||||||
ar71xx_gpio_wr(GPIO_REG_INT_POLARITY, GPIO_INT_ALL);
|
__raw_writel(GPIO_INT_ALL, base + GPIO_REG_INT_POLARITY);
|
||||||
|
|
||||||
for (i = AR71XX_GPIO_IRQ_BASE;
|
for (i = AR71XX_GPIO_IRQ_BASE;
|
||||||
i < AR71XX_GPIO_IRQ_BASE + AR71XX_GPIO_IRQ_COUNT; i++) {
|
i < AR71XX_GPIO_IRQ_BASE + AR71XX_GPIO_IRQ_COUNT; i++) {
|
||||||
@ -140,32 +150,44 @@ static void ar71xx_misc_irq_dispatch(void)
|
|||||||
|
|
||||||
static void ar71xx_misc_irq_unmask(unsigned int irq)
|
static void ar71xx_misc_irq_unmask(unsigned int irq)
|
||||||
{
|
{
|
||||||
|
void __iomem *base = ar71xx_reset_base;
|
||||||
|
u32 t;
|
||||||
|
|
||||||
irq -= AR71XX_MISC_IRQ_BASE;
|
irq -= AR71XX_MISC_IRQ_BASE;
|
||||||
ar71xx_reset_wr(AR71XX_RESET_REG_MISC_INT_ENABLE,
|
|
||||||
ar71xx_reset_rr(AR71XX_RESET_REG_MISC_INT_ENABLE) | (1 << irq));
|
t = __raw_readl(base + AR71XX_RESET_REG_MISC_INT_ENABLE);
|
||||||
|
__raw_writel(t | (1 << irq), base + AR71XX_RESET_REG_MISC_INT_ENABLE);
|
||||||
|
|
||||||
/* flush write */
|
/* flush write */
|
||||||
ar71xx_reset_rr(AR71XX_RESET_REG_MISC_INT_ENABLE);
|
(void) __raw_readl(base + AR71XX_RESET_REG_MISC_INT_ENABLE);
|
||||||
}
|
}
|
||||||
|
|
||||||
static void ar71xx_misc_irq_mask(unsigned int irq)
|
static void ar71xx_misc_irq_mask(unsigned int irq)
|
||||||
{
|
{
|
||||||
|
void __iomem *base = ar71xx_reset_base;
|
||||||
|
u32 t;
|
||||||
|
|
||||||
irq -= AR71XX_MISC_IRQ_BASE;
|
irq -= AR71XX_MISC_IRQ_BASE;
|
||||||
ar71xx_reset_wr(AR71XX_RESET_REG_MISC_INT_ENABLE,
|
|
||||||
ar71xx_reset_rr(AR71XX_RESET_REG_MISC_INT_ENABLE) & ~(1 << irq));
|
t = __raw_readl(base + AR71XX_RESET_REG_MISC_INT_ENABLE);
|
||||||
|
__raw_writel(t & ~(1 << irq), base + AR71XX_RESET_REG_MISC_INT_ENABLE);
|
||||||
|
|
||||||
/* flush write */
|
/* flush write */
|
||||||
ar71xx_reset_rr(AR71XX_RESET_REG_MISC_INT_ENABLE);
|
(void) __raw_readl(base + AR71XX_RESET_REG_MISC_INT_ENABLE);
|
||||||
}
|
}
|
||||||
|
|
||||||
static void ar724x_misc_irq_ack(unsigned int irq)
|
static void ar724x_misc_irq_ack(unsigned int irq)
|
||||||
{
|
{
|
||||||
|
void __iomem *base = ar71xx_reset_base;
|
||||||
|
u32 t;
|
||||||
|
|
||||||
irq -= AR71XX_MISC_IRQ_BASE;
|
irq -= AR71XX_MISC_IRQ_BASE;
|
||||||
ar71xx_reset_wr(AR71XX_RESET_REG_MISC_INT_STATUS,
|
|
||||||
ar71xx_reset_rr(AR71XX_RESET_REG_MISC_INT_STATUS) & ~(1 << irq));
|
t = __raw_readl(base + AR71XX_RESET_REG_MISC_INT_STATUS);
|
||||||
|
__raw_writel(t & ~(1 << irq), base + AR71XX_RESET_REG_MISC_INT_STATUS);
|
||||||
|
|
||||||
/* flush write */
|
/* flush write */
|
||||||
ar71xx_reset_rr(AR71XX_RESET_REG_MISC_INT_STATUS);
|
(void) __raw_readl(base + AR71XX_RESET_REG_MISC_INT_STATUS);
|
||||||
}
|
}
|
||||||
|
|
||||||
static struct irq_chip ar71xx_misc_irq_chip = {
|
static struct irq_chip ar71xx_misc_irq_chip = {
|
||||||
@ -181,10 +203,11 @@ static struct irqaction ar71xx_misc_irqaction = {
|
|||||||
|
|
||||||
static void __init ar71xx_misc_irq_init(void)
|
static void __init ar71xx_misc_irq_init(void)
|
||||||
{
|
{
|
||||||
|
void __iomem *base = ar71xx_reset_base;
|
||||||
int i;
|
int i;
|
||||||
|
|
||||||
ar71xx_reset_wr(AR71XX_RESET_REG_MISC_INT_ENABLE, 0);
|
__raw_writel(0, base + AR71XX_RESET_REG_MISC_INT_ENABLE);
|
||||||
ar71xx_reset_wr(AR71XX_RESET_REG_MISC_INT_STATUS, 0);
|
__raw_writel(0, base + AR71XX_RESET_REG_MISC_INT_STATUS);
|
||||||
|
|
||||||
if (ar71xx_soc == AR71XX_SOC_AR7240)
|
if (ar71xx_soc == AR71XX_SOC_AR7240)
|
||||||
ar71xx_misc_irq_chip.ack = ar724x_misc_irq_ack;
|
ar71xx_misc_irq_chip.ack = ar724x_misc_irq_ack;
|
||||||
|
Loading…
Reference in New Issue
Block a user