xref: /linux/drivers/input/keyboard/gpio_keys.c (revision 16cd1c2657762c62a00ac78eecaa25868f7e601b)
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Driver for keys on GPIO lines capable of generating interrupts.
4  *
5  * Copyright 2005 Phil Blundell
6  * Copyright 2010, 2011 David Jander <david@protonic.nl>
7  */
8 
9 #include <linux/module.h>
10 
11 #include <linux/hrtimer.h>
12 #include <linux/init.h>
13 #include <linux/fs.h>
14 #include <linux/interrupt.h>
15 #include <linux/irq.h>
16 #include <linux/sched.h>
17 #include <linux/pm.h>
18 #include <linux/slab.h>
19 #include <linux/sysctl.h>
20 #include <linux/proc_fs.h>
21 #include <linux/delay.h>
22 #include <linux/platform_device.h>
23 #include <linux/input.h>
24 #include <linux/gpio_keys.h>
25 #include <linux/workqueue.h>
26 #include <linux/gpio.h>
27 #include <linux/gpio/consumer.h>
28 #include <linux/of.h>
29 #include <linux/of_irq.h>
30 #include <linux/spinlock.h>
31 #include <dt-bindings/input/gpio-keys.h>
32 
33 struct gpio_button_data {
34 	const struct gpio_keys_button *button;
35 	struct input_dev *input;
36 	struct gpio_desc *gpiod;
37 
38 	unsigned short *code;
39 
40 	struct hrtimer release_timer;
41 	unsigned int release_delay;	/* in msecs, for IRQ-only buttons */
42 
43 	struct delayed_work work;
44 	struct hrtimer debounce_timer;
45 	unsigned int software_debounce;	/* in msecs, for GPIO-driven buttons */
46 
47 	unsigned int irq;
48 	unsigned int wakeirq;
49 	unsigned int wakeup_trigger_type;
50 
51 	spinlock_t lock;
52 	bool disabled;
53 	bool key_pressed;
54 	bool suspended;
55 	bool debounce_use_hrtimer;
56 };
57 
58 struct gpio_keys_drvdata {
59 	const struct gpio_keys_platform_data *pdata;
60 	struct input_dev *input;
61 	struct mutex disable_lock;
62 	unsigned short *keymap;
63 	struct gpio_button_data data[];
64 };
65 
66 /*
67  * SYSFS interface for enabling/disabling keys and switches:
68  *
69  * There are 4 attributes under /sys/devices/platform/gpio-keys/
70  *	keys [ro]              - bitmap of keys (EV_KEY) which can be
71  *	                         disabled
72  *	switches [ro]          - bitmap of switches (EV_SW) which can be
73  *	                         disabled
74  *	disabled_keys [rw]     - bitmap of keys currently disabled
75  *	disabled_switches [rw] - bitmap of switches currently disabled
76  *
77  * Userland can change these values and hence disable event generation
78  * for each key (or switch). Disabling a key means its interrupt line
79  * is disabled.
80  *
81  * For example, if we have following switches set up as gpio-keys:
82  *	SW_DOCK = 5
83  *	SW_CAMERA_LENS_COVER = 9
84  *	SW_KEYPAD_SLIDE = 10
85  *	SW_FRONT_PROXIMITY = 11
86  * This is read from switches:
87  *	11-9,5
88  * Next we want to disable proximity (11) and dock (5), we write:
89  *	11,5
90  * to file disabled_switches. Now proximity and dock IRQs are disabled.
91  * This can be verified by reading the file disabled_switches:
92  *	11,5
93  * If we now want to enable proximity (11) switch we write:
94  *	5
95  * to disabled_switches.
96  *
97  * We can disable only those keys which don't allow sharing the irq.
98  */
99 
100 /**
101  * get_n_events_by_type() - returns maximum number of events per @type
102  * @type: type of button (%EV_KEY, %EV_SW)
103  *
104  * Return value of this function can be used to allocate bitmap
105  * large enough to hold all bits for given type.
106  */
get_n_events_by_type(int type)107 static int get_n_events_by_type(int type)
108 {
109 	BUG_ON(type != EV_SW && type != EV_KEY);
110 
111 	return (type == EV_KEY) ? KEY_CNT : SW_CNT;
112 }
113 
114 /**
115  * get_bm_events_by_type() - returns bitmap of supported events per @type
116  * @dev: input device from which bitmap is retrieved
117  * @type: type of button (%EV_KEY, %EV_SW)
118  *
119  * Return value of this function can be used to allocate bitmap
120  * large enough to hold all bits for given type.
121  */
get_bm_events_by_type(struct input_dev * dev,int type)122 static const unsigned long *get_bm_events_by_type(struct input_dev *dev,
123 						  int type)
124 {
125 	BUG_ON(type != EV_SW && type != EV_KEY);
126 
127 	return (type == EV_KEY) ? dev->keybit : dev->swbit;
128 }
129 
gpio_keys_quiesce_key(void * data)130 static void gpio_keys_quiesce_key(void *data)
131 {
132 	struct gpio_button_data *bdata = data;
133 
134 	if (!bdata->gpiod)
135 		hrtimer_cancel(&bdata->release_timer);
136 	else if (bdata->debounce_use_hrtimer)
137 		hrtimer_cancel(&bdata->debounce_timer);
138 	else
139 		cancel_delayed_work_sync(&bdata->work);
140 }
141 
142 /**
143  * gpio_keys_disable_button() - disables given GPIO button
144  * @bdata: button data for button to be disabled
145  *
146  * Disables button pointed by @bdata. This is done by masking
147  * IRQ line. After this function is called, button won't generate
148  * input events anymore. Note that one can only disable buttons
149  * that don't share IRQs.
150  *
151  * Make sure that @bdata->disable_lock is locked when entering
152  * this function to avoid races when concurrent threads are
153  * disabling buttons at the same time.
154  */
gpio_keys_disable_button(struct gpio_button_data * bdata)155 static void gpio_keys_disable_button(struct gpio_button_data *bdata)
156 {
157 	if (!bdata->disabled) {
158 		/*
159 		 * Disable IRQ and associated timer/work structure.
160 		 */
161 		disable_irq(bdata->irq);
162 		gpio_keys_quiesce_key(bdata);
163 		bdata->disabled = true;
164 	}
165 }
166 
167 /**
168  * gpio_keys_enable_button() - enables given GPIO button
169  * @bdata: button data for button to be disabled
170  *
171  * Enables given button pointed by @bdata.
172  *
173  * Make sure that @bdata->disable_lock is locked when entering
174  * this function to avoid races with concurrent threads trying
175  * to enable the same button at the same time.
176  */
gpio_keys_enable_button(struct gpio_button_data * bdata)177 static void gpio_keys_enable_button(struct gpio_button_data *bdata)
178 {
179 	if (bdata->disabled) {
180 		enable_irq(bdata->irq);
181 		bdata->disabled = false;
182 	}
183 }
184 
185 /**
186  * gpio_keys_attr_show_helper() - fill in stringified bitmap of buttons
187  * @ddata: pointer to drvdata
188  * @buf: buffer where stringified bitmap is written
189  * @type: button type (%EV_KEY, %EV_SW)
190  * @only_disabled: does caller want only those buttons that are
191  *                 currently disabled or all buttons that can be
192  *                 disabled
193  *
194  * This function writes buttons that can be disabled to @buf. If
195  * @only_disabled is true, then @buf contains only those buttons
196  * that are currently disabled. Returns 0 on success or negative
197  * errno on failure.
198  */
gpio_keys_attr_show_helper(struct gpio_keys_drvdata * ddata,char * buf,unsigned int type,bool only_disabled)199 static ssize_t gpio_keys_attr_show_helper(struct gpio_keys_drvdata *ddata,
200 					  char *buf, unsigned int type,
201 					  bool only_disabled)
202 {
203 	int n_events = get_n_events_by_type(type);
204 	unsigned long *bits;
205 	ssize_t ret;
206 	int i;
207 
208 	bits = bitmap_zalloc(n_events, GFP_KERNEL);
209 	if (!bits)
210 		return -ENOMEM;
211 
212 	for (i = 0; i < ddata->pdata->nbuttons; i++) {
213 		struct gpio_button_data *bdata = &ddata->data[i];
214 
215 		if (bdata->button->type != type)
216 			continue;
217 
218 		if (only_disabled && !bdata->disabled)
219 			continue;
220 
221 		__set_bit(*bdata->code, bits);
222 	}
223 
224 	ret = scnprintf(buf, PAGE_SIZE - 1, "%*pbl", n_events, bits);
225 	buf[ret++] = '\n';
226 	buf[ret] = '\0';
227 
228 	bitmap_free(bits);
229 
230 	return ret;
231 }
232 
233 /**
234  * gpio_keys_attr_store_helper() - enable/disable buttons based on given bitmap
235  * @ddata: pointer to drvdata
236  * @buf: buffer from userspace that contains stringified bitmap
237  * @type: button type (%EV_KEY, %EV_SW)
238  *
239  * This function parses stringified bitmap from @buf and disables/enables
240  * GPIO buttons accordingly. Returns 0 on success and negative error
241  * on failure.
242  */
gpio_keys_attr_store_helper(struct gpio_keys_drvdata * ddata,const char * buf,unsigned int type)243 static ssize_t gpio_keys_attr_store_helper(struct gpio_keys_drvdata *ddata,
244 					   const char *buf, unsigned int type)
245 {
246 	int n_events = get_n_events_by_type(type);
247 	const unsigned long *bitmap = get_bm_events_by_type(ddata->input, type);
248 	ssize_t error;
249 	int i;
250 
251 	unsigned long *bits __free(bitmap) = bitmap_alloc(n_events, GFP_KERNEL);
252 	if (!bits)
253 		return -ENOMEM;
254 
255 	error = bitmap_parselist(buf, bits, n_events);
256 	if (error)
257 		return error;
258 
259 	/* First validate */
260 	if (!bitmap_subset(bits, bitmap, n_events))
261 		return -EINVAL;
262 
263 	for (i = 0; i < ddata->pdata->nbuttons; i++) {
264 		struct gpio_button_data *bdata = &ddata->data[i];
265 
266 		if (bdata->button->type != type)
267 			continue;
268 
269 		if (test_bit(*bdata->code, bits) &&
270 		    !bdata->button->can_disable) {
271 			return -EINVAL;
272 		}
273 	}
274 
275 	guard(mutex)(&ddata->disable_lock);
276 
277 	for (i = 0; i < ddata->pdata->nbuttons; i++) {
278 		struct gpio_button_data *bdata = &ddata->data[i];
279 
280 		if (bdata->button->type != type)
281 			continue;
282 
283 		if (test_bit(*bdata->code, bits))
284 			gpio_keys_disable_button(bdata);
285 		else
286 			gpio_keys_enable_button(bdata);
287 	}
288 
289 	return 0;
290 }
291 
292 #define ATTR_SHOW_FN(name, type, only_disabled)				\
293 static ssize_t gpio_keys_show_##name(struct device *dev,		\
294 				     struct device_attribute *attr,	\
295 				     char *buf)				\
296 {									\
297 	struct platform_device *pdev = to_platform_device(dev);		\
298 	struct gpio_keys_drvdata *ddata = platform_get_drvdata(pdev);	\
299 									\
300 	return gpio_keys_attr_show_helper(ddata, buf,			\
301 					  type, only_disabled);		\
302 }
303 
304 ATTR_SHOW_FN(keys, EV_KEY, false);
305 ATTR_SHOW_FN(switches, EV_SW, false);
306 ATTR_SHOW_FN(disabled_keys, EV_KEY, true);
307 ATTR_SHOW_FN(disabled_switches, EV_SW, true);
308 
309 /*
310  * ATTRIBUTES:
311  *
312  * /sys/devices/platform/gpio-keys/keys [ro]
313  * /sys/devices/platform/gpio-keys/switches [ro]
314  */
315 static DEVICE_ATTR(keys, S_IRUGO, gpio_keys_show_keys, NULL);
316 static DEVICE_ATTR(switches, S_IRUGO, gpio_keys_show_switches, NULL);
317 
318 #define ATTR_STORE_FN(name, type)					\
319 static ssize_t gpio_keys_store_##name(struct device *dev,		\
320 				      struct device_attribute *attr,	\
321 				      const char *buf,			\
322 				      size_t count)			\
323 {									\
324 	struct platform_device *pdev = to_platform_device(dev);		\
325 	struct gpio_keys_drvdata *ddata = platform_get_drvdata(pdev);	\
326 	ssize_t error;							\
327 									\
328 	error = gpio_keys_attr_store_helper(ddata, buf, type);		\
329 	if (error)							\
330 		return error;						\
331 									\
332 	return count;							\
333 }
334 
335 ATTR_STORE_FN(disabled_keys, EV_KEY);
336 ATTR_STORE_FN(disabled_switches, EV_SW);
337 
338 /*
339  * ATTRIBUTES:
340  *
341  * /sys/devices/platform/gpio-keys/disabled_keys [rw]
342  * /sys/devices/platform/gpio-keys/disables_switches [rw]
343  */
344 static DEVICE_ATTR(disabled_keys, S_IWUSR | S_IRUGO,
345 		   gpio_keys_show_disabled_keys,
346 		   gpio_keys_store_disabled_keys);
347 static DEVICE_ATTR(disabled_switches, S_IWUSR | S_IRUGO,
348 		   gpio_keys_show_disabled_switches,
349 		   gpio_keys_store_disabled_switches);
350 
351 static struct attribute *gpio_keys_attrs[] = {
352 	&dev_attr_keys.attr,
353 	&dev_attr_switches.attr,
354 	&dev_attr_disabled_keys.attr,
355 	&dev_attr_disabled_switches.attr,
356 	NULL,
357 };
358 ATTRIBUTE_GROUPS(gpio_keys);
359 
gpio_keys_gpio_report_event(struct gpio_button_data * bdata)360 static void gpio_keys_gpio_report_event(struct gpio_button_data *bdata)
361 {
362 	const struct gpio_keys_button *button = bdata->button;
363 	struct input_dev *input = bdata->input;
364 	unsigned int type = button->type ?: EV_KEY;
365 	int state;
366 
367 	state = bdata->debounce_use_hrtimer ?
368 			gpiod_get_value(bdata->gpiod) :
369 			gpiod_get_value_cansleep(bdata->gpiod);
370 	if (state < 0) {
371 		dev_err(input->dev.parent,
372 			"failed to get gpio state: %d\n", state);
373 		return;
374 	}
375 
376 	if (type == EV_ABS) {
377 		if (state)
378 			input_event(input, type, button->code, button->value);
379 	} else {
380 		input_event(input, type, *bdata->code, state);
381 	}
382 }
383 
gpio_keys_debounce_event(struct gpio_button_data * bdata)384 static void gpio_keys_debounce_event(struct gpio_button_data *bdata)
385 {
386 	gpio_keys_gpio_report_event(bdata);
387 	input_sync(bdata->input);
388 
389 	if (bdata->button->wakeup)
390 		pm_relax(bdata->input->dev.parent);
391 }
392 
gpio_keys_gpio_work_func(struct work_struct * work)393 static void gpio_keys_gpio_work_func(struct work_struct *work)
394 {
395 	struct gpio_button_data *bdata =
396 		container_of(work, struct gpio_button_data, work.work);
397 
398 	gpio_keys_debounce_event(bdata);
399 }
400 
gpio_keys_debounce_timer(struct hrtimer * t)401 static enum hrtimer_restart gpio_keys_debounce_timer(struct hrtimer *t)
402 {
403 	struct gpio_button_data *bdata =
404 		container_of(t, struct gpio_button_data, debounce_timer);
405 
406 	gpio_keys_debounce_event(bdata);
407 
408 	return HRTIMER_NORESTART;
409 }
410 
gpio_keys_gpio_isr(int irq,void * dev_id)411 static irqreturn_t gpio_keys_gpio_isr(int irq, void *dev_id)
412 {
413 	struct gpio_button_data *bdata = dev_id;
414 
415 	BUG_ON(irq != bdata->irq);
416 
417 	if (bdata->button->wakeup) {
418 		const struct gpio_keys_button *button = bdata->button;
419 
420 		pm_stay_awake(bdata->input->dev.parent);
421 		if (bdata->suspended  &&
422 		    (button->type == 0 || button->type == EV_KEY)) {
423 			/*
424 			 * Simulate wakeup key press in case the key has
425 			 * already released by the time we got interrupt
426 			 * handler to run.
427 			 */
428 			input_report_key(bdata->input, button->code, 1);
429 		}
430 	}
431 
432 	if (bdata->debounce_use_hrtimer) {
433 		hrtimer_start(&bdata->debounce_timer,
434 			      ms_to_ktime(bdata->software_debounce),
435 			      HRTIMER_MODE_REL);
436 	} else {
437 		mod_delayed_work(system_wq,
438 				 &bdata->work,
439 				 msecs_to_jiffies(bdata->software_debounce));
440 	}
441 
442 	return IRQ_HANDLED;
443 }
444 
gpio_keys_irq_timer(struct hrtimer * t)445 static enum hrtimer_restart gpio_keys_irq_timer(struct hrtimer *t)
446 {
447 	struct gpio_button_data *bdata = container_of(t,
448 						      struct gpio_button_data,
449 						      release_timer);
450 	struct input_dev *input = bdata->input;
451 
452 	if (bdata->key_pressed) {
453 		input_report_key(input, *bdata->code, 0);
454 		input_sync(input);
455 		bdata->key_pressed = false;
456 	}
457 
458 	return HRTIMER_NORESTART;
459 }
460 
gpio_keys_irq_isr(int irq,void * dev_id)461 static irqreturn_t gpio_keys_irq_isr(int irq, void *dev_id)
462 {
463 	struct gpio_button_data *bdata = dev_id;
464 	struct input_dev *input = bdata->input;
465 
466 	BUG_ON(irq != bdata->irq);
467 
468 	guard(spinlock_irqsave)(&bdata->lock);
469 
470 	if (!bdata->key_pressed) {
471 		if (bdata->button->wakeup)
472 			pm_wakeup_event(bdata->input->dev.parent, 0);
473 
474 		input_report_key(input, *bdata->code, 1);
475 		input_sync(input);
476 
477 		if (!bdata->release_delay) {
478 			input_report_key(input, *bdata->code, 0);
479 			input_sync(input);
480 			goto out;
481 		}
482 
483 		bdata->key_pressed = true;
484 	}
485 
486 	if (bdata->release_delay)
487 		hrtimer_start(&bdata->release_timer,
488 			      ms_to_ktime(bdata->release_delay),
489 			      HRTIMER_MODE_REL_HARD);
490 out:
491 	return IRQ_HANDLED;
492 }
493 
gpio_keys_setup_key(struct platform_device * pdev,struct input_dev * input,struct gpio_keys_drvdata * ddata,const struct gpio_keys_button * button,int idx,struct fwnode_handle * child)494 static int gpio_keys_setup_key(struct platform_device *pdev,
495 				struct input_dev *input,
496 				struct gpio_keys_drvdata *ddata,
497 				const struct gpio_keys_button *button,
498 				int idx,
499 				struct fwnode_handle *child)
500 {
501 	const char *desc = button->desc ? button->desc : "gpio_keys";
502 	struct device *dev = &pdev->dev;
503 	struct gpio_button_data *bdata = &ddata->data[idx];
504 	irq_handler_t isr;
505 	unsigned long irqflags;
506 	const char *wakedesc;
507 	int irq;
508 	int error;
509 
510 	bdata->input = input;
511 	bdata->button = button;
512 	spin_lock_init(&bdata->lock);
513 
514 	if (child) {
515 		bdata->gpiod = devm_fwnode_gpiod_get(dev, child,
516 						     NULL, GPIOD_IN, desc);
517 		if (IS_ERR(bdata->gpiod)) {
518 			error = PTR_ERR(bdata->gpiod);
519 			if (error != -ENOENT)
520 				return dev_err_probe(dev, error,
521 						     "failed to get gpio\n");
522 
523 			/*
524 			 * GPIO is optional, we may be dealing with
525 			 * purely interrupt-driven setup.
526 			 */
527 			bdata->gpiod = NULL;
528 		}
529 	} else if (gpio_is_valid(button->gpio)) {
530 		/*
531 		 * Legacy GPIO number, so request the GPIO here and
532 		 * convert it to descriptor.
533 		 */
534 		error = devm_gpio_request_one(dev, button->gpio, GPIOF_IN, desc);
535 		if (error < 0) {
536 			dev_err(dev, "Failed to request GPIO %d, error %d\n",
537 				button->gpio, error);
538 			return error;
539 		}
540 
541 		bdata->gpiod = gpio_to_desc(button->gpio);
542 		if (!bdata->gpiod)
543 			return -EINVAL;
544 
545 		if (button->active_low ^ gpiod_is_active_low(bdata->gpiod))
546 			gpiod_toggle_active_low(bdata->gpiod);
547 	}
548 
549 	if (bdata->gpiod) {
550 		bool active_low = gpiod_is_active_low(bdata->gpiod);
551 
552 		if (button->debounce_interval) {
553 			error = gpiod_set_debounce(bdata->gpiod,
554 					button->debounce_interval * 1000);
555 			/* use timer if gpiolib doesn't provide debounce */
556 			if (error < 0)
557 				bdata->software_debounce =
558 						button->debounce_interval;
559 
560 			/*
561 			 * If reading the GPIO won't sleep, we can use a
562 			 * hrtimer instead of a standard timer for the software
563 			 * debounce, to reduce the latency as much as possible.
564 			 */
565 			bdata->debounce_use_hrtimer =
566 					!gpiod_cansleep(bdata->gpiod);
567 		}
568 
569 		/*
570 		 * If an interrupt was specified, use it instead of the gpio
571 		 * interrupt and use the gpio for reading the state. A separate
572 		 * interrupt may be used as the main button interrupt for
573 		 * runtime PM to detect events also in deeper idle states. If a
574 		 * dedicated wakeirq is used for system suspend only, see below
575 		 * for bdata->wakeirq setup.
576 		 */
577 		if (button->irq) {
578 			bdata->irq = button->irq;
579 		} else {
580 			irq = gpiod_to_irq(bdata->gpiod);
581 			if (irq < 0) {
582 				error = irq;
583 				dev_err_probe(dev, error,
584 					      "Unable to get irq number for GPIO %d\n",
585 					      button->gpio);
586 				return error;
587 			}
588 			bdata->irq = irq;
589 		}
590 
591 		INIT_DELAYED_WORK(&bdata->work, gpio_keys_gpio_work_func);
592 
593 		hrtimer_setup(&bdata->debounce_timer, gpio_keys_debounce_timer,
594 			      CLOCK_REALTIME, HRTIMER_MODE_REL);
595 
596 		isr = gpio_keys_gpio_isr;
597 		irqflags = IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING;
598 
599 		switch (button->wakeup_event_action) {
600 		case EV_ACT_ASSERTED:
601 			bdata->wakeup_trigger_type = active_low ?
602 				IRQ_TYPE_EDGE_FALLING : IRQ_TYPE_EDGE_RISING;
603 			break;
604 		case EV_ACT_DEASSERTED:
605 			bdata->wakeup_trigger_type = active_low ?
606 				IRQ_TYPE_EDGE_RISING : IRQ_TYPE_EDGE_FALLING;
607 			break;
608 		case EV_ACT_ANY:
609 		default:
610 			/*
611 			 * For other cases, we are OK letting suspend/resume
612 			 * not reconfigure the trigger type.
613 			 */
614 			break;
615 		}
616 	} else {
617 		if (!button->irq) {
618 			dev_err(dev, "Found button without gpio or irq\n");
619 			return -EINVAL;
620 		}
621 
622 		bdata->irq = button->irq;
623 
624 		if (button->type && button->type != EV_KEY) {
625 			dev_err(dev, "Only EV_KEY allowed for IRQ buttons.\n");
626 			return -EINVAL;
627 		}
628 
629 		bdata->release_delay = button->debounce_interval;
630 		hrtimer_setup(&bdata->release_timer, gpio_keys_irq_timer,
631 			      CLOCK_REALTIME, HRTIMER_MODE_REL_HARD);
632 
633 		isr = gpio_keys_irq_isr;
634 		irqflags = 0;
635 
636 		/*
637 		 * For IRQ buttons, there is no interrupt for release.
638 		 * So we don't need to reconfigure the trigger type for wakeup.
639 		 */
640 	}
641 
642 	bdata->code = &ddata->keymap[idx];
643 	*bdata->code = button->code;
644 	input_set_capability(input, button->type ?: EV_KEY, *bdata->code);
645 
646 	/*
647 	 * Install custom action to cancel release timer and
648 	 * workqueue item.
649 	 */
650 	error = devm_add_action(dev, gpio_keys_quiesce_key, bdata);
651 	if (error) {
652 		dev_err(dev, "failed to register quiesce action, error: %d\n",
653 			error);
654 		return error;
655 	}
656 
657 	/*
658 	 * If platform has specified that the button can be disabled,
659 	 * we don't want it to share the interrupt line.
660 	 */
661 	if (!button->can_disable)
662 		irqflags |= IRQF_SHARED;
663 
664 	error = devm_request_any_context_irq(dev, bdata->irq, isr, irqflags,
665 					     desc, bdata);
666 	if (error < 0) {
667 		dev_err(dev, "Unable to claim irq %d; error %d\n",
668 			bdata->irq, error);
669 		return error;
670 	}
671 
672 	if (!button->wakeirq)
673 		return 0;
674 
675 	/* Use :wakeup suffix like drivers/base/power/wakeirq.c does */
676 	wakedesc = devm_kasprintf(dev, GFP_KERNEL, "%s:wakeup", desc);
677 	if (!wakedesc)
678 		return -ENOMEM;
679 
680 	bdata->wakeirq = button->wakeirq;
681 	irqflags |= IRQF_NO_SUSPEND;
682 
683 	/*
684 	 * Wakeirq shares the handler with the main interrupt, it's only
685 	 * active during system suspend. See gpio_keys_button_enable_wakeup()
686 	 * and gpio_keys_button_disable_wakeup().
687 	 */
688 	error = devm_request_any_context_irq(dev, bdata->wakeirq, isr,
689 					     irqflags, wakedesc, bdata);
690 	if (error < 0) {
691 		dev_err(dev, "Unable to claim wakeirq %d; error %d\n",
692 			bdata->irq, error);
693 		return error;
694 	}
695 
696 	/*
697 	 * Disable wakeirq until suspend. IRQF_NO_AUTOEN won't work if
698 	 * IRQF_SHARED was set based on !button->can_disable.
699 	 */
700 	disable_irq(bdata->wakeirq);
701 
702 	return 0;
703 }
704 
gpio_keys_report_state(struct gpio_keys_drvdata * ddata)705 static void gpio_keys_report_state(struct gpio_keys_drvdata *ddata)
706 {
707 	struct input_dev *input = ddata->input;
708 	int i;
709 
710 	for (i = 0; i < ddata->pdata->nbuttons; i++) {
711 		struct gpio_button_data *bdata = &ddata->data[i];
712 		if (bdata->gpiod)
713 			gpio_keys_gpio_report_event(bdata);
714 	}
715 	input_sync(input);
716 }
717 
gpio_keys_open(struct input_dev * input)718 static int gpio_keys_open(struct input_dev *input)
719 {
720 	struct gpio_keys_drvdata *ddata = input_get_drvdata(input);
721 	const struct gpio_keys_platform_data *pdata = ddata->pdata;
722 	int error;
723 
724 	if (pdata->enable) {
725 		error = pdata->enable(input->dev.parent);
726 		if (error)
727 			return error;
728 	}
729 
730 	/* Report current state of buttons that are connected to GPIOs */
731 	gpio_keys_report_state(ddata);
732 
733 	return 0;
734 }
735 
gpio_keys_close(struct input_dev * input)736 static void gpio_keys_close(struct input_dev *input)
737 {
738 	struct gpio_keys_drvdata *ddata = input_get_drvdata(input);
739 	const struct gpio_keys_platform_data *pdata = ddata->pdata;
740 
741 	if (pdata->disable)
742 		pdata->disable(input->dev.parent);
743 }
744 
745 /*
746  * Handlers for alternative sources of platform_data
747  */
748 
749 /*
750  * Translate properties into platform_data
751  */
752 static struct gpio_keys_platform_data *
gpio_keys_get_devtree_pdata(struct device * dev)753 gpio_keys_get_devtree_pdata(struct device *dev)
754 {
755 	struct gpio_keys_platform_data *pdata;
756 	struct gpio_keys_button *button;
757 	int nbuttons, irq;
758 
759 	nbuttons = device_get_child_node_count(dev);
760 	if (nbuttons == 0)
761 		return ERR_PTR(-ENODEV);
762 
763 	pdata = devm_kzalloc(dev,
764 			     sizeof(*pdata) + nbuttons * sizeof(*button),
765 			     GFP_KERNEL);
766 	if (!pdata)
767 		return ERR_PTR(-ENOMEM);
768 
769 	button = (struct gpio_keys_button *)(pdata + 1);
770 
771 	pdata->buttons = button;
772 	pdata->nbuttons = nbuttons;
773 
774 	pdata->rep = device_property_read_bool(dev, "autorepeat");
775 
776 	device_property_read_string(dev, "label", &pdata->name);
777 
778 	device_for_each_child_node_scoped(dev, child) {
779 		if (is_of_node(child)) {
780 			irq = of_irq_get_byname(to_of_node(child), "irq");
781 			if (irq > 0)
782 				button->irq = irq;
783 
784 			irq = of_irq_get_byname(to_of_node(child), "wakeup");
785 			if (irq > 0)
786 				button->wakeirq = irq;
787 
788 			if (!button->irq && !button->wakeirq)
789 				button->irq =
790 					irq_of_parse_and_map(to_of_node(child), 0);
791 		}
792 
793 		if (fwnode_property_read_u32(child, "linux,code",
794 					     &button->code)) {
795 			dev_err(dev, "Button without keycode\n");
796 			return ERR_PTR(-EINVAL);
797 		}
798 
799 		fwnode_property_read_string(child, "label", &button->desc);
800 
801 		if (fwnode_property_read_u32(child, "linux,input-type",
802 					     &button->type))
803 			button->type = EV_KEY;
804 
805 		fwnode_property_read_u32(child, "linux,input-value",
806 					 (u32 *)&button->value);
807 
808 		button->wakeup =
809 			fwnode_property_read_bool(child, "wakeup-source") ||
810 			/* legacy name */
811 			fwnode_property_read_bool(child, "gpio-key,wakeup");
812 
813 		fwnode_property_read_u32(child, "wakeup-event-action",
814 					 &button->wakeup_event_action);
815 
816 		button->can_disable =
817 			fwnode_property_read_bool(child, "linux,can-disable");
818 
819 		if (fwnode_property_read_u32(child, "debounce-interval",
820 					 &button->debounce_interval))
821 			button->debounce_interval = 5;
822 
823 		button++;
824 	}
825 
826 	return pdata;
827 }
828 
829 static const struct of_device_id gpio_keys_of_match[] = {
830 	{ .compatible = "gpio-keys", },
831 	{ },
832 };
833 MODULE_DEVICE_TABLE(of, gpio_keys_of_match);
834 
gpio_keys_probe(struct platform_device * pdev)835 static int gpio_keys_probe(struct platform_device *pdev)
836 {
837 	struct device *dev = &pdev->dev;
838 	const struct gpio_keys_platform_data *pdata = dev_get_platdata(dev);
839 	struct fwnode_handle *child = NULL;
840 	struct gpio_keys_drvdata *ddata;
841 	struct input_dev *input;
842 	int i, error;
843 	int wakeup = 0;
844 
845 	if (!pdata) {
846 		pdata = gpio_keys_get_devtree_pdata(dev);
847 		if (IS_ERR(pdata))
848 			return PTR_ERR(pdata);
849 	}
850 
851 	ddata = devm_kzalloc(dev, struct_size(ddata, data, pdata->nbuttons),
852 			     GFP_KERNEL);
853 	if (!ddata) {
854 		dev_err(dev, "failed to allocate state\n");
855 		return -ENOMEM;
856 	}
857 
858 	ddata->keymap = devm_kcalloc(dev,
859 				     pdata->nbuttons, sizeof(ddata->keymap[0]),
860 				     GFP_KERNEL);
861 	if (!ddata->keymap)
862 		return -ENOMEM;
863 
864 	input = devm_input_allocate_device(dev);
865 	if (!input) {
866 		dev_err(dev, "failed to allocate input device\n");
867 		return -ENOMEM;
868 	}
869 
870 	ddata->pdata = pdata;
871 	ddata->input = input;
872 	mutex_init(&ddata->disable_lock);
873 
874 	platform_set_drvdata(pdev, ddata);
875 	input_set_drvdata(input, ddata);
876 
877 	input->name = pdata->name ? : pdev->name;
878 	input->phys = "gpio-keys/input0";
879 	input->dev.parent = dev;
880 	input->open = gpio_keys_open;
881 	input->close = gpio_keys_close;
882 
883 	input->id.bustype = BUS_HOST;
884 	input->id.vendor = 0x0001;
885 	input->id.product = 0x0001;
886 	input->id.version = 0x0100;
887 
888 	input->keycode = ddata->keymap;
889 	input->keycodesize = sizeof(ddata->keymap[0]);
890 	input->keycodemax = pdata->nbuttons;
891 
892 	/* Enable auto repeat feature of Linux input subsystem */
893 	if (pdata->rep)
894 		__set_bit(EV_REP, input->evbit);
895 
896 	for (i = 0; i < pdata->nbuttons; i++) {
897 		const struct gpio_keys_button *button = &pdata->buttons[i];
898 
899 		if (!dev_get_platdata(dev)) {
900 			child = device_get_next_child_node(dev, child);
901 			if (!child) {
902 				dev_err(dev,
903 					"missing child device node for entry %d\n",
904 					i);
905 				return -EINVAL;
906 			}
907 		}
908 
909 		error = gpio_keys_setup_key(pdev, input, ddata,
910 					    button, i, child);
911 		if (error) {
912 			fwnode_handle_put(child);
913 			return error;
914 		}
915 
916 		if (button->wakeup)
917 			wakeup = 1;
918 	}
919 
920 	fwnode_handle_put(child);
921 
922 	error = input_register_device(input);
923 	if (error) {
924 		dev_err(dev, "Unable to register input device, error: %d\n",
925 			error);
926 		return error;
927 	}
928 
929 	device_init_wakeup(dev, wakeup);
930 
931 	return 0;
932 }
933 
934 static int __maybe_unused
gpio_keys_button_enable_wakeup(struct gpio_button_data * bdata)935 gpio_keys_button_enable_wakeup(struct gpio_button_data *bdata)
936 {
937 	int error;
938 
939 	error = enable_irq_wake(bdata->irq);
940 	if (error) {
941 		dev_err(bdata->input->dev.parent,
942 			"failed to configure IRQ %d as wakeup source: %d\n",
943 			bdata->irq, error);
944 		return error;
945 	}
946 
947 	if (bdata->wakeup_trigger_type) {
948 		error = irq_set_irq_type(bdata->irq,
949 					 bdata->wakeup_trigger_type);
950 		if (error) {
951 			dev_err(bdata->input->dev.parent,
952 				"failed to set wakeup trigger %08x for IRQ %d: %d\n",
953 				bdata->wakeup_trigger_type, bdata->irq, error);
954 			disable_irq_wake(bdata->irq);
955 			return error;
956 		}
957 	}
958 
959 	if (bdata->wakeirq) {
960 		enable_irq(bdata->wakeirq);
961 		disable_irq(bdata->irq);
962 	}
963 
964 	return 0;
965 }
966 
967 static void __maybe_unused
gpio_keys_button_disable_wakeup(struct gpio_button_data * bdata)968 gpio_keys_button_disable_wakeup(struct gpio_button_data *bdata)
969 {
970 	int error;
971 
972 	if (bdata->wakeirq) {
973 		enable_irq(bdata->irq);
974 		disable_irq(bdata->wakeirq);
975 	}
976 
977 	/*
978 	 * The trigger type is always both edges for gpio-based keys and we do
979 	 * not support changing wakeup trigger for interrupt-based keys.
980 	 */
981 	if (bdata->wakeup_trigger_type) {
982 		error = irq_set_irq_type(bdata->irq, IRQ_TYPE_EDGE_BOTH);
983 		if (error)
984 			dev_warn(bdata->input->dev.parent,
985 				 "failed to restore interrupt trigger for IRQ %d: %d\n",
986 				 bdata->irq, error);
987 	}
988 
989 	error = disable_irq_wake(bdata->irq);
990 	if (error)
991 		dev_warn(bdata->input->dev.parent,
992 			 "failed to disable IRQ %d as wake source: %d\n",
993 			 bdata->irq, error);
994 }
995 
996 static int __maybe_unused
gpio_keys_enable_wakeup(struct gpio_keys_drvdata * ddata)997 gpio_keys_enable_wakeup(struct gpio_keys_drvdata *ddata)
998 {
999 	struct gpio_button_data *bdata;
1000 	int error;
1001 	int i;
1002 
1003 	for (i = 0; i < ddata->pdata->nbuttons; i++) {
1004 		bdata = &ddata->data[i];
1005 		if (bdata->button->wakeup) {
1006 			error = gpio_keys_button_enable_wakeup(bdata);
1007 			if (error)
1008 				goto err_out;
1009 		}
1010 		bdata->suspended = true;
1011 	}
1012 
1013 	return 0;
1014 
1015 err_out:
1016 	while (i--) {
1017 		bdata = &ddata->data[i];
1018 		if (bdata->button->wakeup)
1019 			gpio_keys_button_disable_wakeup(bdata);
1020 		bdata->suspended = false;
1021 	}
1022 
1023 	return error;
1024 }
1025 
1026 static void __maybe_unused
gpio_keys_disable_wakeup(struct gpio_keys_drvdata * ddata)1027 gpio_keys_disable_wakeup(struct gpio_keys_drvdata *ddata)
1028 {
1029 	struct gpio_button_data *bdata;
1030 	int i;
1031 
1032 	for (i = 0; i < ddata->pdata->nbuttons; i++) {
1033 		bdata = &ddata->data[i];
1034 		bdata->suspended = false;
1035 		if (irqd_is_wakeup_set(irq_get_irq_data(bdata->irq)))
1036 			gpio_keys_button_disable_wakeup(bdata);
1037 	}
1038 }
1039 
gpio_keys_suspend(struct device * dev)1040 static int gpio_keys_suspend(struct device *dev)
1041 {
1042 	struct gpio_keys_drvdata *ddata = dev_get_drvdata(dev);
1043 	struct input_dev *input = ddata->input;
1044 	int error;
1045 
1046 	if (device_may_wakeup(dev)) {
1047 		error = gpio_keys_enable_wakeup(ddata);
1048 		if (error)
1049 			return error;
1050 	} else {
1051 		guard(mutex)(&input->mutex);
1052 
1053 		if (input_device_enabled(input))
1054 			gpio_keys_close(input);
1055 	}
1056 
1057 	return 0;
1058 }
1059 
gpio_keys_resume(struct device * dev)1060 static int gpio_keys_resume(struct device *dev)
1061 {
1062 	struct gpio_keys_drvdata *ddata = dev_get_drvdata(dev);
1063 	struct input_dev *input = ddata->input;
1064 	int error;
1065 
1066 	if (device_may_wakeup(dev)) {
1067 		gpio_keys_disable_wakeup(ddata);
1068 	} else {
1069 		guard(mutex)(&input->mutex);
1070 
1071 		if (input_device_enabled(input)) {
1072 			error = gpio_keys_open(input);
1073 			if (error)
1074 				return error;
1075 		}
1076 	}
1077 
1078 	gpio_keys_report_state(ddata);
1079 	return 0;
1080 }
1081 
1082 static DEFINE_SIMPLE_DEV_PM_OPS(gpio_keys_pm_ops, gpio_keys_suspend, gpio_keys_resume);
1083 
gpio_keys_shutdown(struct platform_device * pdev)1084 static void gpio_keys_shutdown(struct platform_device *pdev)
1085 {
1086 	int ret;
1087 
1088 	ret = gpio_keys_suspend(&pdev->dev);
1089 	if (ret)
1090 		dev_err(&pdev->dev, "failed to shutdown\n");
1091 }
1092 
1093 static struct platform_driver gpio_keys_device_driver = {
1094 	.probe		= gpio_keys_probe,
1095 	.shutdown	= gpio_keys_shutdown,
1096 	.driver		= {
1097 		.name	= "gpio-keys",
1098 		.pm	= pm_sleep_ptr(&gpio_keys_pm_ops),
1099 		.of_match_table = gpio_keys_of_match,
1100 		.dev_groups	= gpio_keys_groups,
1101 	}
1102 };
1103 
gpio_keys_init(void)1104 static int __init gpio_keys_init(void)
1105 {
1106 	return platform_driver_register(&gpio_keys_device_driver);
1107 }
1108 
gpio_keys_exit(void)1109 static void __exit gpio_keys_exit(void)
1110 {
1111 	platform_driver_unregister(&gpio_keys_device_driver);
1112 }
1113 
1114 late_initcall(gpio_keys_init);
1115 module_exit(gpio_keys_exit);
1116 
1117 MODULE_LICENSE("GPL");
1118 MODULE_AUTHOR("Phil Blundell <pb@handhelds.org>");
1119 MODULE_DESCRIPTION("Keyboard driver for GPIOs");
1120 MODULE_ALIAS("platform:gpio-keys");
1121