Input: gpio-keys - change timer to workqueue
The gpio_get_value function of I2C/SPI GPIO expander may sleep thus this function call can not be called in a timer function. Signed-off-by: Alek Du <alek.du@intel.com> Signed-off-by: Dmitry Torokhov <dtor@mail.ru>
This commit is contained in:
parent
c57c0a2a0d
commit
0b346838c5
@ -22,13 +22,14 @@
|
|||||||
#include <linux/platform_device.h>
|
#include <linux/platform_device.h>
|
||||||
#include <linux/input.h>
|
#include <linux/input.h>
|
||||||
#include <linux/gpio_keys.h>
|
#include <linux/gpio_keys.h>
|
||||||
|
#include <linux/workqueue.h>
|
||||||
|
|
||||||
#include <asm/gpio.h>
|
#include <asm/gpio.h>
|
||||||
|
|
||||||
struct gpio_button_data {
|
struct gpio_button_data {
|
||||||
struct gpio_keys_button *button;
|
struct gpio_keys_button *button;
|
||||||
struct input_dev *input;
|
struct input_dev *input;
|
||||||
struct timer_list timer;
|
struct delayed_work work;
|
||||||
};
|
};
|
||||||
|
|
||||||
struct gpio_keys_drvdata {
|
struct gpio_keys_drvdata {
|
||||||
@ -36,8 +37,10 @@ struct gpio_keys_drvdata {
|
|||||||
struct gpio_button_data data[0];
|
struct gpio_button_data data[0];
|
||||||
};
|
};
|
||||||
|
|
||||||
static void gpio_keys_report_event(struct gpio_button_data *bdata)
|
static void gpio_keys_report_event(struct work_struct *work)
|
||||||
{
|
{
|
||||||
|
struct gpio_button_data *bdata =
|
||||||
|
container_of(work, struct gpio_button_data, work.work);
|
||||||
struct gpio_keys_button *button = bdata->button;
|
struct gpio_keys_button *button = bdata->button;
|
||||||
struct input_dev *input = bdata->input;
|
struct input_dev *input = bdata->input;
|
||||||
unsigned int type = button->type ?: EV_KEY;
|
unsigned int type = button->type ?: EV_KEY;
|
||||||
@ -47,25 +50,17 @@ static void gpio_keys_report_event(struct gpio_button_data *bdata)
|
|||||||
input_sync(input);
|
input_sync(input);
|
||||||
}
|
}
|
||||||
|
|
||||||
static void gpio_check_button(unsigned long _data)
|
|
||||||
{
|
|
||||||
struct gpio_button_data *data = (struct gpio_button_data *)_data;
|
|
||||||
|
|
||||||
gpio_keys_report_event(data);
|
|
||||||
}
|
|
||||||
|
|
||||||
static irqreturn_t gpio_keys_isr(int irq, void *dev_id)
|
static irqreturn_t gpio_keys_isr(int irq, void *dev_id)
|
||||||
{
|
{
|
||||||
struct gpio_button_data *bdata = dev_id;
|
struct gpio_button_data *bdata = dev_id;
|
||||||
struct gpio_keys_button *button = bdata->button;
|
struct gpio_keys_button *button = bdata->button;
|
||||||
|
unsigned long delay;
|
||||||
|
|
||||||
BUG_ON(irq != gpio_to_irq(button->gpio));
|
BUG_ON(irq != gpio_to_irq(button->gpio));
|
||||||
|
|
||||||
if (button->debounce_interval)
|
delay = button->debounce_interval ?
|
||||||
mod_timer(&bdata->timer,
|
msecs_to_jiffies(button->debounce_interval) : 0;
|
||||||
jiffies + msecs_to_jiffies(button->debounce_interval));
|
schedule_delayed_work(&bdata->work, delay);
|
||||||
else
|
|
||||||
gpio_keys_report_event(bdata);
|
|
||||||
|
|
||||||
return IRQ_HANDLED;
|
return IRQ_HANDLED;
|
||||||
}
|
}
|
||||||
@ -112,8 +107,7 @@ static int __devinit gpio_keys_probe(struct platform_device *pdev)
|
|||||||
|
|
||||||
bdata->input = input;
|
bdata->input = input;
|
||||||
bdata->button = button;
|
bdata->button = button;
|
||||||
setup_timer(&bdata->timer,
|
INIT_DELAYED_WORK(&bdata->work, gpio_keys_report_event);
|
||||||
gpio_check_button, (unsigned long)bdata);
|
|
||||||
|
|
||||||
error = gpio_request(button->gpio, button->desc ?: "gpio_keys");
|
error = gpio_request(button->gpio, button->desc ?: "gpio_keys");
|
||||||
if (error < 0) {
|
if (error < 0) {
|
||||||
@ -172,8 +166,7 @@ static int __devinit gpio_keys_probe(struct platform_device *pdev)
|
|||||||
fail2:
|
fail2:
|
||||||
while (--i >= 0) {
|
while (--i >= 0) {
|
||||||
free_irq(gpio_to_irq(pdata->buttons[i].gpio), &ddata->data[i]);
|
free_irq(gpio_to_irq(pdata->buttons[i].gpio), &ddata->data[i]);
|
||||||
if (pdata->buttons[i].debounce_interval)
|
cancel_delayed_work_sync(&ddata->data[i].work);
|
||||||
del_timer_sync(&ddata->data[i].timer);
|
|
||||||
gpio_free(pdata->buttons[i].gpio);
|
gpio_free(pdata->buttons[i].gpio);
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -197,8 +190,7 @@ static int __devexit gpio_keys_remove(struct platform_device *pdev)
|
|||||||
for (i = 0; i < pdata->nbuttons; i++) {
|
for (i = 0; i < pdata->nbuttons; i++) {
|
||||||
int irq = gpio_to_irq(pdata->buttons[i].gpio);
|
int irq = gpio_to_irq(pdata->buttons[i].gpio);
|
||||||
free_irq(irq, &ddata->data[i]);
|
free_irq(irq, &ddata->data[i]);
|
||||||
if (pdata->buttons[i].debounce_interval)
|
cancel_delayed_work_sync(&ddata->data[i].work);
|
||||||
del_timer_sync(&ddata->data[i].timer);
|
|
||||||
gpio_free(pdata->buttons[i].gpio);
|
gpio_free(pdata->buttons[i].gpio);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user