Input: gpio-keys - add support for setkeycode

gpio-keys input devices created by the soc_button_array driver are
configured with key-codes based on ACPI provided information.

Unfortunately on some tablets this info is wrong, and we need to have
a quirk to fix things up.

Add support for input_setkeycode to the gpio-keys driver, so that
the existing udev hwdb mechanism can be used to fix things up on these
tablets.

Signed-off-by: Hans de Goede <hdegoede@redhat.com>
Signed-off-by: Dmitry Torokhov <dmitry.torokhov@gmail.com>
[sw0312.kim: backport mainline commit 83e4947a569f to suuport setkeycode]
Reference: https://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git/commit/?id=83e4947a569f4d544ef4a1361f51c91d73a9c915
Signed-off-by: Seung-Woo Kim <sw0312.kim@samsung.com>
Change-Id: Ia21dbdb9591b7a83989dfcba561eb5a4cf846ade

diff --git a/drivers/input/keyboard/gpio_keys.c b/drivers/input/keyboard/gpio_keys.c
index 43f433959876cbf7e0f40c65abbb1b9c2e5e2c90..a6ba98163080181b7faa5f716840c968dcfef6bd 100644 (file)
--- a/drivers/input/keyboard/gpio_keys.c
+++ b/drivers/input/keyboard/gpio_keys.c
@@ -46,6 +46,8 @@ struct gpio_button_data {
        struct input_dev *input;
        struct gpio_desc *gpiod;
 
+       unsigned short *code;
+
        struct timer_list release_timer;
        unsigned int release_delay;     /* in msecs, for IRQ-only buttons */
 
@@ -66,6 +68,7 @@ struct gpio_keys_drvdata {
        struct device *sec_key;
        struct input_dev *input;
        struct mutex disable_lock;
+       unsigned short *keymap;
 #ifdef CONFIG_DISPLAY_EARLY_DPMS
        bool resume_state;
 #endif
@@ -85,7 +88,7 @@ void gpio_keys_send_fake_powerkey(int value)
                return;
        }
 
-       input_event(input, type, button->code, value);
+       input_event(input, type, *global_button_data->code, value);
        input_sync(input);
 
        dev_info(&input->dev,
@@ -243,7 +246,7 @@ static ssize_t gpio_keys_attr_show_helper(struct gpio_keys_drvdata *ddata,
                if (only_disabled && !bdata->disabled)
                        continue;
 
-               __set_bit(bdata->button->code, bits);
+               __set_bit(*bdata->code, bits);
        }
 
        ret = scnprintf(buf, PAGE_SIZE - 1, "%*pbl", n_events, bits);
@@ -294,7 +297,7 @@ static ssize_t gpio_keys_attr_store_helper(struct gpio_keys_drvdata *ddata,
                if (bdata->button->type != type)
                        continue;
 
-               if (test_bit(bdata->button->code, bits) &&
+               if (test_bit(*bdata->code, bits) &&
                    !bdata->button->can_disable) {
                        error = -EINVAL;
                        goto out;
@@ -309,7 +312,7 @@ static ssize_t gpio_keys_attr_store_helper(struct gpio_keys_drvdata *ddata,
                if (bdata->button->type != type)
                        continue;
 
-               if (test_bit(bdata->button->code, bits))
+               if (test_bit(*bdata->code, bits))
                        gpio_keys_disable_button(bdata);
                else
                        gpio_keys_enable_button(bdata);
@@ -472,7 +475,7 @@ static void gpio_keys_gpio_report_event(struct gpio_button_data *bdata)
                        input_event(input, type, button->code, button->value);
        } else {
                key_pressed = irqd_is_wakeup_set(&desc->irq_data) ? 1 : state;
-               input_event(input, type, button->code,
+               input_event(input, type, *bdata->code,
                                irqd_is_wakeup_set(&desc->irq_data) ? 1 : state);
        }
        input_sync(input);
@@ -495,7 +498,7 @@ static void gpio_keys_gpio_report_event(struct gpio_button_data *bdata)
 #endif
 
 #if defined(BACK_KEY_BOOSTER)
-       if ((button->code == KEY_BACK) && (bdata->isr_status)) {
+       if ((*bdata->code == KEY_BACK) && (bdata->isr_status)) {
                back_key_booster_turn_on();
        }
 #endif
@@ -549,7 +552,7 @@ static void gpio_keys_irq_timer(unsigned long _data)
 
        spin_lock_irqsave(&bdata->lock, flags);
        if (bdata->key_pressed) {
-               input_event(input, EV_KEY, bdata->button->code, 0);
+               input_event(input, EV_KEY, *bdata->code, 0);
                input_sync(input);
                bdata->key_pressed = false;
        }
@@ -559,7 +562,6 @@ static void gpio_keys_irq_timer(unsigned long _data)
 static irqreturn_t gpio_keys_irq_isr(int irq, void *dev_id)
 {
        struct gpio_button_data *bdata = dev_id;
-       const struct gpio_keys_button *button = bdata->button;
        struct input_dev *input = bdata->input;
        unsigned long flags;
 
@@ -571,11 +573,11 @@ static irqreturn_t gpio_keys_irq_isr(int irq, void *dev_id)
                if (bdata->button->wakeup)
                        pm_wakeup_event(bdata->input->dev.parent, 0);
 
-               input_event(input, EV_KEY, button->code, 1);
+               input_event(input, EV_KEY, *bdata->code, 1);
                input_sync(input);
 
                if (!bdata->release_delay) {
-                       input_event(input, EV_KEY, button->code, 0);
+                       input_event(input, EV_KEY, *bdata->code, 0);
                        input_sync(input);
                        goto out;
                }
@@ -603,11 +605,13 @@ static void gpio_keys_quiesce_key(void *data)
 
 static int gpio_keys_setup_key(struct platform_device *pdev,
                                struct input_dev *input,
-                               struct gpio_button_data *bdata,
-                               const struct gpio_keys_button *button)
+                               struct gpio_keys_drvdata *ddata,
+                               const struct gpio_keys_button *button,
+                               int idx)
 {
        const char *desc = button->desc ? button->desc : "gpio_keys";
        struct device *dev = &pdev->dev;
+       struct gpio_button_data *bdata = &ddata->data[idx];
        irq_handler_t isr;
        unsigned long irqflags;
        int irq;
@@ -687,7 +691,9 @@ static int gpio_keys_setup_key(struct platform_device *pdev,
                irqflags = 0;
        }
 
-       input_set_capability(input, button->type ?: EV_KEY, button->code);
+       bdata->code = &ddata->keymap[idx];
+       *bdata->code = button->code;
+       input_set_capability(input, button->type ?: EV_KEY, *bdata->code);
 
        /*
         * Install custom action to cancel release timer and
@@ -896,6 +902,12 @@ static int gpio_keys_probe(struct platform_device *pdev)
                return -ENOMEM;
        }
 
+       ddata->keymap = devm_kcalloc(dev,
+                                    pdata->nbuttons, sizeof(ddata->keymap[0]),
+                                    GFP_KERNEL);
+       if (!ddata->keymap)
+               return -ENOMEM;
+
        input = devm_input_allocate_device(dev);
        if (!input) {
                dev_err(dev, "failed to allocate input device\n");
@@ -920,16 +932,19 @@ static int gpio_keys_probe(struct platform_device *pdev)
        input->id.product = 0x0001;
        input->id.version = 0x0100;
 
+       input->keycode = ddata->keymap;
+       input->keycodesize = sizeof(ddata->keymap[0]);
+       input->keycodemax = pdata->nbuttons;
+
        /* Enable auto repeat feature of Linux input subsystem */
        if (pdata->rep)
                __set_bit(EV_REP, input->evbit);
 
        for (i = 0; i < pdata->nbuttons; i++) {
                const struct gpio_keys_button *button = &pdata->buttons[i];
-               struct gpio_button_data *bdata = &ddata->data[i];
 
-               global_button_data = bdata;
-               error = gpio_keys_setup_key(pdev, input, bdata, button);
+               global_button_data = &ddata->data[i];
+               error = gpio_keys_setup_key(pdev, input, ddata, button, i);
                if (error)
                        return error;