2 * Driver for keys on GPIO lines capable of generating interrupts.
4 * Copyright 2005 Phil Blundell
5 * Copyright 2010, 2011 David Jander <david@protonic.nl>
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as
9 * published by the Free Software Foundation.
12 #include <linux/module.h>
14 #include <linux/init.h>
16 #include <linux/interrupt.h>
17 #include <linux/irq.h>
18 #include <linux/sched.h>
20 #include <linux/slab.h>
21 #include <linux/sysctl.h>
22 #include <linux/proc_fs.h>
23 #include <linux/delay.h>
24 #include <linux/platform_device.h>
25 #include <linux/input.h>
26 #include <linux/gpio_keys.h>
27 #include <linux/workqueue.h>
28 #include <linux/gpio.h>
29 #include <linux/gpio/consumer.h>
31 #include <linux/of_irq.h>
32 #include <linux/spinlock.h>
33 #include <dt-bindings/input/gpio-keys.h>
35 struct gpio_button_data
{
36 const struct gpio_keys_button
*button
;
37 struct input_dev
*input
;
38 struct gpio_desc
*gpiod
;
42 struct timer_list release_timer
;
43 unsigned int release_delay
; /* in msecs, for IRQ-only buttons */
45 struct delayed_work work
;
46 unsigned int software_debounce
; /* in msecs, for GPIO-driven buttons */
49 unsigned int wakeup_trigger_type
;
56 struct gpio_keys_drvdata
{
57 const struct gpio_keys_platform_data
*pdata
;
58 struct input_dev
*input
;
59 struct mutex disable_lock
;
60 unsigned short *keymap
;
61 struct gpio_button_data data
[0];
65 * SYSFS interface for enabling/disabling keys and switches:
67 * There are 4 attributes under /sys/devices/platform/gpio-keys/
68 * keys [ro] - bitmap of keys (EV_KEY) which can be
70 * switches [ro] - bitmap of switches (EV_SW) which can be
72 * disabled_keys [rw] - bitmap of keys currently disabled
73 * disabled_switches [rw] - bitmap of switches currently disabled
75 * Userland can change these values and hence disable event generation
76 * for each key (or switch). Disabling a key means its interrupt line
79 * For example, if we have following switches set up as gpio-keys:
81 * SW_CAMERA_LENS_COVER = 9
82 * SW_KEYPAD_SLIDE = 10
83 * SW_FRONT_PROXIMITY = 11
84 * This is read from switches:
86 * Next we want to disable proximity (11) and dock (5), we write:
88 * to file disabled_switches. Now proximity and dock IRQs are disabled.
89 * This can be verified by reading the file disabled_switches:
91 * If we now want to enable proximity (11) switch we write:
93 * to disabled_switches.
95 * We can disable only those keys which don't allow sharing the irq.
99 * get_n_events_by_type() - returns maximum number of events per @type
100 * @type: type of button (%EV_KEY, %EV_SW)
102 * Return value of this function can be used to allocate bitmap
103 * large enough to hold all bits for given type.
105 static int get_n_events_by_type(int type
)
107 BUG_ON(type
!= EV_SW
&& type
!= EV_KEY
);
109 return (type
== EV_KEY
) ? KEY_CNT
: SW_CNT
;
113 * get_bm_events_by_type() - returns bitmap of supported events per @type
114 * @input: input device from which bitmap is retrieved
115 * @type: type of button (%EV_KEY, %EV_SW)
117 * Return value of this function can be used to allocate bitmap
118 * large enough to hold all bits for given type.
120 static const unsigned long *get_bm_events_by_type(struct input_dev
*dev
,
123 BUG_ON(type
!= EV_SW
&& type
!= EV_KEY
);
125 return (type
== EV_KEY
) ? dev
->keybit
: dev
->swbit
;
129 * gpio_keys_disable_button() - disables given GPIO button
130 * @bdata: button data for button to be disabled
132 * Disables button pointed by @bdata. This is done by masking
133 * IRQ line. After this function is called, button won't generate
134 * input events anymore. Note that one can only disable buttons
135 * that don't share IRQs.
137 * Make sure that @bdata->disable_lock is locked when entering
138 * this function to avoid races when concurrent threads are
139 * disabling buttons at the same time.
141 static void gpio_keys_disable_button(struct gpio_button_data
*bdata
)
143 if (!bdata
->disabled
) {
145 * Disable IRQ and associated timer/work structure.
147 disable_irq(bdata
->irq
);
150 cancel_delayed_work_sync(&bdata
->work
);
152 del_timer_sync(&bdata
->release_timer
);
154 bdata
->disabled
= true;
159 * gpio_keys_enable_button() - enables given GPIO button
160 * @bdata: button data for button to be disabled
162 * Enables given button pointed by @bdata.
164 * Make sure that @bdata->disable_lock is locked when entering
165 * this function to avoid races with concurrent threads trying
166 * to enable the same button at the same time.
168 static void gpio_keys_enable_button(struct gpio_button_data
*bdata
)
170 if (bdata
->disabled
) {
171 enable_irq(bdata
->irq
);
172 bdata
->disabled
= false;
177 * gpio_keys_attr_show_helper() - fill in stringified bitmap of buttons
178 * @ddata: pointer to drvdata
179 * @buf: buffer where stringified bitmap is written
180 * @type: button type (%EV_KEY, %EV_SW)
181 * @only_disabled: does caller want only those buttons that are
182 * currently disabled or all buttons that can be
185 * This function writes buttons that can be disabled to @buf. If
186 * @only_disabled is true, then @buf contains only those buttons
187 * that are currently disabled. Returns 0 on success or negative
190 static ssize_t
gpio_keys_attr_show_helper(struct gpio_keys_drvdata
*ddata
,
191 char *buf
, unsigned int type
,
194 int n_events
= get_n_events_by_type(type
);
199 bits
= bitmap_zalloc(n_events
, GFP_KERNEL
);
203 for (i
= 0; i
< ddata
->pdata
->nbuttons
; i
++) {
204 struct gpio_button_data
*bdata
= &ddata
->data
[i
];
206 if (bdata
->button
->type
!= type
)
209 if (only_disabled
&& !bdata
->disabled
)
212 __set_bit(*bdata
->code
, bits
);
215 ret
= scnprintf(buf
, PAGE_SIZE
- 1, "%*pbl", n_events
, bits
);
225 * gpio_keys_attr_store_helper() - enable/disable buttons based on given bitmap
226 * @ddata: pointer to drvdata
227 * @buf: buffer from userspace that contains stringified bitmap
228 * @type: button type (%EV_KEY, %EV_SW)
230 * This function parses stringified bitmap from @buf and disables/enables
231 * GPIO buttons accordingly. Returns 0 on success and negative error
234 static ssize_t
gpio_keys_attr_store_helper(struct gpio_keys_drvdata
*ddata
,
235 const char *buf
, unsigned int type
)
237 int n_events
= get_n_events_by_type(type
);
238 const unsigned long *bitmap
= get_bm_events_by_type(ddata
->input
, type
);
243 bits
= bitmap_zalloc(n_events
, GFP_KERNEL
);
247 error
= bitmap_parselist(buf
, bits
, n_events
);
252 if (!bitmap_subset(bits
, bitmap
, n_events
)) {
257 for (i
= 0; i
< ddata
->pdata
->nbuttons
; i
++) {
258 struct gpio_button_data
*bdata
= &ddata
->data
[i
];
260 if (bdata
->button
->type
!= type
)
263 if (test_bit(*bdata
->code
, bits
) &&
264 !bdata
->button
->can_disable
) {
270 mutex_lock(&ddata
->disable_lock
);
272 for (i
= 0; i
< ddata
->pdata
->nbuttons
; i
++) {
273 struct gpio_button_data
*bdata
= &ddata
->data
[i
];
275 if (bdata
->button
->type
!= type
)
278 if (test_bit(*bdata
->code
, bits
))
279 gpio_keys_disable_button(bdata
);
281 gpio_keys_enable_button(bdata
);
284 mutex_unlock(&ddata
->disable_lock
);
291 #define ATTR_SHOW_FN(name, type, only_disabled) \
292 static ssize_t gpio_keys_show_##name(struct device *dev, \
293 struct device_attribute *attr, \
296 struct platform_device *pdev = to_platform_device(dev); \
297 struct gpio_keys_drvdata *ddata = platform_get_drvdata(pdev); \
299 return gpio_keys_attr_show_helper(ddata, buf, \
300 type, only_disabled); \
303 ATTR_SHOW_FN(keys
, EV_KEY
, false);
304 ATTR_SHOW_FN(switches
, EV_SW
, false);
305 ATTR_SHOW_FN(disabled_keys
, EV_KEY
, true);
306 ATTR_SHOW_FN(disabled_switches
, EV_SW
, true);
311 * /sys/devices/platform/gpio-keys/keys [ro]
312 * /sys/devices/platform/gpio-keys/switches [ro]
314 static DEVICE_ATTR(keys
, S_IRUGO
, gpio_keys_show_keys
, NULL
);
315 static DEVICE_ATTR(switches
, S_IRUGO
, gpio_keys_show_switches
, NULL
);
317 #define ATTR_STORE_FN(name, type) \
318 static ssize_t gpio_keys_store_##name(struct device *dev, \
319 struct device_attribute *attr, \
323 struct platform_device *pdev = to_platform_device(dev); \
324 struct gpio_keys_drvdata *ddata = platform_get_drvdata(pdev); \
327 error = gpio_keys_attr_store_helper(ddata, buf, type); \
334 ATTR_STORE_FN(disabled_keys
, EV_KEY
);
335 ATTR_STORE_FN(disabled_switches
, EV_SW
);
340 * /sys/devices/platform/gpio-keys/disabled_keys [rw]
341 * /sys/devices/platform/gpio-keys/disables_switches [rw]
343 static DEVICE_ATTR(disabled_keys
, S_IWUSR
| S_IRUGO
,
344 gpio_keys_show_disabled_keys
,
345 gpio_keys_store_disabled_keys
);
346 static DEVICE_ATTR(disabled_switches
, S_IWUSR
| S_IRUGO
,
347 gpio_keys_show_disabled_switches
,
348 gpio_keys_store_disabled_switches
);
350 static struct attribute
*gpio_keys_attrs
[] = {
352 &dev_attr_switches
.attr
,
353 &dev_attr_disabled_keys
.attr
,
354 &dev_attr_disabled_switches
.attr
,
358 static const struct attribute_group gpio_keys_attr_group
= {
359 .attrs
= gpio_keys_attrs
,
362 static void gpio_keys_gpio_report_event(struct gpio_button_data
*bdata
)
364 const struct gpio_keys_button
*button
= bdata
->button
;
365 struct input_dev
*input
= bdata
->input
;
366 unsigned int type
= button
->type
?: EV_KEY
;
369 state
= gpiod_get_value_cansleep(bdata
->gpiod
);
371 dev_err(input
->dev
.parent
,
372 "failed to get gpio state: %d\n", state
);
376 if (type
== EV_ABS
) {
378 input_event(input
, type
, button
->code
, button
->value
);
380 input_event(input
, type
, *bdata
->code
, state
);
385 static void gpio_keys_gpio_work_func(struct work_struct
*work
)
387 struct gpio_button_data
*bdata
=
388 container_of(work
, struct gpio_button_data
, work
.work
);
390 gpio_keys_gpio_report_event(bdata
);
392 if (bdata
->button
->wakeup
)
393 pm_relax(bdata
->input
->dev
.parent
);
396 static irqreturn_t
gpio_keys_gpio_isr(int irq
, void *dev_id
)
398 struct gpio_button_data
*bdata
= dev_id
;
400 BUG_ON(irq
!= bdata
->irq
);
402 if (bdata
->button
->wakeup
) {
403 const struct gpio_keys_button
*button
= bdata
->button
;
405 pm_stay_awake(bdata
->input
->dev
.parent
);
406 if (bdata
->suspended
&&
407 (button
->type
== 0 || button
->type
== EV_KEY
)) {
409 * Simulate wakeup key press in case the key has
410 * already released by the time we got interrupt
413 input_report_key(bdata
->input
, button
->code
, 1);
417 mod_delayed_work(system_wq
,
419 msecs_to_jiffies(bdata
->software_debounce
));
424 static void gpio_keys_irq_timer(struct timer_list
*t
)
426 struct gpio_button_data
*bdata
= from_timer(bdata
, t
, release_timer
);
427 struct input_dev
*input
= bdata
->input
;
430 spin_lock_irqsave(&bdata
->lock
, flags
);
431 if (bdata
->key_pressed
) {
432 input_event(input
, EV_KEY
, *bdata
->code
, 0);
434 bdata
->key_pressed
= false;
436 spin_unlock_irqrestore(&bdata
->lock
, flags
);
439 static irqreturn_t
gpio_keys_irq_isr(int irq
, void *dev_id
)
441 struct gpio_button_data
*bdata
= dev_id
;
442 struct input_dev
*input
= bdata
->input
;
445 BUG_ON(irq
!= bdata
->irq
);
447 spin_lock_irqsave(&bdata
->lock
, flags
);
449 if (!bdata
->key_pressed
) {
450 if (bdata
->button
->wakeup
)
451 pm_wakeup_event(bdata
->input
->dev
.parent
, 0);
453 input_event(input
, EV_KEY
, *bdata
->code
, 1);
456 if (!bdata
->release_delay
) {
457 input_event(input
, EV_KEY
, *bdata
->code
, 0);
462 bdata
->key_pressed
= true;
465 if (bdata
->release_delay
)
466 mod_timer(&bdata
->release_timer
,
467 jiffies
+ msecs_to_jiffies(bdata
->release_delay
));
469 spin_unlock_irqrestore(&bdata
->lock
, flags
);
473 static void gpio_keys_quiesce_key(void *data
)
475 struct gpio_button_data
*bdata
= data
;
478 cancel_delayed_work_sync(&bdata
->work
);
480 del_timer_sync(&bdata
->release_timer
);
483 static int gpio_keys_setup_key(struct platform_device
*pdev
,
484 struct input_dev
*input
,
485 struct gpio_keys_drvdata
*ddata
,
486 const struct gpio_keys_button
*button
,
488 struct fwnode_handle
*child
)
490 const char *desc
= button
->desc
? button
->desc
: "gpio_keys";
491 struct device
*dev
= &pdev
->dev
;
492 struct gpio_button_data
*bdata
= &ddata
->data
[idx
];
494 unsigned long irqflags
;
498 bdata
->input
= input
;
499 bdata
->button
= button
;
500 spin_lock_init(&bdata
->lock
);
503 bdata
->gpiod
= devm_fwnode_get_gpiod_from_child(dev
, NULL
,
507 if (IS_ERR(bdata
->gpiod
)) {
508 error
= PTR_ERR(bdata
->gpiod
);
509 if (error
== -ENOENT
) {
511 * GPIO is optional, we may be dealing with
512 * purely interrupt-driven setup.
516 if (error
!= -EPROBE_DEFER
)
517 dev_err(dev
, "failed to get gpio: %d\n",
522 } else if (gpio_is_valid(button
->gpio
)) {
524 * Legacy GPIO number, so request the GPIO here and
525 * convert it to descriptor.
527 unsigned flags
= GPIOF_IN
;
529 if (button
->active_low
)
530 flags
|= GPIOF_ACTIVE_LOW
;
532 error
= devm_gpio_request_one(dev
, button
->gpio
, flags
, desc
);
534 dev_err(dev
, "Failed to request GPIO %d, error %d\n",
535 button
->gpio
, error
);
539 bdata
->gpiod
= gpio_to_desc(button
->gpio
);
545 bool active_low
= gpiod_is_active_low(bdata
->gpiod
);
547 if (button
->debounce_interval
) {
548 error
= gpiod_set_debounce(bdata
->gpiod
,
549 button
->debounce_interval
* 1000);
550 /* use timer if gpiolib doesn't provide debounce */
552 bdata
->software_debounce
=
553 button
->debounce_interval
;
557 bdata
->irq
= button
->irq
;
559 irq
= gpiod_to_irq(bdata
->gpiod
);
563 "Unable to get irq number for GPIO %d, error %d\n",
564 button
->gpio
, error
);
570 INIT_DELAYED_WORK(&bdata
->work
, gpio_keys_gpio_work_func
);
572 isr
= gpio_keys_gpio_isr
;
573 irqflags
= IRQF_TRIGGER_RISING
| IRQF_TRIGGER_FALLING
;
575 switch (button
->wakeup_event_action
) {
576 case EV_ACT_ASSERTED
:
577 bdata
->wakeup_trigger_type
= active_low
?
578 IRQ_TYPE_EDGE_FALLING
: IRQ_TYPE_EDGE_RISING
;
580 case EV_ACT_DEASSERTED
:
581 bdata
->wakeup_trigger_type
= active_low
?
582 IRQ_TYPE_EDGE_RISING
: IRQ_TYPE_EDGE_FALLING
;
588 * For other cases, we are OK letting suspend/resume
589 * not reconfigure the trigger type.
595 dev_err(dev
, "Found button without gpio or irq\n");
599 bdata
->irq
= button
->irq
;
601 if (button
->type
&& button
->type
!= EV_KEY
) {
602 dev_err(dev
, "Only EV_KEY allowed for IRQ buttons.\n");
606 bdata
->release_delay
= button
->debounce_interval
;
607 timer_setup(&bdata
->release_timer
, gpio_keys_irq_timer
, 0);
609 isr
= gpio_keys_irq_isr
;
613 * For IRQ buttons, there is no interrupt for release.
614 * So we don't need to reconfigure the trigger type for wakeup.
618 bdata
->code
= &ddata
->keymap
[idx
];
619 *bdata
->code
= button
->code
;
620 input_set_capability(input
, button
->type
?: EV_KEY
, *bdata
->code
);
623 * Install custom action to cancel release timer and
626 error
= devm_add_action(dev
, gpio_keys_quiesce_key
, bdata
);
628 dev_err(dev
, "failed to register quiesce action, error: %d\n",
634 * If platform has specified that the button can be disabled,
635 * we don't want it to share the interrupt line.
637 if (!button
->can_disable
)
638 irqflags
|= IRQF_SHARED
;
640 error
= devm_request_any_context_irq(dev
, bdata
->irq
, isr
, irqflags
,
643 dev_err(dev
, "Unable to claim irq %d; error %d\n",
651 static void gpio_keys_report_state(struct gpio_keys_drvdata
*ddata
)
653 struct input_dev
*input
= ddata
->input
;
656 for (i
= 0; i
< ddata
->pdata
->nbuttons
; i
++) {
657 struct gpio_button_data
*bdata
= &ddata
->data
[i
];
659 gpio_keys_gpio_report_event(bdata
);
664 static int gpio_keys_open(struct input_dev
*input
)
666 struct gpio_keys_drvdata
*ddata
= input_get_drvdata(input
);
667 const struct gpio_keys_platform_data
*pdata
= ddata
->pdata
;
671 error
= pdata
->enable(input
->dev
.parent
);
676 /* Report current state of buttons that are connected to GPIOs */
677 gpio_keys_report_state(ddata
);
682 static void gpio_keys_close(struct input_dev
*input
)
684 struct gpio_keys_drvdata
*ddata
= input_get_drvdata(input
);
685 const struct gpio_keys_platform_data
*pdata
= ddata
->pdata
;
688 pdata
->disable(input
->dev
.parent
);
692 * Handlers for alternative sources of platform_data
696 * Translate properties into platform_data
698 static struct gpio_keys_platform_data
*
699 gpio_keys_get_devtree_pdata(struct device
*dev
)
701 struct gpio_keys_platform_data
*pdata
;
702 struct gpio_keys_button
*button
;
703 struct fwnode_handle
*child
;
706 nbuttons
= device_get_child_node_count(dev
);
708 return ERR_PTR(-ENODEV
);
710 pdata
= devm_kzalloc(dev
,
711 sizeof(*pdata
) + nbuttons
* sizeof(*button
),
714 return ERR_PTR(-ENOMEM
);
716 button
= (struct gpio_keys_button
*)(pdata
+ 1);
718 pdata
->buttons
= button
;
719 pdata
->nbuttons
= nbuttons
;
721 pdata
->rep
= device_property_read_bool(dev
, "autorepeat");
723 device_property_read_string(dev
, "label", &pdata
->name
);
725 device_for_each_child_node(dev
, child
) {
726 if (is_of_node(child
))
728 irq_of_parse_and_map(to_of_node(child
), 0);
730 if (fwnode_property_read_u32(child
, "linux,code",
732 dev_err(dev
, "Button without keycode\n");
733 fwnode_handle_put(child
);
734 return ERR_PTR(-EINVAL
);
737 fwnode_property_read_string(child
, "label", &button
->desc
);
739 if (fwnode_property_read_u32(child
, "linux,input-type",
741 button
->type
= EV_KEY
;
744 fwnode_property_read_bool(child
, "wakeup-source") ||
746 fwnode_property_read_bool(child
, "gpio-key,wakeup");
748 fwnode_property_read_u32(child
, "wakeup-event-action",
749 &button
->wakeup_event_action
);
751 button
->can_disable
=
752 fwnode_property_read_bool(child
, "linux,can-disable");
754 if (fwnode_property_read_u32(child
, "debounce-interval",
755 &button
->debounce_interval
))
756 button
->debounce_interval
= 5;
764 static const struct of_device_id gpio_keys_of_match
[] = {
765 { .compatible
= "gpio-keys", },
768 MODULE_DEVICE_TABLE(of
, gpio_keys_of_match
);
770 static int gpio_keys_probe(struct platform_device
*pdev
)
772 struct device
*dev
= &pdev
->dev
;
773 const struct gpio_keys_platform_data
*pdata
= dev_get_platdata(dev
);
774 struct fwnode_handle
*child
= NULL
;
775 struct gpio_keys_drvdata
*ddata
;
776 struct input_dev
*input
;
782 pdata
= gpio_keys_get_devtree_pdata(dev
);
784 return PTR_ERR(pdata
);
787 size
= sizeof(struct gpio_keys_drvdata
) +
788 pdata
->nbuttons
* sizeof(struct gpio_button_data
);
789 ddata
= devm_kzalloc(dev
, size
, GFP_KERNEL
);
791 dev_err(dev
, "failed to allocate state\n");
795 ddata
->keymap
= devm_kcalloc(dev
,
796 pdata
->nbuttons
, sizeof(ddata
->keymap
[0]),
801 input
= devm_input_allocate_device(dev
);
803 dev_err(dev
, "failed to allocate input device\n");
807 ddata
->pdata
= pdata
;
808 ddata
->input
= input
;
809 mutex_init(&ddata
->disable_lock
);
811 platform_set_drvdata(pdev
, ddata
);
812 input_set_drvdata(input
, ddata
);
814 input
->name
= pdata
->name
? : pdev
->name
;
815 input
->phys
= "gpio-keys/input0";
816 input
->dev
.parent
= dev
;
817 input
->open
= gpio_keys_open
;
818 input
->close
= gpio_keys_close
;
820 input
->id
.bustype
= BUS_HOST
;
821 input
->id
.vendor
= 0x0001;
822 input
->id
.product
= 0x0001;
823 input
->id
.version
= 0x0100;
825 input
->keycode
= ddata
->keymap
;
826 input
->keycodesize
= sizeof(ddata
->keymap
[0]);
827 input
->keycodemax
= pdata
->nbuttons
;
829 /* Enable auto repeat feature of Linux input subsystem */
831 __set_bit(EV_REP
, input
->evbit
);
833 for (i
= 0; i
< pdata
->nbuttons
; i
++) {
834 const struct gpio_keys_button
*button
= &pdata
->buttons
[i
];
836 if (!dev_get_platdata(dev
)) {
837 child
= device_get_next_child_node(dev
, child
);
840 "missing child device node for entry %d\n",
846 error
= gpio_keys_setup_key(pdev
, input
, ddata
,
849 fwnode_handle_put(child
);
857 fwnode_handle_put(child
);
859 error
= devm_device_add_group(dev
, &gpio_keys_attr_group
);
861 dev_err(dev
, "Unable to export keys/switches, error: %d\n",
866 error
= input_register_device(input
);
868 dev_err(dev
, "Unable to register input device, error: %d\n",
873 device_init_wakeup(dev
, wakeup
);
878 static int __maybe_unused
879 gpio_keys_button_enable_wakeup(struct gpio_button_data
*bdata
)
883 error
= enable_irq_wake(bdata
->irq
);
885 dev_err(bdata
->input
->dev
.parent
,
886 "failed to configure IRQ %d as wakeup source: %d\n",
891 if (bdata
->wakeup_trigger_type
) {
892 error
= irq_set_irq_type(bdata
->irq
,
893 bdata
->wakeup_trigger_type
);
895 dev_err(bdata
->input
->dev
.parent
,
896 "failed to set wakeup trigger %08x for IRQ %d: %d\n",
897 bdata
->wakeup_trigger_type
, bdata
->irq
, error
);
898 disable_irq_wake(bdata
->irq
);
906 static void __maybe_unused
907 gpio_keys_button_disable_wakeup(struct gpio_button_data
*bdata
)
912 * The trigger type is always both edges for gpio-based keys and we do
913 * not support changing wakeup trigger for interrupt-based keys.
915 if (bdata
->wakeup_trigger_type
) {
916 error
= irq_set_irq_type(bdata
->irq
, IRQ_TYPE_EDGE_BOTH
);
918 dev_warn(bdata
->input
->dev
.parent
,
919 "failed to restore interrupt trigger for IRQ %d: %d\n",
923 error
= disable_irq_wake(bdata
->irq
);
925 dev_warn(bdata
->input
->dev
.parent
,
926 "failed to disable IRQ %d as wake source: %d\n",
930 static int __maybe_unused
931 gpio_keys_enable_wakeup(struct gpio_keys_drvdata
*ddata
)
933 struct gpio_button_data
*bdata
;
937 for (i
= 0; i
< ddata
->pdata
->nbuttons
; i
++) {
938 bdata
= &ddata
->data
[i
];
939 if (bdata
->button
->wakeup
) {
940 error
= gpio_keys_button_enable_wakeup(bdata
);
944 bdata
->suspended
= true;
951 bdata
= &ddata
->data
[i
];
952 if (bdata
->button
->wakeup
)
953 gpio_keys_button_disable_wakeup(bdata
);
954 bdata
->suspended
= false;
960 static void __maybe_unused
961 gpio_keys_disable_wakeup(struct gpio_keys_drvdata
*ddata
)
963 struct gpio_button_data
*bdata
;
966 for (i
= 0; i
< ddata
->pdata
->nbuttons
; i
++) {
967 bdata
= &ddata
->data
[i
];
968 bdata
->suspended
= false;
969 if (irqd_is_wakeup_set(irq_get_irq_data(bdata
->irq
)))
970 gpio_keys_button_disable_wakeup(bdata
);
974 static int __maybe_unused
gpio_keys_suspend(struct device
*dev
)
976 struct gpio_keys_drvdata
*ddata
= dev_get_drvdata(dev
);
977 struct input_dev
*input
= ddata
->input
;
980 if (device_may_wakeup(dev
)) {
981 error
= gpio_keys_enable_wakeup(ddata
);
985 mutex_lock(&input
->mutex
);
987 gpio_keys_close(input
);
988 mutex_unlock(&input
->mutex
);
994 static int __maybe_unused
gpio_keys_resume(struct device
*dev
)
996 struct gpio_keys_drvdata
*ddata
= dev_get_drvdata(dev
);
997 struct input_dev
*input
= ddata
->input
;
1000 if (device_may_wakeup(dev
)) {
1001 gpio_keys_disable_wakeup(ddata
);
1003 mutex_lock(&input
->mutex
);
1005 error
= gpio_keys_open(input
);
1006 mutex_unlock(&input
->mutex
);
1012 gpio_keys_report_state(ddata
);
1016 static SIMPLE_DEV_PM_OPS(gpio_keys_pm_ops
, gpio_keys_suspend
, gpio_keys_resume
);
1018 static struct platform_driver gpio_keys_device_driver
= {
1019 .probe
= gpio_keys_probe
,
1021 .name
= "gpio-keys",
1022 .pm
= &gpio_keys_pm_ops
,
1023 .of_match_table
= gpio_keys_of_match
,
1027 static int __init
gpio_keys_init(void)
1029 return platform_driver_register(&gpio_keys_device_driver
);
1032 static void __exit
gpio_keys_exit(void)
1034 platform_driver_unregister(&gpio_keys_device_driver
);
1037 late_initcall(gpio_keys_init
);
1038 module_exit(gpio_keys_exit
);
1040 MODULE_LICENSE("GPL");
1041 MODULE_AUTHOR("Phil Blundell <pb@handhelds.org>");
1042 MODULE_DESCRIPTION("Keyboard driver for GPIOs");
1043 MODULE_ALIAS("platform:gpio-keys");