|
@@ -199,52 +199,32 @@ static void _set_gpio_debounce(struct gpio_bank *bank, unsigned gpio,
|
|
__raw_writel(val, reg);
|
|
__raw_writel(val, reg);
|
|
}
|
|
}
|
|
|
|
|
|
-#ifdef CONFIG_ARCH_OMAP2PLUS
|
|
|
|
-static inline void set_24xx_gpio_triggering(struct gpio_bank *bank, int gpio,
|
|
|
|
|
|
+static inline void set_gpio_trigger(struct gpio_bank *bank, int gpio,
|
|
int trigger)
|
|
int trigger)
|
|
{
|
|
{
|
|
void __iomem *base = bank->base;
|
|
void __iomem *base = bank->base;
|
|
u32 gpio_bit = 1 << gpio;
|
|
u32 gpio_bit = 1 << gpio;
|
|
|
|
|
|
- if (cpu_is_omap44xx()) {
|
|
|
|
- _gpio_rmw(base, OMAP4_GPIO_LEVELDETECT0, gpio_bit,
|
|
|
|
- trigger & IRQ_TYPE_LEVEL_LOW);
|
|
|
|
- _gpio_rmw(base, OMAP4_GPIO_LEVELDETECT1, gpio_bit,
|
|
|
|
- trigger & IRQ_TYPE_LEVEL_HIGH);
|
|
|
|
- _gpio_rmw(base, OMAP4_GPIO_RISINGDETECT, gpio_bit,
|
|
|
|
- trigger & IRQ_TYPE_EDGE_RISING);
|
|
|
|
- _gpio_rmw(base, OMAP4_GPIO_FALLINGDETECT, gpio_bit,
|
|
|
|
- trigger & IRQ_TYPE_EDGE_FALLING);
|
|
|
|
- } else {
|
|
|
|
- _gpio_rmw(base, OMAP24XX_GPIO_LEVELDETECT0, gpio_bit,
|
|
|
|
- trigger & IRQ_TYPE_LEVEL_LOW);
|
|
|
|
- _gpio_rmw(base, OMAP24XX_GPIO_LEVELDETECT1, gpio_bit,
|
|
|
|
- trigger & IRQ_TYPE_LEVEL_HIGH);
|
|
|
|
- _gpio_rmw(base, OMAP24XX_GPIO_RISINGDETECT, gpio_bit,
|
|
|
|
- trigger & IRQ_TYPE_EDGE_RISING);
|
|
|
|
- _gpio_rmw(base, OMAP24XX_GPIO_FALLINGDETECT, gpio_bit,
|
|
|
|
- trigger & IRQ_TYPE_EDGE_FALLING);
|
|
|
|
- }
|
|
|
|
- if (likely(!(bank->non_wakeup_gpios & gpio_bit))) {
|
|
|
|
- if (cpu_is_omap44xx()) {
|
|
|
|
- _gpio_rmw(base, OMAP4_GPIO_IRQWAKEN0, gpio_bit,
|
|
|
|
- trigger != 0);
|
|
|
|
- } else {
|
|
|
|
- /*
|
|
|
|
- * GPIO wakeup request can only be generated on edge
|
|
|
|
- * transitions
|
|
|
|
- */
|
|
|
|
- if (trigger & IRQ_TYPE_EDGE_BOTH)
|
|
|
|
- __raw_writel(1 << gpio, bank->base
|
|
|
|
- + OMAP24XX_GPIO_SETWKUENA);
|
|
|
|
- else
|
|
|
|
- __raw_writel(1 << gpio, bank->base
|
|
|
|
- + OMAP24XX_GPIO_CLEARWKUENA);
|
|
|
|
- }
|
|
|
|
- }
|
|
|
|
|
|
+ _gpio_rmw(base, bank->regs->leveldetect0, gpio_bit,
|
|
|
|
+ trigger & IRQ_TYPE_LEVEL_LOW);
|
|
|
|
+ _gpio_rmw(base, bank->regs->leveldetect1, gpio_bit,
|
|
|
|
+ trigger & IRQ_TYPE_LEVEL_HIGH);
|
|
|
|
+ _gpio_rmw(base, bank->regs->risingdetect, gpio_bit,
|
|
|
|
+ trigger & IRQ_TYPE_EDGE_RISING);
|
|
|
|
+ _gpio_rmw(base, bank->regs->fallingdetect, gpio_bit,
|
|
|
|
+ trigger & IRQ_TYPE_EDGE_FALLING);
|
|
|
|
+
|
|
|
|
+ if (likely(!(bank->non_wakeup_gpios & gpio_bit)))
|
|
|
|
+ _gpio_rmw(base, bank->regs->wkup_en, gpio_bit, trigger != 0);
|
|
|
|
+
|
|
/* This part needs to be executed always for OMAP{34xx, 44xx} */
|
|
/* This part needs to be executed always for OMAP{34xx, 44xx} */
|
|
- if (cpu_is_omap34xx() || cpu_is_omap44xx() ||
|
|
|
|
- (bank->non_wakeup_gpios & gpio_bit)) {
|
|
|
|
|
|
+ if (!bank->regs->irqctrl) {
|
|
|
|
+ /* On omap24xx proceed only when valid GPIO bit is set */
|
|
|
|
+ if (bank->non_wakeup_gpios) {
|
|
|
|
+ if (!(bank->non_wakeup_gpios & gpio_bit))
|
|
|
|
+ goto exit;
|
|
|
|
+ }
|
|
|
|
+
|
|
/*
|
|
/*
|
|
* Log the edge gpio and manually trigger the IRQ
|
|
* Log the edge gpio and manually trigger the IRQ
|
|
* after resume if the input level changes
|
|
* after resume if the input level changes
|
|
@@ -257,11 +237,11 @@ static inline void set_24xx_gpio_triggering(struct gpio_bank *bank, int gpio,
|
|
bank->enabled_non_wakeup_gpios &= ~gpio_bit;
|
|
bank->enabled_non_wakeup_gpios &= ~gpio_bit;
|
|
}
|
|
}
|
|
|
|
|
|
|
|
+exit:
|
|
bank->level_mask =
|
|
bank->level_mask =
|
|
__raw_readl(bank->base + bank->regs->leveldetect0) |
|
|
__raw_readl(bank->base + bank->regs->leveldetect0) |
|
|
__raw_readl(bank->base + bank->regs->leveldetect1);
|
|
__raw_readl(bank->base + bank->regs->leveldetect1);
|
|
}
|
|
}
|
|
-#endif
|
|
|
|
|
|
|
|
#ifdef CONFIG_ARCH_OMAP1
|
|
#ifdef CONFIG_ARCH_OMAP1
|
|
/*
|
|
/*
|
|
@@ -273,23 +253,10 @@ static void _toggle_gpio_edge_triggering(struct gpio_bank *bank, int gpio)
|
|
void __iomem *reg = bank->base;
|
|
void __iomem *reg = bank->base;
|
|
u32 l = 0;
|
|
u32 l = 0;
|
|
|
|
|
|
- switch (bank->method) {
|
|
|
|
- case METHOD_MPUIO:
|
|
|
|
- reg += OMAP_MPUIO_GPIO_INT_EDGE / bank->stride;
|
|
|
|
- break;
|
|
|
|
-#ifdef CONFIG_ARCH_OMAP15XX
|
|
|
|
- case METHOD_GPIO_1510:
|
|
|
|
- reg += OMAP1510_GPIO_INT_CONTROL;
|
|
|
|
- break;
|
|
|
|
-#endif
|
|
|
|
-#if defined(CONFIG_ARCH_OMAP730) || defined(CONFIG_ARCH_OMAP850)
|
|
|
|
- case METHOD_GPIO_7XX:
|
|
|
|
- reg += OMAP7XX_GPIO_INT_CONTROL;
|
|
|
|
- break;
|
|
|
|
-#endif
|
|
|
|
- default:
|
|
|
|
|
|
+ if (!bank->regs->irqctrl)
|
|
return;
|
|
return;
|
|
- }
|
|
|
|
|
|
+
|
|
|
|
+ reg += bank->regs->irqctrl;
|
|
|
|
|
|
l = __raw_readl(reg);
|
|
l = __raw_readl(reg);
|
|
if ((l >> gpio) & 1)
|
|
if ((l >> gpio) & 1)
|
|
@@ -299,31 +266,21 @@ static void _toggle_gpio_edge_triggering(struct gpio_bank *bank, int gpio)
|
|
|
|
|
|
__raw_writel(l, reg);
|
|
__raw_writel(l, reg);
|
|
}
|
|
}
|
|
|
|
+#else
|
|
|
|
+static void _toggle_gpio_edge_triggering(struct gpio_bank *bank, int gpio) {}
|
|
#endif
|
|
#endif
|
|
|
|
|
|
static int _set_gpio_triggering(struct gpio_bank *bank, int gpio, int trigger)
|
|
static int _set_gpio_triggering(struct gpio_bank *bank, int gpio, int trigger)
|
|
{
|
|
{
|
|
void __iomem *reg = bank->base;
|
|
void __iomem *reg = bank->base;
|
|
|
|
+ void __iomem *base = bank->base;
|
|
u32 l = 0;
|
|
u32 l = 0;
|
|
|
|
|
|
- switch (bank->method) {
|
|
|
|
-#ifdef CONFIG_ARCH_OMAP1
|
|
|
|
- case METHOD_MPUIO:
|
|
|
|
- reg += OMAP_MPUIO_GPIO_INT_EDGE / bank->stride;
|
|
|
|
- l = __raw_readl(reg);
|
|
|
|
- if ((trigger & IRQ_TYPE_SENSE_MASK) == IRQ_TYPE_EDGE_BOTH)
|
|
|
|
- bank->toggle_mask |= 1 << gpio;
|
|
|
|
- if (trigger & IRQ_TYPE_EDGE_RISING)
|
|
|
|
- l |= 1 << gpio;
|
|
|
|
- else if (trigger & IRQ_TYPE_EDGE_FALLING)
|
|
|
|
- l &= ~(1 << gpio);
|
|
|
|
- else
|
|
|
|
- goto bad;
|
|
|
|
- break;
|
|
|
|
-#endif
|
|
|
|
-#ifdef CONFIG_ARCH_OMAP15XX
|
|
|
|
- case METHOD_GPIO_1510:
|
|
|
|
- reg += OMAP1510_GPIO_INT_CONTROL;
|
|
|
|
|
|
+ if (bank->regs->leveldetect0 && bank->regs->wkup_en) {
|
|
|
|
+ set_gpio_trigger(bank, gpio, trigger);
|
|
|
|
+ } else if (bank->regs->irqctrl) {
|
|
|
|
+ reg += bank->regs->irqctrl;
|
|
|
|
+
|
|
l = __raw_readl(reg);
|
|
l = __raw_readl(reg);
|
|
if ((trigger & IRQ_TYPE_SENSE_MASK) == IRQ_TYPE_EDGE_BOTH)
|
|
if ((trigger & IRQ_TYPE_SENSE_MASK) == IRQ_TYPE_EDGE_BOTH)
|
|
bank->toggle_mask |= 1 << gpio;
|
|
bank->toggle_mask |= 1 << gpio;
|
|
@@ -332,15 +289,15 @@ static int _set_gpio_triggering(struct gpio_bank *bank, int gpio, int trigger)
|
|
else if (trigger & IRQ_TYPE_EDGE_FALLING)
|
|
else if (trigger & IRQ_TYPE_EDGE_FALLING)
|
|
l &= ~(1 << gpio);
|
|
l &= ~(1 << gpio);
|
|
else
|
|
else
|
|
- goto bad;
|
|
|
|
- break;
|
|
|
|
-#endif
|
|
|
|
-#ifdef CONFIG_ARCH_OMAP16XX
|
|
|
|
- case METHOD_GPIO_1610:
|
|
|
|
|
|
+ return -EINVAL;
|
|
|
|
+
|
|
|
|
+ __raw_writel(l, reg);
|
|
|
|
+ } else if (bank->regs->edgectrl1) {
|
|
if (gpio & 0x08)
|
|
if (gpio & 0x08)
|
|
- reg += OMAP1610_GPIO_EDGE_CTRL2;
|
|
|
|
|
|
+ reg += bank->regs->edgectrl2;
|
|
else
|
|
else
|
|
- reg += OMAP1610_GPIO_EDGE_CTRL1;
|
|
|
|
|
|
+ reg += bank->regs->edgectrl1;
|
|
|
|
+
|
|
gpio &= 0x07;
|
|
gpio &= 0x07;
|
|
l = __raw_readl(reg);
|
|
l = __raw_readl(reg);
|
|
l &= ~(3 << (gpio << 1));
|
|
l &= ~(3 << (gpio << 1));
|
|
@@ -348,40 +305,12 @@ static int _set_gpio_triggering(struct gpio_bank *bank, int gpio, int trigger)
|
|
l |= 2 << (gpio << 1);
|
|
l |= 2 << (gpio << 1);
|
|
if (trigger & IRQ_TYPE_EDGE_FALLING)
|
|
if (trigger & IRQ_TYPE_EDGE_FALLING)
|
|
l |= 1 << (gpio << 1);
|
|
l |= 1 << (gpio << 1);
|
|
- if (trigger)
|
|
|
|
- /* Enable wake-up during idle for dynamic tick */
|
|
|
|
- __raw_writel(1 << gpio, bank->base + OMAP1610_GPIO_SET_WAKEUPENA);
|
|
|
|
- else
|
|
|
|
- __raw_writel(1 << gpio, bank->base + OMAP1610_GPIO_CLEAR_WAKEUPENA);
|
|
|
|
- break;
|
|
|
|
-#endif
|
|
|
|
-#if defined(CONFIG_ARCH_OMAP730) || defined(CONFIG_ARCH_OMAP850)
|
|
|
|
- case METHOD_GPIO_7XX:
|
|
|
|
- reg += OMAP7XX_GPIO_INT_CONTROL;
|
|
|
|
- l = __raw_readl(reg);
|
|
|
|
- if ((trigger & IRQ_TYPE_SENSE_MASK) == IRQ_TYPE_EDGE_BOTH)
|
|
|
|
- bank->toggle_mask |= 1 << gpio;
|
|
|
|
- if (trigger & IRQ_TYPE_EDGE_RISING)
|
|
|
|
- l |= 1 << gpio;
|
|
|
|
- else if (trigger & IRQ_TYPE_EDGE_FALLING)
|
|
|
|
- l &= ~(1 << gpio);
|
|
|
|
- else
|
|
|
|
- goto bad;
|
|
|
|
- break;
|
|
|
|
-#endif
|
|
|
|
-#ifdef CONFIG_ARCH_OMAP2PLUS
|
|
|
|
- case METHOD_GPIO_24XX:
|
|
|
|
- case METHOD_GPIO_44XX:
|
|
|
|
- set_24xx_gpio_triggering(bank, gpio, trigger);
|
|
|
|
- return 0;
|
|
|
|
-#endif
|
|
|
|
- default:
|
|
|
|
- goto bad;
|
|
|
|
|
|
+
|
|
|
|
+ /* Enable wake-up during idle for dynamic tick */
|
|
|
|
+ _gpio_rmw(base, bank->regs->wkup_en, 1 << gpio, trigger);
|
|
|
|
+ __raw_writel(l, reg);
|
|
}
|
|
}
|
|
- __raw_writel(l, reg);
|
|
|
|
return 0;
|
|
return 0;
|
|
-bad:
|
|
|
|
- return -EINVAL;
|
|
|
|
}
|
|
}
|
|
|
|
|
|
static int gpio_irq_type(struct irq_data *d, unsigned type)
|
|
static int gpio_irq_type(struct irq_data *d, unsigned type)
|