mirror of
https://github.com/rd-stuffs/msm-4.14.git
synced 2025-02-20 11:45:48 +08:00
gpio/langwell: Simplify demux loop
Use __ffs() to find the pending interrupt source instead of looping 32 times. Signed-off-by: Thomas Gleixner <tglx@linutronix.de> Cc: Feng Tang <feng.tang@intel.com> Cc: Alek Du <alek.du@intel.com> Cc: Alan Cox <alan@lxorguk.ukuu.org.uk> Signed-off-by: Grant Likely <grant.likely@secretlab.ca>
This commit is contained in:
parent
674db90690
commit
732063b92b
@ -191,19 +191,20 @@ static void lnw_irq_handler(unsigned irq, struct irq_desc *desc)
|
|||||||
struct lnw_gpio *lnw = irq_data_get_irq_handler_data(data);
|
struct lnw_gpio *lnw = irq_data_get_irq_handler_data(data);
|
||||||
struct irq_chip *chip = irq_data_get_irq_chip(data);
|
struct irq_chip *chip = irq_data_get_irq_chip(data);
|
||||||
u32 base, gpio, gedr_v;
|
u32 base, gpio, gedr_v;
|
||||||
|
unsigned long pending;
|
||||||
void __iomem *gedr;
|
void __iomem *gedr;
|
||||||
|
|
||||||
/* check GPIO controller to check which pin triggered the interrupt */
|
/* check GPIO controller to check which pin triggered the interrupt */
|
||||||
for (base = 0; base < lnw->chip.ngpio; base += 32) {
|
for (base = 0; base < lnw->chip.ngpio; base += 32) {
|
||||||
gedr = gpio_reg(&lnw->chip, base, GEDR);
|
gedr = gpio_reg(&lnw->chip, base, GEDR);
|
||||||
gedr_v = readl(gedr);
|
gedr_v = pending = readl(gedr);
|
||||||
if (!gedr_v)
|
if (!gedr_v)
|
||||||
continue;
|
continue;
|
||||||
for (gpio = base; gpio < base + 32; gpio++)
|
while (pending) {
|
||||||
if (gedr_v & BIT(gpio % 32)) {
|
gpio = __ffs(pending) - 1;
|
||||||
pr_debug("pin %d triggered\n", gpio);
|
pending &= ~BIT(gpio);
|
||||||
generic_handle_irq(lnw->irq_base + gpio);
|
generic_handle_irq(lnw->irq_base + base + gpio);
|
||||||
}
|
}
|
||||||
/* clear the edge detect status bit */
|
/* clear the edge detect status bit */
|
||||||
writel(gedr_v, gedr);
|
writel(gedr_v, gedr);
|
||||||
}
|
}
|
||||||
|
Loading…
x
Reference in New Issue
Block a user