提交 b5a7c9a0 编写于 作者: L Linus Torvalds
...@@ -180,14 +180,9 @@ static struct completion irq_event; ...@@ -180,14 +180,9 @@ static struct completion irq_event;
static int twl4030_irq_thread(void *data) static int twl4030_irq_thread(void *data)
{ {
long irq = (long)data; long irq = (long)data;
struct irq_desc *desc = irq_to_desc(irq);
static unsigned i2c_errors; static unsigned i2c_errors;
static const unsigned max_i2c_errors = 100; static const unsigned max_i2c_errors = 100;
if (!desc) {
pr_err("twl4030: Invalid IRQ: %ld\n", irq);
return -EINVAL;
}
current->flags |= PF_NOFREEZE; current->flags |= PF_NOFREEZE;
...@@ -240,7 +235,7 @@ static int twl4030_irq_thread(void *data) ...@@ -240,7 +235,7 @@ static int twl4030_irq_thread(void *data)
} }
local_irq_enable(); local_irq_enable();
desc->chip->unmask(irq); enable_irq(irq);
} }
return 0; return 0;
...@@ -255,25 +250,13 @@ static int twl4030_irq_thread(void *data) ...@@ -255,25 +250,13 @@ static int twl4030_irq_thread(void *data)
* thread. All we do here is acknowledge and mask the interrupt and wakeup * thread. All we do here is acknowledge and mask the interrupt and wakeup
* the kernel thread. * the kernel thread.
*/ */
static void handle_twl4030_pih(unsigned int irq, struct irq_desc *desc) static irqreturn_t handle_twl4030_pih(int irq, void *devid)
{ {
/* Acknowledge, clear *AND* mask the interrupt... */ /* Acknowledge, clear *AND* mask the interrupt... */
desc->chip->ack(irq); disable_irq_nosync(irq);
complete(&irq_event); complete(devid);
} return IRQ_HANDLED;
static struct task_struct *start_twl4030_irq_thread(long irq)
{
struct task_struct *thread;
init_completion(&irq_event);
thread = kthread_run(twl4030_irq_thread, (void *)irq, "twl4030-irq");
if (!thread)
pr_err("twl4030: could not create irq %ld thread!\n", irq);
return thread;
} }
/*----------------------------------------------------------------------*/ /*----------------------------------------------------------------------*/
/* /*
...@@ -734,18 +717,28 @@ int twl_init_irq(int irq_num, unsigned irq_base, unsigned irq_end) ...@@ -734,18 +717,28 @@ int twl_init_irq(int irq_num, unsigned irq_base, unsigned irq_end)
} }
/* install an irq handler to demultiplex the TWL4030 interrupt */ /* install an irq handler to demultiplex the TWL4030 interrupt */
task = start_twl4030_irq_thread(irq_num);
if (!task) {
pr_err("twl4030: irq thread FAIL\n");
status = -ESRCH;
goto fail;
}
set_irq_data(irq_num, task);
set_irq_chained_handler(irq_num, handle_twl4030_pih);
return status; init_completion(&irq_event);
status = request_irq(irq_num, handle_twl4030_pih, IRQF_DISABLED,
"TWL4030-PIH", &irq_event);
if (status < 0) {
pr_err("twl4030: could not claim irq%d: %d\n", irq_num, status);
goto fail_rqirq;
}
task = kthread_run(twl4030_irq_thread, (void *)irq_num, "twl4030-irq");
if (IS_ERR(task)) {
pr_err("twl4030: could not create irq %d thread!\n", irq_num);
status = PTR_ERR(task);
goto fail_kthread;
}
return status;
fail_kthread:
free_irq(irq_num, &irq_event);
fail_rqirq:
/* clean up twl4030_sih_setup */
fail: fail:
for (i = irq_base; i < irq_end; i++) for (i = irq_base; i < irq_end; i++)
set_irq_chip_and_handler(i, NULL, NULL); set_irq_chip_and_handler(i, NULL, NULL);
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册