提交 c1e61bcf 编写于 作者: N NeilBrown 提交者: Samuel Ortiz

mfd: Use request_threaded_irq for twl4030-irq instead of irq_set_chained_handler

irq_set_chained_handler sets 'desc->handle_irq'.
However this irq is called by handle_nested_irq from handle_twl4030_pih,
and that uses action->thread_fn.

So the handled set with irq_set_chained_handler is never called.

So change to use request_threaded_irq instead - that sets the correct field.

Tested on GTA04 Phoenux.
Signed-off-by: NNeilBrown <neilb@suse.de>
Tested-by: NFelipe Contreras <felipe.contreras@gmail.com>
Signed-off-by: NSamuel Ortiz <sameo@linux.intel.com>
上级 286f8f3c
...@@ -432,6 +432,7 @@ struct sih_agent { ...@@ -432,6 +432,7 @@ struct sih_agent {
u32 edge_change; u32 edge_change;
struct mutex irq_lock; struct mutex irq_lock;
char *irq_name;
}; };
/*----------------------------------------------------------------------*/ /*----------------------------------------------------------------------*/
...@@ -589,7 +590,7 @@ static inline int sih_read_isr(const struct sih *sih) ...@@ -589,7 +590,7 @@ static inline int sih_read_isr(const struct sih *sih)
* Generic handler for SIH interrupts ... we "know" this is called * Generic handler for SIH interrupts ... we "know" this is called
* in task context, with IRQs enabled. * in task context, with IRQs enabled.
*/ */
static void handle_twl4030_sih(unsigned irq, struct irq_desc *desc) static irqreturn_t handle_twl4030_sih(int irq, void *data)
{ {
struct sih_agent *agent = irq_get_handler_data(irq); struct sih_agent *agent = irq_get_handler_data(irq);
const struct sih *sih = agent->sih; const struct sih *sih = agent->sih;
...@@ -602,7 +603,7 @@ static void handle_twl4030_sih(unsigned irq, struct irq_desc *desc) ...@@ -602,7 +603,7 @@ static void handle_twl4030_sih(unsigned irq, struct irq_desc *desc)
pr_err("twl4030: %s SIH, read ISR error %d\n", pr_err("twl4030: %s SIH, read ISR error %d\n",
sih->name, isr); sih->name, isr);
/* REVISIT: recover; eventually mask it all, etc */ /* REVISIT: recover; eventually mask it all, etc */
return; return IRQ_HANDLED;
} }
while (isr) { while (isr) {
...@@ -616,6 +617,7 @@ static void handle_twl4030_sih(unsigned irq, struct irq_desc *desc) ...@@ -616,6 +617,7 @@ static void handle_twl4030_sih(unsigned irq, struct irq_desc *desc)
pr_err("twl4030: %s SIH, invalid ISR bit %d\n", pr_err("twl4030: %s SIH, invalid ISR bit %d\n",
sih->name, irq); sih->name, irq);
} }
return IRQ_HANDLED;
} }
static unsigned twl4030_irq_next; static unsigned twl4030_irq_next;
...@@ -668,18 +670,19 @@ int twl4030_sih_setup(int module) ...@@ -668,18 +670,19 @@ int twl4030_sih_setup(int module)
activate_irq(irq); activate_irq(irq);
} }
status = irq_base;
twl4030_irq_next += i; twl4030_irq_next += i;
/* replace generic PIH handler (handle_simple_irq) */ /* replace generic PIH handler (handle_simple_irq) */
irq = sih_mod + twl4030_irq_base; irq = sih_mod + twl4030_irq_base;
irq_set_handler_data(irq, agent); irq_set_handler_data(irq, agent);
irq_set_chained_handler(irq, handle_twl4030_sih); agent->irq_name = kasprintf(GFP_KERNEL, "twl4030_%s", sih->name);
status = request_threaded_irq(irq, NULL, handle_twl4030_sih, 0,
agent->irq_name ?: sih->name, NULL);
pr_info("twl4030: %s (irq %d) chaining IRQs %d..%d\n", sih->name, pr_info("twl4030: %s (irq %d) chaining IRQs %d..%d\n", sih->name,
irq, irq_base, twl4030_irq_next - 1); irq, irq_base, twl4030_irq_next - 1);
return status; return status < 0 ? status : irq_base;
} }
/* FIXME need a call to reverse twl4030_sih_setup() ... */ /* FIXME need a call to reverse twl4030_sih_setup() ... */
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册