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

[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@artecdesign.ee>

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 {