From: Jonas Aaberg <jonas.ab...@stericsson.com>

Disable hardware if active when suspending if the hw can not
wake the system from suspend.

Cc: Dmitry Torokhov <dmitry.torok...@gmail.com>
Cc: linux-in...@vger.kernel.org
Signed-off-by: Lee Jones <lee.jo...@linaro.org>
Signed-off-by: Jonas Aaberg <jonas.ab...@stericsson.com>
Signed-off-by: Philippe Langlais <philippe.langl...@linaro.org>
Reviewed-by: Bengt Jonsson <bengt.g.jons...@stericsson.com>
---
 drivers/input/keyboard/gpio_keys.c |   15 +++++++++++++++
 1 file changed, 15 insertions(+)

diff --git a/drivers/input/keyboard/gpio_keys.c 
b/drivers/input/keyboard/gpio_keys.c
index 6a68041..2cf6757 100644
--- a/drivers/input/keyboard/gpio_keys.c
+++ b/drivers/input/keyboard/gpio_keys.c
@@ -46,6 +46,8 @@ struct gpio_keys_drvdata {
        const struct gpio_keys_platform_data *pdata;
        struct input_dev *input;
        struct mutex disable_lock;
+       bool enabled;
+       bool enable_after_suspend;
        struct gpio_button_data data[0];
 };
 
@@ -531,6 +533,8 @@ static int gpio_keys_open(struct input_dev *input)
        struct gpio_keys_drvdata *ddata = input_get_drvdata(input);
        const struct gpio_keys_platform_data *pdata = ddata->pdata;
 
+       ddata->enabled = true;
+
        return pdata->enable ? pdata->enable(input->dev.parent) : 0;
 }
 
@@ -539,6 +543,8 @@ static void gpio_keys_close(struct input_dev *input)
        struct gpio_keys_drvdata *ddata = input_get_drvdata(input);
        const struct gpio_keys_platform_data *pdata = ddata->pdata;
 
+       ddata->enabled = false;
+
        if (pdata->disable)
                pdata->disable(input->dev.parent);
 }
@@ -685,6 +691,7 @@ static int __devinit gpio_keys_probe(struct platform_device 
*pdev)
 
        ddata->pdata = pdata;
        ddata->input = input;
+       ddata->enabled = false;
        mutex_init(&ddata->disable_lock);
 
        platform_set_drvdata(pdev, ddata);
@@ -796,6 +803,10 @@ static int gpio_keys_suspend(struct device *dev)
                        if (bdata->button->wakeup)
                                enable_irq_wake(bdata->irq);
                }
+       } else {
+               ddata->enable_after_suspend = ddata->enabled;
+               if (ddata->enabled)
+                       gpio_keys_close(ddata->input);
        }
 
        return 0;
@@ -814,6 +825,10 @@ static int gpio_keys_resume(struct device *dev)
                if (gpio_is_valid(bdata->button->gpio))
                        gpio_keys_gpio_report_event(bdata);
        }
+
+       if (!device_may_wakeup(dev) && ddata->enable_after_suspend)
+               gpio_keys_open(ddata->input);
+
        input_sync(ddata->input);
 
        return 0;
-- 
1.7.9.5

--
To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html
Please read the FAQ at  http://www.tux.org/lkml/

Reply via email to