[PATCH][resend] Add suspend and resume to gpio_keys driver

[Anti Sullin]

This patch adds suspend/resume support and enables wakeup from gpio_keys 
buttons. Buttons, that generate wakeup events, can be specified in 
platform data.

Signed-off-by: Anti Sullin <anti.sullin@xxxxxxxxxxxxxx>

diff -pur linux-2.6.23-rc5-clean/drivers/input/keyboard/gpio_keys.c 
linux-2.6.23-rc5/drivers/input/keyboard/gpio_keys.c
--- linux-2.6.23-rc5-clean/drivers/input/keyboard/gpio_keys.c    
2007-09-10 09:52:18.000000000 +0300
+++ linux-2.6.23-rc5/drivers/input/keyboard/gpio_keys.c    2007-09-10 
10:01:56.000000000 +0300
@@ -54,6 +54,7 @@ static int __devinit gpio_keys_probe(str
    struct gpio_keys_platform_data *pdata = pdev->dev.platform_data;
    struct input_dev *input;
    int i, error;
+    int wakeup = 0;

    input = input_allocate_device();
    if (!input)
@@ -87,6 +88,9 @@ static int __devinit gpio_keys_probe(str
            goto fail;
        }

+        if (button->wakeup)
+            wakeup = 1;
+       
        input_set_capability(input, type, button->code);
    }

@@ -96,6 +100,8 @@ static int __devinit gpio_keys_probe(str
        goto fail;
    }

+    device_init_wakeup(&pdev->dev, wakeup);
+   
    return 0;

 fail:
@@ -118,14 +124,52 @@ static int __devexit gpio_keys_remove(st
        free_irq(irq, pdev);
    }

+    device_init_wakeup(&pdev->dev, 0);
    input_unregister_device(input);

    return 0;
}

+
+#ifdef CONFIG_PM
+static int gpio_keys_suspend(struct platform_device *pdev, pm_message_t 
state)
+{
+    struct gpio_keys_platform_data *pdata = pdev->dev.platform_data;
+    int i;
+
+    if (device_may_wakeup(&pdev->dev)) {
+        for (i = 0; i < pdata->nbuttons; i++) {
+            int irq = gpio_to_irq(pdata->buttons[i].gpio);
+            if (pdata->buttons[i].wakeup)
+                enable_irq_wake(irq);
+        }
+    }
+
+    return 0;
+}
+
+static int gpio_keys_resume(struct platform_device *pdev)
+{
+    struct gpio_keys_platform_data *pdata = pdev->dev.platform_data;
+    int i;
+
+    for (i = 0; i < pdata->nbuttons; i++) {
+        int irq = gpio_to_irq(pdata->buttons[i].gpio);
+        disable_irq_wake(irq);
+    }
+
+    return 0;
+}
+#else
+#define gpio_keys_suspend    NULL
+#define gpio_keys_resume    NULL
+#endif
+
struct platform_driver gpio_keys_device_driver = {
    .probe        = gpio_keys_probe,
    .remove        = __devexit_p(gpio_keys_remove),
+    .suspend    = gpio_keys_suspend,
+    .resume        = gpio_keys_resume,   
    .driver        = {
        .name    = "gpio-keys",
    }
diff -pur linux-2.6.23-rc5-clean/include/linux/gpio_keys.h 
linux-2.6.23-rc5/include/linux/gpio_keys.h
--- linux-2.6.23-rc5-clean/include/linux/gpio_keys.h    2007-09-01 
09:08:24.000000000 +0300
+++ linux-2.6.23-rc5/include/linux/gpio_keys.h    2007-09-10 
10:43:39.000000000 +0300
@@ -8,6 +8,7 @@ struct gpio_keys_button {
    int active_low;
    char *desc;
    int type;        /* input event type (EV_KEY, EV_SW) */
+    int wakeup;        /* configure the button as wake-up source from 
suspend */
};

struct gpio_keys_platform_data {

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