[1/3] input: keyboard: MCS5080: support suspend/resume.

Commit Message

Kim, HeungJun Nov. 15, 2010, 4:31 a.m. UTC

None

Patch

diff --git a/drivers/input/keyboard/mcs_touchkey.c b/drivers/input/keyboard/mcs_touchkey.c
index 63b849d..06385f5 100644
--- a/drivers/input/keyboard/mcs_touchkey.c
+++ b/drivers/input/keyboard/mcs_touchkey.c
@@ -45,6 +45,8 @@  struct mcs_touchkey_chip {
 };

 struct mcs_touchkey_data {
+       void (*poweron)(int);
+
        struct i2c_client *client;
        struct input_dev *input_dev;
        struct mcs_touchkey_chip chip;
@@ -168,6 +170,8 @@  static int __devinit mcs_touchkey_probe(struct i2c_client *client,

        if (pdata->cfg_pin)
                pdata->cfg_pin();
+       if (pdata->poweron)
+               data->poweron = pdata->poweron;

        error = request_threaded_irq(client->irq, NULL, mcs_touchkey_interrupt,
                        IRQF_TRIGGER_FALLING, client->dev.driver->name, data);
@@ -202,6 +206,41 @@  static int __devexit mcs_touchkey_remove(struct i2c_client *client)
        return 0;
 }

+#ifdef CONFIG_PM
+static int mcs_touchkey_suspend(struct i2c_client *client, pm_message_t mesg)
+{
+       struct mcs_touchkey_data *data = i2c_get_clientdata(client);
+
+       /* Disable the work */
+       disable_irq(client->irq);
+
+       /* Don't I2C operation since we don't know I2C bus is dead already */
+
+       /* Finally turn off the power */
+       if (data->poweron)
+               data->poweron(0);
+
+       return 0;
+}
+
+static int mcs_touchkey_resume(struct i2c_client *client)
+{
+       struct mcs_touchkey_data *data = i2c_get_clientdata(client);
+
+       /* Enable the device first */
+       if (data->poweron)
+               data->poweron(1);
+
+       /* Enable irq again */
+       enable_irq(client->irq);
+
+       return 0;
+}
+#else
+#define mcs_touchkey_suspend   NULL
+#define mcs_touchkey_resume    NULL
+#endif
+
 static const struct i2c_device_id mcs_touchkey_id[] = {
        { "mcs5000_touchkey", MCS5000_TOUCHKEY },
        { "mcs5080_touchkey", MCS5080_TOUCHKEY },
@@ -216,6 +255,8 @@  static struct i2c_driver mcs_touchkey_driver = {
        },
        .probe          = mcs_touchkey_probe,
        .remove         = __devexit_p(mcs_touchkey_remove),
+       .suspend        = mcs_touchkey_suspend,
+       .resume         = mcs_touchkey_resume,
        .id_table       = mcs_touchkey_id,
 };

diff --git a/include/linux/i2c/mcs.h b/include/linux/i2c/mcs.h
index 725ae7c..c4a3869 100644
--- a/include/linux/i2c/mcs.h
+++ b/include/linux/i2c/mcs.h
@@ -18,6 +18,7 @@ 
 #define MCS_KEY_CODE(v)                ((v) & 0xffff)

 struct mcs_platform_data {
+       void (*poweron)(int);
        void (*cfg_pin)(void);

        /* touchscreen */