|
@@ -424,6 +424,16 @@ out:
|
|
return IRQ_HANDLED;
|
|
return IRQ_HANDLED;
|
|
}
|
|
}
|
|
|
|
|
|
|
|
+static void gpio_keys_quiesce_key(void *data)
|
|
|
|
+{
|
|
|
|
+ struct gpio_button_data *bdata = data;
|
|
|
|
+
|
|
|
|
+ if (bdata->timer_debounce)
|
|
|
|
+ del_timer_sync(&bdata->timer);
|
|
|
|
+
|
|
|
|
+ cancel_work_sync(&bdata->work);
|
|
|
|
+}
|
|
|
|
+
|
|
static int gpio_keys_setup_key(struct platform_device *pdev,
|
|
static int gpio_keys_setup_key(struct platform_device *pdev,
|
|
struct input_dev *input,
|
|
struct input_dev *input,
|
|
struct gpio_button_data *bdata,
|
|
struct gpio_button_data *bdata,
|
|
@@ -433,7 +443,8 @@ static int gpio_keys_setup_key(struct platform_device *pdev,
|
|
struct device *dev = &pdev->dev;
|
|
struct device *dev = &pdev->dev;
|
|
irq_handler_t isr;
|
|
irq_handler_t isr;
|
|
unsigned long irqflags;
|
|
unsigned long irqflags;
|
|
- int irq, error;
|
|
|
|
|
|
+ int irq;
|
|
|
|
+ int error;
|
|
|
|
|
|
bdata->input = input;
|
|
bdata->input = input;
|
|
bdata->button = button;
|
|
bdata->button = button;
|
|
@@ -441,7 +452,8 @@ static int gpio_keys_setup_key(struct platform_device *pdev,
|
|
|
|
|
|
if (gpio_is_valid(button->gpio)) {
|
|
if (gpio_is_valid(button->gpio)) {
|
|
|
|
|
|
- error = gpio_request_one(button->gpio, GPIOF_IN, desc);
|
|
|
|
|
|
+ error = devm_gpio_request_one(&pdev->dev, button->gpio,
|
|
|
|
+ GPIOF_IN, desc);
|
|
if (error < 0) {
|
|
if (error < 0) {
|
|
dev_err(dev, "Failed to request GPIO %d, error %d\n",
|
|
dev_err(dev, "Failed to request GPIO %d, error %d\n",
|
|
button->gpio, error);
|
|
button->gpio, error);
|
|
@@ -463,7 +475,7 @@ static int gpio_keys_setup_key(struct platform_device *pdev,
|
|
dev_err(dev,
|
|
dev_err(dev,
|
|
"Unable to get irq number for GPIO %d, error %d\n",
|
|
"Unable to get irq number for GPIO %d, error %d\n",
|
|
button->gpio, error);
|
|
button->gpio, error);
|
|
- goto fail;
|
|
|
|
|
|
+ return error;
|
|
}
|
|
}
|
|
bdata->irq = irq;
|
|
bdata->irq = irq;
|
|
|
|
|
|
@@ -496,6 +508,18 @@ static int gpio_keys_setup_key(struct platform_device *pdev,
|
|
|
|
|
|
input_set_capability(input, button->type ?: EV_KEY, button->code);
|
|
input_set_capability(input, button->type ?: EV_KEY, button->code);
|
|
|
|
|
|
|
|
+ /*
|
|
|
|
+ * Install custom action to cancel debounce timer and
|
|
|
|
+ * workqueue item.
|
|
|
|
+ */
|
|
|
|
+ error = devm_add_action(&pdev->dev, gpio_keys_quiesce_key, bdata);
|
|
|
|
+ if (error) {
|
|
|
|
+ dev_err(&pdev->dev,
|
|
|
|
+ "failed to register quiesce action, error: %d\n",
|
|
|
|
+ error);
|
|
|
|
+ return error;
|
|
|
|
+ }
|
|
|
|
+
|
|
/*
|
|
/*
|
|
* If platform has specified that the button can be disabled,
|
|
* If platform has specified that the button can be disabled,
|
|
* we don't want it to share the interrupt line.
|
|
* we don't want it to share the interrupt line.
|
|
@@ -503,20 +527,15 @@ static int gpio_keys_setup_key(struct platform_device *pdev,
|
|
if (!button->can_disable)
|
|
if (!button->can_disable)
|
|
irqflags |= IRQF_SHARED;
|
|
irqflags |= IRQF_SHARED;
|
|
|
|
|
|
- error = request_any_context_irq(bdata->irq, isr, irqflags, desc, bdata);
|
|
|
|
|
|
+ error = devm_request_any_context_irq(&pdev->dev, bdata->irq,
|
|
|
|
+ isr, irqflags, desc, bdata);
|
|
if (error < 0) {
|
|
if (error < 0) {
|
|
dev_err(dev, "Unable to claim irq %d; error %d\n",
|
|
dev_err(dev, "Unable to claim irq %d; error %d\n",
|
|
bdata->irq, error);
|
|
bdata->irq, error);
|
|
- goto fail;
|
|
|
|
|
|
+ return error;
|
|
}
|
|
}
|
|
|
|
|
|
return 0;
|
|
return 0;
|
|
-
|
|
|
|
-fail:
|
|
|
|
- if (gpio_is_valid(button->gpio))
|
|
|
|
- gpio_free(button->gpio);
|
|
|
|
-
|
|
|
|
- return error;
|
|
|
|
}
|
|
}
|
|
|
|
|
|
static void gpio_keys_report_state(struct gpio_keys_drvdata *ddata)
|
|
static void gpio_keys_report_state(struct gpio_keys_drvdata *ddata)
|
|
@@ -662,16 +681,6 @@ gpio_keys_get_devtree_pdata(struct device *dev)
|
|
|
|
|
|
#endif
|
|
#endif
|
|
|
|
|
|
-static void gpio_remove_key(struct gpio_button_data *bdata)
|
|
|
|
-{
|
|
|
|
- free_irq(bdata->irq, bdata);
|
|
|
|
- if (bdata->timer_debounce)
|
|
|
|
- del_timer_sync(&bdata->timer);
|
|
|
|
- cancel_work_sync(&bdata->work);
|
|
|
|
- if (gpio_is_valid(bdata->button->gpio))
|
|
|
|
- gpio_free(bdata->button->gpio);
|
|
|
|
-}
|
|
|
|
-
|
|
|
|
static int gpio_keys_probe(struct platform_device *pdev)
|
|
static int gpio_keys_probe(struct platform_device *pdev)
|
|
{
|
|
{
|
|
struct device *dev = &pdev->dev;
|
|
struct device *dev = &pdev->dev;
|
|
@@ -730,7 +739,7 @@ static int gpio_keys_probe(struct platform_device *pdev)
|
|
|
|
|
|
error = gpio_keys_setup_key(pdev, input, bdata, button);
|
|
error = gpio_keys_setup_key(pdev, input, bdata, button);
|
|
if (error)
|
|
if (error)
|
|
- goto fail2;
|
|
|
|
|
|
+ return error;
|
|
|
|
|
|
if (button->wakeup)
|
|
if (button->wakeup)
|
|
wakeup = 1;
|
|
wakeup = 1;
|
|
@@ -740,41 +749,31 @@ static int gpio_keys_probe(struct platform_device *pdev)
|
|
if (error) {
|
|
if (error) {
|
|
dev_err(dev, "Unable to export keys/switches, error: %d\n",
|
|
dev_err(dev, "Unable to export keys/switches, error: %d\n",
|
|
error);
|
|
error);
|
|
- goto fail2;
|
|
|
|
|
|
+ return error;
|
|
}
|
|
}
|
|
|
|
|
|
error = input_register_device(input);
|
|
error = input_register_device(input);
|
|
if (error) {
|
|
if (error) {
|
|
dev_err(dev, "Unable to register input device, error: %d\n",
|
|
dev_err(dev, "Unable to register input device, error: %d\n",
|
|
error);
|
|
error);
|
|
- goto fail3;
|
|
|
|
|
|
+ goto err_remove_group;
|
|
}
|
|
}
|
|
|
|
|
|
device_init_wakeup(&pdev->dev, wakeup);
|
|
device_init_wakeup(&pdev->dev, wakeup);
|
|
|
|
|
|
return 0;
|
|
return 0;
|
|
|
|
|
|
- fail3:
|
|
|
|
|
|
+err_remove_group:
|
|
sysfs_remove_group(&pdev->dev.kobj, &gpio_keys_attr_group);
|
|
sysfs_remove_group(&pdev->dev.kobj, &gpio_keys_attr_group);
|
|
- fail2:
|
|
|
|
- while (--i >= 0)
|
|
|
|
- gpio_remove_key(&ddata->data[i]);
|
|
|
|
-
|
|
|
|
return error;
|
|
return error;
|
|
}
|
|
}
|
|
|
|
|
|
static int gpio_keys_remove(struct platform_device *pdev)
|
|
static int gpio_keys_remove(struct platform_device *pdev)
|
|
{
|
|
{
|
|
- struct gpio_keys_drvdata *ddata = platform_get_drvdata(pdev);
|
|
|
|
- int i;
|
|
|
|
-
|
|
|
|
sysfs_remove_group(&pdev->dev.kobj, &gpio_keys_attr_group);
|
|
sysfs_remove_group(&pdev->dev.kobj, &gpio_keys_attr_group);
|
|
|
|
|
|
device_init_wakeup(&pdev->dev, 0);
|
|
device_init_wakeup(&pdev->dev, 0);
|
|
|
|
|
|
- for (i = 0; i < ddata->pdata->nbuttons; i++)
|
|
|
|
- gpio_remove_key(&ddata->data[i]);
|
|
|
|
-
|
|
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
|