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 */ 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 */ 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 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 */ 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 */ 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 */ 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 */ 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 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 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 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 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 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 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 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 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 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 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 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 * 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 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 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 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 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 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 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 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 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 1104 static int __init gpio_keys_init(void) 1105 { 1106 return platform_driver_register(&gpio_keys_device_driver); 1107 } 1108 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