|
@@ -14,6 +14,7 @@
|
|
|
#include <linux/clk.h>
|
|
|
#include <linux/gpio.h>
|
|
|
#include <linux/irqdomain.h>
|
|
|
+#include <linux/irqchip/chained_irq.h>
|
|
|
#include <linux/module.h>
|
|
|
#include <linux/of.h>
|
|
|
#include <linux/of_address.h>
|
|
@@ -665,6 +666,7 @@ static struct irq_chip sunxi_pinctrl_irq_chip = {
|
|
|
|
|
|
static void sunxi_pinctrl_irq_handler(unsigned irq, struct irq_desc *desc)
|
|
|
{
|
|
|
+ struct irq_chip *chip = irq_get_chip(irq);
|
|
|
struct sunxi_pinctrl *pctl = irq_get_handler_data(irq);
|
|
|
const unsigned long reg = readl(pctl->membase + IRQ_STATUS_REG);
|
|
|
|
|
@@ -674,10 +676,12 @@ static void sunxi_pinctrl_irq_handler(unsigned irq, struct irq_desc *desc)
|
|
|
if (reg) {
|
|
|
int irqoffset;
|
|
|
|
|
|
+ chained_irq_enter(chip, desc);
|
|
|
for_each_set_bit(irqoffset, ®, SUNXI_IRQ_NUMBER) {
|
|
|
int pin_irq = irq_find_mapping(pctl->domain, irqoffset);
|
|
|
generic_handle_irq(pin_irq);
|
|
|
}
|
|
|
+ chained_irq_exit(chip, desc);
|
|
|
}
|
|
|
}
|
|
|
|