|
@@ -39,6 +39,8 @@ struct gpio_keys_drvdata {
|
|
|
struct input_dev *input;
|
|
|
struct mutex disable_lock;
|
|
|
unsigned int n_buttons;
|
|
|
+ int (*enable)(struct device *dev);
|
|
|
+ void (*disable)(struct device *dev);
|
|
|
struct gpio_button_data data[0];
|
|
|
};
|
|
|
|
|
@@ -423,6 +425,21 @@ fail2:
|
|
|
return error;
|
|
|
}
|
|
|
|
|
|
+static int gpio_keys_open(struct input_dev *input)
|
|
|
+{
|
|
|
+ struct gpio_keys_drvdata *ddata = input_get_drvdata(input);
|
|
|
+
|
|
|
+ return ddata->enable ? ddata->enable(input->dev.parent) : 0;
|
|
|
+}
|
|
|
+
|
|
|
+static void gpio_keys_close(struct input_dev *input)
|
|
|
+{
|
|
|
+ struct gpio_keys_drvdata *ddata = input_get_drvdata(input);
|
|
|
+
|
|
|
+ if (ddata->disable)
|
|
|
+ ddata->disable(input->dev.parent);
|
|
|
+}
|
|
|
+
|
|
|
static int __devinit gpio_keys_probe(struct platform_device *pdev)
|
|
|
{
|
|
|
struct gpio_keys_platform_data *pdata = pdev->dev.platform_data;
|
|
@@ -444,13 +461,18 @@ static int __devinit gpio_keys_probe(struct platform_device *pdev)
|
|
|
|
|
|
ddata->input = input;
|
|
|
ddata->n_buttons = pdata->nbuttons;
|
|
|
+ ddata->enable = pdata->enable;
|
|
|
+ ddata->disable = pdata->disable;
|
|
|
mutex_init(&ddata->disable_lock);
|
|
|
|
|
|
platform_set_drvdata(pdev, ddata);
|
|
|
+ input_set_drvdata(input, ddata);
|
|
|
|
|
|
input->name = pdev->name;
|
|
|
input->phys = "gpio-keys/input0";
|
|
|
input->dev.parent = &pdev->dev;
|
|
|
+ input->open = gpio_keys_open;
|
|
|
+ input->close = gpio_keys_close;
|
|
|
|
|
|
input->id.bustype = BUS_HOST;
|
|
|
input->id.vendor = 0x0001;
|