178a56aabSPhil Blundell /* 278a56aabSPhil Blundell * Driver for keys on GPIO lines capable of generating interrupts. 378a56aabSPhil Blundell * 478a56aabSPhil Blundell * Copyright 2005 Phil Blundell 5fd05d089SDavid Jander * Copyright 2010, 2011 David Jander <david@protonic.nl> 678a56aabSPhil Blundell * 778a56aabSPhil Blundell * This program is free software; you can redistribute it and/or modify 878a56aabSPhil Blundell * it under the terms of the GNU General Public License version 2 as 978a56aabSPhil Blundell * published by the Free Software Foundation. 1078a56aabSPhil Blundell */ 1178a56aabSPhil Blundell 1278a56aabSPhil Blundell #include <linux/module.h> 1378a56aabSPhil Blundell 1478a56aabSPhil Blundell #include <linux/init.h> 1578a56aabSPhil Blundell #include <linux/fs.h> 1678a56aabSPhil Blundell #include <linux/interrupt.h> 1778a56aabSPhil Blundell #include <linux/irq.h> 1878a56aabSPhil Blundell #include <linux/sched.h> 1978a56aabSPhil Blundell #include <linux/pm.h> 205a0e3ad6STejun Heo #include <linux/slab.h> 2178a56aabSPhil Blundell #include <linux/sysctl.h> 2278a56aabSPhil Blundell #include <linux/proc_fs.h> 2378a56aabSPhil Blundell #include <linux/delay.h> 2478a56aabSPhil Blundell #include <linux/platform_device.h> 2578a56aabSPhil Blundell #include <linux/input.h> 2649015beeSDavid Brownell #include <linux/gpio_keys.h> 27da0d03feSJani Nikula #include <linux/workqueue.h> 28111bc59cSBen Dooks #include <linux/gpio.h> 29415a4caaSSachin Kamat #include <linux/of.h> 30fd05d089SDavid Jander #include <linux/of_platform.h> 31fd05d089SDavid Jander #include <linux/of_gpio.h> 32f2d347ffSAlexander Stein #include <linux/of_irq.h> 33d8ee4a1cSLaxman Dewangan #include <linux/spinlock.h> 3478a56aabSPhil Blundell 35a33466e3SDmitry Baryshkov struct gpio_button_data { 36d9080921SDmitry Torokhov const struct gpio_keys_button *button; 37a33466e3SDmitry Baryshkov struct input_dev *input; 388ed92556SDmitry Torokhov 398ed92556SDmitry Torokhov struct timer_list release_timer; 408ed92556SDmitry Torokhov unsigned int release_delay; /* in msecs, for IRQ-only buttons */ 418ed92556SDmitry Torokhov 428ed92556SDmitry Torokhov struct delayed_work work; 438ed92556SDmitry Torokhov unsigned int software_debounce; /* in msecs, for GPIO-driven buttons */ 448ed92556SDmitry Torokhov 45d8ee4a1cSLaxman Dewangan unsigned int irq; 46d8ee4a1cSLaxman Dewangan spinlock_t lock; 479e3af04fSMika Westerberg bool disabled; 48d8ee4a1cSLaxman Dewangan bool key_pressed; 49a33466e3SDmitry Baryshkov }; 50a33466e3SDmitry Baryshkov 51a33466e3SDmitry Baryshkov struct gpio_keys_drvdata { 52219edc71SAlexandre Pereira da Silva const struct gpio_keys_platform_data *pdata; 53a33466e3SDmitry Baryshkov struct input_dev *input; 549e3af04fSMika Westerberg struct mutex disable_lock; 55a33466e3SDmitry Baryshkov struct gpio_button_data data[0]; 56a33466e3SDmitry Baryshkov }; 57a33466e3SDmitry Baryshkov 589e3af04fSMika Westerberg /* 599e3af04fSMika Westerberg * SYSFS interface for enabling/disabling keys and switches: 609e3af04fSMika Westerberg * 619e3af04fSMika Westerberg * There are 4 attributes under /sys/devices/platform/gpio-keys/ 629e3af04fSMika Westerberg * keys [ro] - bitmap of keys (EV_KEY) which can be 639e3af04fSMika Westerberg * disabled 649e3af04fSMika Westerberg * switches [ro] - bitmap of switches (EV_SW) which can be 659e3af04fSMika Westerberg * disabled 669e3af04fSMika Westerberg * disabled_keys [rw] - bitmap of keys currently disabled 679e3af04fSMika Westerberg * disabled_switches [rw] - bitmap of switches currently disabled 689e3af04fSMika Westerberg * 699e3af04fSMika Westerberg * Userland can change these values and hence disable event generation 709e3af04fSMika Westerberg * for each key (or switch). Disabling a key means its interrupt line 719e3af04fSMika Westerberg * is disabled. 729e3af04fSMika Westerberg * 739e3af04fSMika Westerberg * For example, if we have following switches set up as gpio-keys: 749e3af04fSMika Westerberg * SW_DOCK = 5 759e3af04fSMika Westerberg * SW_CAMERA_LENS_COVER = 9 769e3af04fSMika Westerberg * SW_KEYPAD_SLIDE = 10 779e3af04fSMika Westerberg * SW_FRONT_PROXIMITY = 11 789e3af04fSMika Westerberg * This is read from switches: 799e3af04fSMika Westerberg * 11-9,5 809e3af04fSMika Westerberg * Next we want to disable proximity (11) and dock (5), we write: 819e3af04fSMika Westerberg * 11,5 829e3af04fSMika Westerberg * to file disabled_switches. Now proximity and dock IRQs are disabled. 839e3af04fSMika Westerberg * This can be verified by reading the file disabled_switches: 849e3af04fSMika Westerberg * 11,5 859e3af04fSMika Westerberg * If we now want to enable proximity (11) switch we write: 869e3af04fSMika Westerberg * 5 879e3af04fSMika Westerberg * to disabled_switches. 889e3af04fSMika Westerberg * 899e3af04fSMika Westerberg * We can disable only those keys which don't allow sharing the irq. 909e3af04fSMika Westerberg */ 919e3af04fSMika Westerberg 929e3af04fSMika Westerberg /** 939e3af04fSMika Westerberg * get_n_events_by_type() - returns maximum number of events per @type 949e3af04fSMika Westerberg * @type: type of button (%EV_KEY, %EV_SW) 959e3af04fSMika Westerberg * 969e3af04fSMika Westerberg * Return value of this function can be used to allocate bitmap 979e3af04fSMika Westerberg * large enough to hold all bits for given type. 989e3af04fSMika Westerberg */ 999e3af04fSMika Westerberg static inline int get_n_events_by_type(int type) 1009e3af04fSMika Westerberg { 1019e3af04fSMika Westerberg BUG_ON(type != EV_SW && type != EV_KEY); 1029e3af04fSMika Westerberg 1039e3af04fSMika Westerberg return (type == EV_KEY) ? KEY_CNT : SW_CNT; 1049e3af04fSMika Westerberg } 1059e3af04fSMika Westerberg 1069e3af04fSMika Westerberg /** 1079e3af04fSMika Westerberg * gpio_keys_disable_button() - disables given GPIO button 1089e3af04fSMika Westerberg * @bdata: button data for button to be disabled 1099e3af04fSMika Westerberg * 1109e3af04fSMika Westerberg * Disables button pointed by @bdata. This is done by masking 1119e3af04fSMika Westerberg * IRQ line. After this function is called, button won't generate 1129e3af04fSMika Westerberg * input events anymore. Note that one can only disable buttons 1139e3af04fSMika Westerberg * that don't share IRQs. 1149e3af04fSMika Westerberg * 1159e3af04fSMika Westerberg * Make sure that @bdata->disable_lock is locked when entering 1169e3af04fSMika Westerberg * this function to avoid races when concurrent threads are 1179e3af04fSMika Westerberg * disabling buttons at the same time. 1189e3af04fSMika Westerberg */ 1199e3af04fSMika Westerberg static void gpio_keys_disable_button(struct gpio_button_data *bdata) 1209e3af04fSMika Westerberg { 1219e3af04fSMika Westerberg if (!bdata->disabled) { 1229e3af04fSMika Westerberg /* 1238ed92556SDmitry Torokhov * Disable IRQ and associated timer/work structure. 1249e3af04fSMika Westerberg */ 125d8ee4a1cSLaxman Dewangan disable_irq(bdata->irq); 1268ed92556SDmitry Torokhov 1278ed92556SDmitry Torokhov if (gpio_is_valid(bdata->button->gpio)) 1288ed92556SDmitry Torokhov cancel_delayed_work_sync(&bdata->work); 1298ed92556SDmitry Torokhov else 1308ed92556SDmitry Torokhov del_timer_sync(&bdata->release_timer); 1319e3af04fSMika Westerberg 1329e3af04fSMika Westerberg bdata->disabled = true; 1339e3af04fSMika Westerberg } 1349e3af04fSMika Westerberg } 1359e3af04fSMika Westerberg 1369e3af04fSMika Westerberg /** 1379e3af04fSMika Westerberg * gpio_keys_enable_button() - enables given GPIO button 1389e3af04fSMika Westerberg * @bdata: button data for button to be disabled 1399e3af04fSMika Westerberg * 1409e3af04fSMika Westerberg * Enables given button pointed by @bdata. 1419e3af04fSMika Westerberg * 1429e3af04fSMika Westerberg * Make sure that @bdata->disable_lock is locked when entering 1439e3af04fSMika Westerberg * this function to avoid races with concurrent threads trying 1449e3af04fSMika Westerberg * to enable the same button at the same time. 1459e3af04fSMika Westerberg */ 1469e3af04fSMika Westerberg static void gpio_keys_enable_button(struct gpio_button_data *bdata) 1479e3af04fSMika Westerberg { 1489e3af04fSMika Westerberg if (bdata->disabled) { 149d8ee4a1cSLaxman Dewangan enable_irq(bdata->irq); 1509e3af04fSMika Westerberg bdata->disabled = false; 1519e3af04fSMika Westerberg } 1529e3af04fSMika Westerberg } 1539e3af04fSMika Westerberg 1549e3af04fSMika Westerberg /** 1559e3af04fSMika Westerberg * gpio_keys_attr_show_helper() - fill in stringified bitmap of buttons 1569e3af04fSMika Westerberg * @ddata: pointer to drvdata 1579e3af04fSMika Westerberg * @buf: buffer where stringified bitmap is written 1589e3af04fSMika Westerberg * @type: button type (%EV_KEY, %EV_SW) 1599e3af04fSMika Westerberg * @only_disabled: does caller want only those buttons that are 1609e3af04fSMika Westerberg * currently disabled or all buttons that can be 1619e3af04fSMika Westerberg * disabled 1629e3af04fSMika Westerberg * 1639e3af04fSMika Westerberg * This function writes buttons that can be disabled to @buf. If 1649e3af04fSMika Westerberg * @only_disabled is true, then @buf contains only those buttons 1659e3af04fSMika Westerberg * that are currently disabled. Returns 0 on success or negative 1669e3af04fSMika Westerberg * errno on failure. 1679e3af04fSMika Westerberg */ 1689e3af04fSMika Westerberg static ssize_t gpio_keys_attr_show_helper(struct gpio_keys_drvdata *ddata, 1699e3af04fSMika Westerberg char *buf, unsigned int type, 1709e3af04fSMika Westerberg bool only_disabled) 1719e3af04fSMika Westerberg { 1729e3af04fSMika Westerberg int n_events = get_n_events_by_type(type); 1739e3af04fSMika Westerberg unsigned long *bits; 1749e3af04fSMika Westerberg ssize_t ret; 1759e3af04fSMika Westerberg int i; 1769e3af04fSMika Westerberg 1779e3af04fSMika Westerberg bits = kcalloc(BITS_TO_LONGS(n_events), sizeof(*bits), GFP_KERNEL); 1789e3af04fSMika Westerberg if (!bits) 1799e3af04fSMika Westerberg return -ENOMEM; 1809e3af04fSMika Westerberg 181219edc71SAlexandre Pereira da Silva for (i = 0; i < ddata->pdata->nbuttons; i++) { 1829e3af04fSMika Westerberg struct gpio_button_data *bdata = &ddata->data[i]; 1839e3af04fSMika Westerberg 1849e3af04fSMika Westerberg if (bdata->button->type != type) 1859e3af04fSMika Westerberg continue; 1869e3af04fSMika Westerberg 1879e3af04fSMika Westerberg if (only_disabled && !bdata->disabled) 1889e3af04fSMika Westerberg continue; 1899e3af04fSMika Westerberg 1909e3af04fSMika Westerberg __set_bit(bdata->button->code, bits); 1919e3af04fSMika Westerberg } 1929e3af04fSMika Westerberg 1930b480037STejun Heo ret = scnprintf(buf, PAGE_SIZE - 1, "%*pbl", n_events, bits); 1949e3af04fSMika Westerberg buf[ret++] = '\n'; 1959e3af04fSMika Westerberg buf[ret] = '\0'; 1969e3af04fSMika Westerberg 1979e3af04fSMika Westerberg kfree(bits); 1989e3af04fSMika Westerberg 1999e3af04fSMika Westerberg return ret; 2009e3af04fSMika Westerberg } 2019e3af04fSMika Westerberg 2029e3af04fSMika Westerberg /** 2039e3af04fSMika Westerberg * gpio_keys_attr_store_helper() - enable/disable buttons based on given bitmap 2049e3af04fSMika Westerberg * @ddata: pointer to drvdata 2059e3af04fSMika Westerberg * @buf: buffer from userspace that contains stringified bitmap 2069e3af04fSMika Westerberg * @type: button type (%EV_KEY, %EV_SW) 2079e3af04fSMika Westerberg * 2089e3af04fSMika Westerberg * This function parses stringified bitmap from @buf and disables/enables 209a16ca239SDmitry Torokhov * GPIO buttons accordingly. Returns 0 on success and negative error 2109e3af04fSMika Westerberg * on failure. 2119e3af04fSMika Westerberg */ 2129e3af04fSMika Westerberg static ssize_t gpio_keys_attr_store_helper(struct gpio_keys_drvdata *ddata, 2139e3af04fSMika Westerberg const char *buf, unsigned int type) 2149e3af04fSMika Westerberg { 2159e3af04fSMika Westerberg int n_events = get_n_events_by_type(type); 2169e3af04fSMika Westerberg unsigned long *bits; 2179e3af04fSMika Westerberg ssize_t error; 2189e3af04fSMika Westerberg int i; 2199e3af04fSMika Westerberg 2209e3af04fSMika Westerberg bits = kcalloc(BITS_TO_LONGS(n_events), sizeof(*bits), GFP_KERNEL); 2219e3af04fSMika Westerberg if (!bits) 2229e3af04fSMika Westerberg return -ENOMEM; 2239e3af04fSMika Westerberg 2249e3af04fSMika Westerberg error = bitmap_parselist(buf, bits, n_events); 2259e3af04fSMika Westerberg if (error) 2269e3af04fSMika Westerberg goto out; 2279e3af04fSMika Westerberg 2289e3af04fSMika Westerberg /* First validate */ 229219edc71SAlexandre Pereira da Silva for (i = 0; i < ddata->pdata->nbuttons; i++) { 2309e3af04fSMika Westerberg struct gpio_button_data *bdata = &ddata->data[i]; 2319e3af04fSMika Westerberg 2329e3af04fSMika Westerberg if (bdata->button->type != type) 2339e3af04fSMika Westerberg continue; 2349e3af04fSMika Westerberg 2359e3af04fSMika Westerberg if (test_bit(bdata->button->code, bits) && 2369e3af04fSMika Westerberg !bdata->button->can_disable) { 2379e3af04fSMika Westerberg error = -EINVAL; 2389e3af04fSMika Westerberg goto out; 2399e3af04fSMika Westerberg } 2409e3af04fSMika Westerberg } 2419e3af04fSMika Westerberg 2424ea14a53SPeng Fan if (i == ddata->pdata->nbuttons) { 2434ea14a53SPeng Fan error = -EINVAL; 2444ea14a53SPeng Fan goto out; 2454ea14a53SPeng Fan } 2464ea14a53SPeng Fan 2479e3af04fSMika Westerberg mutex_lock(&ddata->disable_lock); 2489e3af04fSMika Westerberg 249219edc71SAlexandre Pereira da Silva for (i = 0; i < ddata->pdata->nbuttons; i++) { 2509e3af04fSMika Westerberg struct gpio_button_data *bdata = &ddata->data[i]; 2519e3af04fSMika Westerberg 2529e3af04fSMika Westerberg if (bdata->button->type != type) 2539e3af04fSMika Westerberg continue; 2549e3af04fSMika Westerberg 2559e3af04fSMika Westerberg if (test_bit(bdata->button->code, bits)) 2569e3af04fSMika Westerberg gpio_keys_disable_button(bdata); 2579e3af04fSMika Westerberg else 2589e3af04fSMika Westerberg gpio_keys_enable_button(bdata); 2599e3af04fSMika Westerberg } 2609e3af04fSMika Westerberg 2619e3af04fSMika Westerberg mutex_unlock(&ddata->disable_lock); 2629e3af04fSMika Westerberg 2639e3af04fSMika Westerberg out: 2649e3af04fSMika Westerberg kfree(bits); 2659e3af04fSMika Westerberg return error; 2669e3af04fSMika Westerberg } 2679e3af04fSMika Westerberg 2689e3af04fSMika Westerberg #define ATTR_SHOW_FN(name, type, only_disabled) \ 2699e3af04fSMika Westerberg static ssize_t gpio_keys_show_##name(struct device *dev, \ 2709e3af04fSMika Westerberg struct device_attribute *attr, \ 2719e3af04fSMika Westerberg char *buf) \ 2729e3af04fSMika Westerberg { \ 2739e3af04fSMika Westerberg struct platform_device *pdev = to_platform_device(dev); \ 2749e3af04fSMika Westerberg struct gpio_keys_drvdata *ddata = platform_get_drvdata(pdev); \ 2759e3af04fSMika Westerberg \ 2769e3af04fSMika Westerberg return gpio_keys_attr_show_helper(ddata, buf, \ 2779e3af04fSMika Westerberg type, only_disabled); \ 2789e3af04fSMika Westerberg } 2799e3af04fSMika Westerberg 2809e3af04fSMika Westerberg ATTR_SHOW_FN(keys, EV_KEY, false); 2819e3af04fSMika Westerberg ATTR_SHOW_FN(switches, EV_SW, false); 2829e3af04fSMika Westerberg ATTR_SHOW_FN(disabled_keys, EV_KEY, true); 2839e3af04fSMika Westerberg ATTR_SHOW_FN(disabled_switches, EV_SW, true); 2849e3af04fSMika Westerberg 2859e3af04fSMika Westerberg /* 2869e3af04fSMika Westerberg * ATTRIBUTES: 2879e3af04fSMika Westerberg * 2889e3af04fSMika Westerberg * /sys/devices/platform/gpio-keys/keys [ro] 2899e3af04fSMika Westerberg * /sys/devices/platform/gpio-keys/switches [ro] 2909e3af04fSMika Westerberg */ 2919e3af04fSMika Westerberg static DEVICE_ATTR(keys, S_IRUGO, gpio_keys_show_keys, NULL); 2929e3af04fSMika Westerberg static DEVICE_ATTR(switches, S_IRUGO, gpio_keys_show_switches, NULL); 2939e3af04fSMika Westerberg 2949e3af04fSMika Westerberg #define ATTR_STORE_FN(name, type) \ 2959e3af04fSMika Westerberg static ssize_t gpio_keys_store_##name(struct device *dev, \ 2969e3af04fSMika Westerberg struct device_attribute *attr, \ 2979e3af04fSMika Westerberg const char *buf, \ 2989e3af04fSMika Westerberg size_t count) \ 2999e3af04fSMika Westerberg { \ 3009e3af04fSMika Westerberg struct platform_device *pdev = to_platform_device(dev); \ 3019e3af04fSMika Westerberg struct gpio_keys_drvdata *ddata = platform_get_drvdata(pdev); \ 3029e3af04fSMika Westerberg ssize_t error; \ 3039e3af04fSMika Westerberg \ 3049e3af04fSMika Westerberg error = gpio_keys_attr_store_helper(ddata, buf, type); \ 3059e3af04fSMika Westerberg if (error) \ 3069e3af04fSMika Westerberg return error; \ 3079e3af04fSMika Westerberg \ 3089e3af04fSMika Westerberg return count; \ 3099e3af04fSMika Westerberg } 3109e3af04fSMika Westerberg 3119e3af04fSMika Westerberg ATTR_STORE_FN(disabled_keys, EV_KEY); 3129e3af04fSMika Westerberg ATTR_STORE_FN(disabled_switches, EV_SW); 3139e3af04fSMika Westerberg 3149e3af04fSMika Westerberg /* 3159e3af04fSMika Westerberg * ATTRIBUTES: 3169e3af04fSMika Westerberg * 3179e3af04fSMika Westerberg * /sys/devices/platform/gpio-keys/disabled_keys [rw] 3189e3af04fSMika Westerberg * /sys/devices/platform/gpio-keys/disables_switches [rw] 3199e3af04fSMika Westerberg */ 3209e3af04fSMika Westerberg static DEVICE_ATTR(disabled_keys, S_IWUSR | S_IRUGO, 3219e3af04fSMika Westerberg gpio_keys_show_disabled_keys, 3229e3af04fSMika Westerberg gpio_keys_store_disabled_keys); 3239e3af04fSMika Westerberg static DEVICE_ATTR(disabled_switches, S_IWUSR | S_IRUGO, 3249e3af04fSMika Westerberg gpio_keys_show_disabled_switches, 3259e3af04fSMika Westerberg gpio_keys_store_disabled_switches); 3269e3af04fSMika Westerberg 3279e3af04fSMika Westerberg static struct attribute *gpio_keys_attrs[] = { 3289e3af04fSMika Westerberg &dev_attr_keys.attr, 3299e3af04fSMika Westerberg &dev_attr_switches.attr, 3309e3af04fSMika Westerberg &dev_attr_disabled_keys.attr, 3319e3af04fSMika Westerberg &dev_attr_disabled_switches.attr, 3329e3af04fSMika Westerberg NULL, 3339e3af04fSMika Westerberg }; 3349e3af04fSMika Westerberg 3359e3af04fSMika Westerberg static struct attribute_group gpio_keys_attr_group = { 3369e3af04fSMika Westerberg .attrs = gpio_keys_attrs, 3379e3af04fSMika Westerberg }; 3389e3af04fSMika Westerberg 339d8ee4a1cSLaxman Dewangan static void gpio_keys_gpio_report_event(struct gpio_button_data *bdata) 34078a56aabSPhil Blundell { 341d9080921SDmitry Torokhov const struct gpio_keys_button *button = bdata->button; 342ce25d7e9SUwe Kleine-König struct input_dev *input = bdata->input; 34384767d00SRoman Moravcik unsigned int type = button->type ?: EV_KEY; 344*77fa0554SBjorn Andersson int state = gpio_get_value_cansleep(button->gpio); 34584767d00SRoman Moravcik 346*77fa0554SBjorn Andersson if (state < 0) { 347*77fa0554SBjorn Andersson dev_err(input->dev.parent, "failed to get gpio state\n"); 348*77fa0554SBjorn Andersson return; 349*77fa0554SBjorn Andersson } 350*77fa0554SBjorn Andersson 351*77fa0554SBjorn Andersson state = (state ? 1 : 0) ^ button->active_low; 35292a47674SAlexander Stein if (type == EV_ABS) { 35392a47674SAlexander Stein if (state) 35492a47674SAlexander Stein input_event(input, type, button->code, button->value); 35592a47674SAlexander Stein } else { 35684767d00SRoman Moravcik input_event(input, type, button->code, !!state); 35792a47674SAlexander Stein } 35878a56aabSPhil Blundell input_sync(input); 359a33466e3SDmitry Baryshkov } 360a33466e3SDmitry Baryshkov 361d8ee4a1cSLaxman Dewangan static void gpio_keys_gpio_work_func(struct work_struct *work) 3626ee88d71SDaniel Mack { 3636ee88d71SDaniel Mack struct gpio_button_data *bdata = 3648ed92556SDmitry Torokhov container_of(work, struct gpio_button_data, work.work); 3656ee88d71SDaniel Mack 366d8ee4a1cSLaxman Dewangan gpio_keys_gpio_report_event(bdata); 3672fba26c6SNeilBrown 3682fba26c6SNeilBrown if (bdata->button->wakeup) 3692fba26c6SNeilBrown pm_relax(bdata->input->dev.parent); 3706ee88d71SDaniel Mack } 3716ee88d71SDaniel Mack 372d8ee4a1cSLaxman Dewangan static irqreturn_t gpio_keys_gpio_isr(int irq, void *dev_id) 373a33466e3SDmitry Baryshkov { 37457ffe9d5SUwe Kleine-König struct gpio_button_data *bdata = dev_id; 375a33466e3SDmitry Baryshkov 376d8ee4a1cSLaxman Dewangan BUG_ON(irq != bdata->irq); 377a33466e3SDmitry Baryshkov 3782fba26c6SNeilBrown if (bdata->button->wakeup) 3792fba26c6SNeilBrown pm_stay_awake(bdata->input->dev.parent); 3808ed92556SDmitry Torokhov 3818ed92556SDmitry Torokhov mod_delayed_work(system_wq, 3828ed92556SDmitry Torokhov &bdata->work, 3838ed92556SDmitry Torokhov msecs_to_jiffies(bdata->software_debounce)); 384a33466e3SDmitry Baryshkov 3851164ec1aSDavid Brownell return IRQ_HANDLED; 38678a56aabSPhil Blundell } 38778a56aabSPhil Blundell 388d8ee4a1cSLaxman Dewangan static void gpio_keys_irq_timer(unsigned long _data) 389d8ee4a1cSLaxman Dewangan { 390d8ee4a1cSLaxman Dewangan struct gpio_button_data *bdata = (struct gpio_button_data *)_data; 391d8ee4a1cSLaxman Dewangan struct input_dev *input = bdata->input; 392d8ee4a1cSLaxman Dewangan unsigned long flags; 393d8ee4a1cSLaxman Dewangan 394d8ee4a1cSLaxman Dewangan spin_lock_irqsave(&bdata->lock, flags); 395d8ee4a1cSLaxman Dewangan if (bdata->key_pressed) { 396d8ee4a1cSLaxman Dewangan input_event(input, EV_KEY, bdata->button->code, 0); 397d8ee4a1cSLaxman Dewangan input_sync(input); 398d8ee4a1cSLaxman Dewangan bdata->key_pressed = false; 399d8ee4a1cSLaxman Dewangan } 400d8ee4a1cSLaxman Dewangan spin_unlock_irqrestore(&bdata->lock, flags); 401d8ee4a1cSLaxman Dewangan } 402d8ee4a1cSLaxman Dewangan 403d8ee4a1cSLaxman Dewangan static irqreturn_t gpio_keys_irq_isr(int irq, void *dev_id) 404d8ee4a1cSLaxman Dewangan { 405d8ee4a1cSLaxman Dewangan struct gpio_button_data *bdata = dev_id; 406d8ee4a1cSLaxman Dewangan const struct gpio_keys_button *button = bdata->button; 407d8ee4a1cSLaxman Dewangan struct input_dev *input = bdata->input; 408d8ee4a1cSLaxman Dewangan unsigned long flags; 409d8ee4a1cSLaxman Dewangan 410d8ee4a1cSLaxman Dewangan BUG_ON(irq != bdata->irq); 411d8ee4a1cSLaxman Dewangan 412d8ee4a1cSLaxman Dewangan spin_lock_irqsave(&bdata->lock, flags); 413d8ee4a1cSLaxman Dewangan 414d8ee4a1cSLaxman Dewangan if (!bdata->key_pressed) { 4152fba26c6SNeilBrown if (bdata->button->wakeup) 4162fba26c6SNeilBrown pm_wakeup_event(bdata->input->dev.parent, 0); 4172fba26c6SNeilBrown 418d8ee4a1cSLaxman Dewangan input_event(input, EV_KEY, button->code, 1); 419d8ee4a1cSLaxman Dewangan input_sync(input); 420d8ee4a1cSLaxman Dewangan 4218ed92556SDmitry Torokhov if (!bdata->release_delay) { 422d8ee4a1cSLaxman Dewangan input_event(input, EV_KEY, button->code, 0); 423d8ee4a1cSLaxman Dewangan input_sync(input); 424d8ee4a1cSLaxman Dewangan goto out; 425d8ee4a1cSLaxman Dewangan } 426d8ee4a1cSLaxman Dewangan 427d8ee4a1cSLaxman Dewangan bdata->key_pressed = true; 428d8ee4a1cSLaxman Dewangan } 429d8ee4a1cSLaxman Dewangan 4308ed92556SDmitry Torokhov if (bdata->release_delay) 4318ed92556SDmitry Torokhov mod_timer(&bdata->release_timer, 4328ed92556SDmitry Torokhov jiffies + msecs_to_jiffies(bdata->release_delay)); 433d8ee4a1cSLaxman Dewangan out: 434d8ee4a1cSLaxman Dewangan spin_unlock_irqrestore(&bdata->lock, flags); 435d8ee4a1cSLaxman Dewangan return IRQ_HANDLED; 436d8ee4a1cSLaxman Dewangan } 437d8ee4a1cSLaxman Dewangan 43827245519SAlexander Shiyan static void gpio_keys_quiesce_key(void *data) 43927245519SAlexander Shiyan { 44027245519SAlexander Shiyan struct gpio_button_data *bdata = data; 44127245519SAlexander Shiyan 4428ed92556SDmitry Torokhov if (gpio_is_valid(bdata->button->gpio)) 4438ed92556SDmitry Torokhov cancel_delayed_work_sync(&bdata->work); 4448ed92556SDmitry Torokhov else 4458ed92556SDmitry Torokhov del_timer_sync(&bdata->release_timer); 44627245519SAlexander Shiyan } 44727245519SAlexander Shiyan 4485298cc4cSBill Pemberton static int gpio_keys_setup_key(struct platform_device *pdev, 449d9080921SDmitry Torokhov struct input_dev *input, 450bc8f1eafSBen Dooks struct gpio_button_data *bdata, 451d9080921SDmitry Torokhov const struct gpio_keys_button *button) 452bc8f1eafSBen Dooks { 45392a47674SAlexander Stein const char *desc = button->desc ? button->desc : "gpio_keys"; 4549e3af04fSMika Westerberg struct device *dev = &pdev->dev; 455d8ee4a1cSLaxman Dewangan irq_handler_t isr; 4569e3af04fSMika Westerberg unsigned long irqflags; 45727245519SAlexander Shiyan int irq; 45827245519SAlexander Shiyan int error; 459bc8f1eafSBen Dooks 460d9080921SDmitry Torokhov bdata->input = input; 461d9080921SDmitry Torokhov bdata->button = button; 462d8ee4a1cSLaxman Dewangan spin_lock_init(&bdata->lock); 463d8ee4a1cSLaxman Dewangan 464d8ee4a1cSLaxman Dewangan if (gpio_is_valid(button->gpio)) { 465bc8f1eafSBen Dooks 46627245519SAlexander Shiyan error = devm_gpio_request_one(&pdev->dev, button->gpio, 46727245519SAlexander Shiyan GPIOF_IN, desc); 468bc8f1eafSBen Dooks if (error < 0) { 469d8ee4a1cSLaxman Dewangan dev_err(dev, "Failed to request GPIO %d, error %d\n", 470bc8f1eafSBen Dooks button->gpio, error); 471d8ee4a1cSLaxman Dewangan return error; 472bc8f1eafSBen Dooks } 473bc8f1eafSBen Dooks 47428ed684fSGrazvydas Ignotas if (button->debounce_interval) { 47528ed684fSGrazvydas Ignotas error = gpio_set_debounce(button->gpio, 47628ed684fSGrazvydas Ignotas button->debounce_interval * 1000); 47728ed684fSGrazvydas Ignotas /* use timer if gpiolib doesn't provide debounce */ 47828ed684fSGrazvydas Ignotas if (error < 0) 4798ed92556SDmitry Torokhov bdata->software_debounce = 480d8ee4a1cSLaxman Dewangan button->debounce_interval; 48128ed684fSGrazvydas Ignotas } 48228ed684fSGrazvydas Ignotas 48397d86e07SDmitry Torokhov if (button->irq) { 48497d86e07SDmitry Torokhov bdata->irq = button->irq; 48597d86e07SDmitry Torokhov } else { 486bc8f1eafSBen Dooks irq = gpio_to_irq(button->gpio); 487bc8f1eafSBen Dooks if (irq < 0) { 488bc8f1eafSBen Dooks error = irq; 489d8ee4a1cSLaxman Dewangan dev_err(dev, 490d8ee4a1cSLaxman Dewangan "Unable to get irq number for GPIO %d, error %d\n", 491bc8f1eafSBen Dooks button->gpio, error); 49227245519SAlexander Shiyan return error; 493d8ee4a1cSLaxman Dewangan } 494d8ee4a1cSLaxman Dewangan bdata->irq = irq; 49597d86e07SDmitry Torokhov } 496d8ee4a1cSLaxman Dewangan 4978ed92556SDmitry Torokhov INIT_DELAYED_WORK(&bdata->work, gpio_keys_gpio_work_func); 498d8ee4a1cSLaxman Dewangan 499d8ee4a1cSLaxman Dewangan isr = gpio_keys_gpio_isr; 500d8ee4a1cSLaxman Dewangan irqflags = IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING; 501d8ee4a1cSLaxman Dewangan 502d8ee4a1cSLaxman Dewangan } else { 503d8ee4a1cSLaxman Dewangan if (!button->irq) { 504d8ee4a1cSLaxman Dewangan dev_err(dev, "No IRQ specified\n"); 505d8ee4a1cSLaxman Dewangan return -EINVAL; 506d8ee4a1cSLaxman Dewangan } 507d8ee4a1cSLaxman Dewangan bdata->irq = button->irq; 508d8ee4a1cSLaxman Dewangan 509d8ee4a1cSLaxman Dewangan if (button->type && button->type != EV_KEY) { 510d8ee4a1cSLaxman Dewangan dev_err(dev, "Only EV_KEY allowed for IRQ buttons.\n"); 511d8ee4a1cSLaxman Dewangan return -EINVAL; 512bc8f1eafSBen Dooks } 513bc8f1eafSBen Dooks 5148ed92556SDmitry Torokhov bdata->release_delay = button->debounce_interval; 5158ed92556SDmitry Torokhov setup_timer(&bdata->release_timer, 516d8ee4a1cSLaxman Dewangan gpio_keys_irq_timer, (unsigned long)bdata); 517d8ee4a1cSLaxman Dewangan 518d8ee4a1cSLaxman Dewangan isr = gpio_keys_irq_isr; 519d8ee4a1cSLaxman Dewangan irqflags = 0; 520d8ee4a1cSLaxman Dewangan } 521d8ee4a1cSLaxman Dewangan 522d8ee4a1cSLaxman Dewangan input_set_capability(input, button->type ?: EV_KEY, button->code); 523d8ee4a1cSLaxman Dewangan 5249e3af04fSMika Westerberg /* 5258ed92556SDmitry Torokhov * Install custom action to cancel release timer and 52627245519SAlexander Shiyan * workqueue item. 52727245519SAlexander Shiyan */ 52827245519SAlexander Shiyan error = devm_add_action(&pdev->dev, gpio_keys_quiesce_key, bdata); 52927245519SAlexander Shiyan if (error) { 53027245519SAlexander Shiyan dev_err(&pdev->dev, 53127245519SAlexander Shiyan "failed to register quiesce action, error: %d\n", 53227245519SAlexander Shiyan error); 53327245519SAlexander Shiyan return error; 53427245519SAlexander Shiyan } 53527245519SAlexander Shiyan 53627245519SAlexander Shiyan /* 5379e3af04fSMika Westerberg * If platform has specified that the button can be disabled, 5389e3af04fSMika Westerberg * we don't want it to share the interrupt line. 5399e3af04fSMika Westerberg */ 5409e3af04fSMika Westerberg if (!button->can_disable) 5419e3af04fSMika Westerberg irqflags |= IRQF_SHARED; 5429e3af04fSMika Westerberg 54327245519SAlexander Shiyan error = devm_request_any_context_irq(&pdev->dev, bdata->irq, 54427245519SAlexander Shiyan isr, irqflags, desc, bdata); 54594a8cab8SPhilippe Langlais if (error < 0) { 546bc8f1eafSBen Dooks dev_err(dev, "Unable to claim irq %d; error %d\n", 547d8ee4a1cSLaxman Dewangan bdata->irq, error); 54827245519SAlexander Shiyan return error; 549bc8f1eafSBen Dooks } 550bc8f1eafSBen Dooks 551bc8f1eafSBen Dooks return 0; 552bc8f1eafSBen Dooks } 553bc8f1eafSBen Dooks 5545b76d7b4SDmitry Torokhov static void gpio_keys_report_state(struct gpio_keys_drvdata *ddata) 5555b76d7b4SDmitry Torokhov { 5565b76d7b4SDmitry Torokhov struct input_dev *input = ddata->input; 5575b76d7b4SDmitry Torokhov int i; 5585b76d7b4SDmitry Torokhov 5595b76d7b4SDmitry Torokhov for (i = 0; i < ddata->pdata->nbuttons; i++) { 5605b76d7b4SDmitry Torokhov struct gpio_button_data *bdata = &ddata->data[i]; 5615b76d7b4SDmitry Torokhov if (gpio_is_valid(bdata->button->gpio)) 5625b76d7b4SDmitry Torokhov gpio_keys_gpio_report_event(bdata); 5635b76d7b4SDmitry Torokhov } 5645b76d7b4SDmitry Torokhov input_sync(input); 5655b76d7b4SDmitry Torokhov } 5665b76d7b4SDmitry Torokhov 567173bdd74SShubhrajyoti D static int gpio_keys_open(struct input_dev *input) 568173bdd74SShubhrajyoti D { 569173bdd74SShubhrajyoti D struct gpio_keys_drvdata *ddata = input_get_drvdata(input); 570219edc71SAlexandre Pereira da Silva const struct gpio_keys_platform_data *pdata = ddata->pdata; 5715b76d7b4SDmitry Torokhov int error; 572173bdd74SShubhrajyoti D 5735b76d7b4SDmitry Torokhov if (pdata->enable) { 5745b76d7b4SDmitry Torokhov error = pdata->enable(input->dev.parent); 5755b76d7b4SDmitry Torokhov if (error) 5765b76d7b4SDmitry Torokhov return error; 5775b76d7b4SDmitry Torokhov } 5785b76d7b4SDmitry Torokhov 5795b76d7b4SDmitry Torokhov /* Report current state of buttons that are connected to GPIOs */ 5805b76d7b4SDmitry Torokhov gpio_keys_report_state(ddata); 5815b76d7b4SDmitry Torokhov 5825b76d7b4SDmitry Torokhov return 0; 583173bdd74SShubhrajyoti D } 584173bdd74SShubhrajyoti D 585173bdd74SShubhrajyoti D static void gpio_keys_close(struct input_dev *input) 586173bdd74SShubhrajyoti D { 587173bdd74SShubhrajyoti D struct gpio_keys_drvdata *ddata = input_get_drvdata(input); 588219edc71SAlexandre Pereira da Silva const struct gpio_keys_platform_data *pdata = ddata->pdata; 589173bdd74SShubhrajyoti D 590219edc71SAlexandre Pereira da Silva if (pdata->disable) 591219edc71SAlexandre Pereira da Silva pdata->disable(input->dev.parent); 592173bdd74SShubhrajyoti D } 593173bdd74SShubhrajyoti D 594fd05d089SDavid Jander /* 595fd05d089SDavid Jander * Handlers for alternative sources of platform_data 596fd05d089SDavid Jander */ 597219edc71SAlexandre Pereira da Silva 598fd05d089SDavid Jander #ifdef CONFIG_OF 599fd05d089SDavid Jander /* 600fd05d089SDavid Jander * Translate OpenFirmware node properties into platform_data 601fd05d089SDavid Jander */ 6025298cc4cSBill Pemberton static struct gpio_keys_platform_data * 603219edc71SAlexandre Pereira da Silva gpio_keys_get_devtree_pdata(struct device *dev) 604fd05d089SDavid Jander { 605fd05d089SDavid Jander struct device_node *node, *pp; 606219edc71SAlexandre Pereira da Silva struct gpio_keys_platform_data *pdata; 607219edc71SAlexandre Pereira da Silva struct gpio_keys_button *button; 608219edc71SAlexandre Pereira da Silva int error; 609219edc71SAlexandre Pereira da Silva int nbuttons; 610fd05d089SDavid Jander int i; 611fd05d089SDavid Jander 612fd05d089SDavid Jander node = dev->of_node; 6135d422f2eSAndy Shevchenko if (!node) 6145d422f2eSAndy Shevchenko return ERR_PTR(-ENODEV); 615fd05d089SDavid Jander 616219edc71SAlexandre Pereira da Silva nbuttons = of_get_child_count(node); 6175d422f2eSAndy Shevchenko if (nbuttons == 0) 6185d422f2eSAndy Shevchenko return ERR_PTR(-ENODEV); 619219edc71SAlexandre Pereira da Silva 6205d422f2eSAndy Shevchenko pdata = devm_kzalloc(dev, 6215d422f2eSAndy Shevchenko sizeof(*pdata) + nbuttons * sizeof(*button), 622219edc71SAlexandre Pereira da Silva GFP_KERNEL); 6235d422f2eSAndy Shevchenko if (!pdata) 6245d422f2eSAndy Shevchenko return ERR_PTR(-ENOMEM); 625219edc71SAlexandre Pereira da Silva 626219edc71SAlexandre Pereira da Silva pdata->buttons = (struct gpio_keys_button *)(pdata + 1); 627219edc71SAlexandre Pereira da Silva pdata->nbuttons = nbuttons; 628fd05d089SDavid Jander 629cca84699STobias Klauser pdata->rep = !!of_get_property(node, "autorepeat", NULL); 630fd05d089SDavid Jander 631fd05d089SDavid Jander i = 0; 632219edc71SAlexandre Pereira da Silva for_each_child_of_node(node, pp) { 633fd05d089SDavid Jander enum of_gpio_flags flags; 634fd05d089SDavid Jander 6351d6a0136SFabio Estevam button = &pdata->buttons[i++]; 6361d6a0136SFabio Estevam 63797d86e07SDmitry Torokhov button->gpio = of_get_gpio_flags(pp, 0, &flags); 63897d86e07SDmitry Torokhov if (button->gpio < 0) { 63997d86e07SDmitry Torokhov error = button->gpio; 64097d86e07SDmitry Torokhov if (error != -ENOENT) { 641e324ce61SDmitry Torokhov if (error != -EPROBE_DEFER) 642e324ce61SDmitry Torokhov dev_err(dev, 643e324ce61SDmitry Torokhov "Failed to get gpio flags, error: %d\n", 644e324ce61SDmitry Torokhov error); 6455d422f2eSAndy Shevchenko return ERR_PTR(error); 646e324ce61SDmitry Torokhov } 64797d86e07SDmitry Torokhov } else { 64897d86e07SDmitry Torokhov button->active_low = flags & OF_GPIO_ACTIVE_LOW; 649f2d347ffSAlexander Stein } 650fd05d089SDavid Jander 65197d86e07SDmitry Torokhov button->irq = irq_of_parse_and_map(pp, 0); 65297d86e07SDmitry Torokhov 65397d86e07SDmitry Torokhov if (!gpio_is_valid(button->gpio) && !button->irq) { 65497d86e07SDmitry Torokhov dev_err(dev, "Found button without gpios or irqs\n"); 65597d86e07SDmitry Torokhov return ERR_PTR(-EINVAL); 65697d86e07SDmitry Torokhov } 657fd05d089SDavid Jander 658219edc71SAlexandre Pereira da Silva if (of_property_read_u32(pp, "linux,code", &button->code)) { 659219edc71SAlexandre Pereira da Silva dev_err(dev, "Button without keycode: 0x%x\n", 660219edc71SAlexandre Pereira da Silva button->gpio); 6615d422f2eSAndy Shevchenko return ERR_PTR(-EINVAL); 662fd05d089SDavid Jander } 663fd05d089SDavid Jander 664219edc71SAlexandre Pereira da Silva button->desc = of_get_property(pp, "label", NULL); 665fd05d089SDavid Jander 666219edc71SAlexandre Pereira da Silva if (of_property_read_u32(pp, "linux,input-type", &button->type)) 667219edc71SAlexandre Pereira da Silva button->type = EV_KEY; 668fd05d089SDavid Jander 66999b4ffbdSDmitry Torokhov button->wakeup = of_property_read_bool(pp, "wakeup-source") || 67099b4ffbdSDmitry Torokhov /* legacy name */ 67199b4ffbdSDmitry Torokhov of_property_read_bool(pp, "gpio-key,wakeup"); 672219edc71SAlexandre Pereira da Silva 67397d86e07SDmitry Torokhov button->can_disable = !!of_get_property(pp, "linux,can-disable", NULL); 67497d86e07SDmitry Torokhov 675219edc71SAlexandre Pereira da Silva if (of_property_read_u32(pp, "debounce-interval", 676219edc71SAlexandre Pereira da Silva &button->debounce_interval)) 677219edc71SAlexandre Pereira da Silva button->debounce_interval = 5; 678219edc71SAlexandre Pereira da Silva } 679219edc71SAlexandre Pereira da Silva 6805d422f2eSAndy Shevchenko if (pdata->nbuttons == 0) 6815d422f2eSAndy Shevchenko return ERR_PTR(-EINVAL); 682219edc71SAlexandre Pereira da Silva 683219edc71SAlexandre Pereira da Silva return pdata; 684fd05d089SDavid Jander } 685fd05d089SDavid Jander 68622daae31SJingoo Han static const struct of_device_id gpio_keys_of_match[] = { 687fd05d089SDavid Jander { .compatible = "gpio-keys", }, 688fd05d089SDavid Jander { }, 689fd05d089SDavid Jander }; 690fd05d089SDavid Jander MODULE_DEVICE_TABLE(of, gpio_keys_of_match); 691fd05d089SDavid Jander 692fd05d089SDavid Jander #else 693fd05d089SDavid Jander 694219edc71SAlexandre Pereira da Silva static inline struct gpio_keys_platform_data * 695219edc71SAlexandre Pereira da Silva gpio_keys_get_devtree_pdata(struct device *dev) 696fd05d089SDavid Jander { 697219edc71SAlexandre Pereira da Silva return ERR_PTR(-ENODEV); 698fd05d089SDavid Jander } 699fd05d089SDavid Jander 700fd05d089SDavid Jander #endif 701fd05d089SDavid Jander 7025298cc4cSBill Pemberton static int gpio_keys_probe(struct platform_device *pdev) 70378a56aabSPhil Blundell { 704db19fd8bSBen Dooks struct device *dev = &pdev->dev; 705219edc71SAlexandre Pereira da Silva const struct gpio_keys_platform_data *pdata = dev_get_platdata(dev); 706219edc71SAlexandre Pereira da Silva struct gpio_keys_drvdata *ddata; 70778a56aabSPhil Blundell struct input_dev *input; 7085d422f2eSAndy Shevchenko size_t size; 70978a56aabSPhil Blundell int i, error; 710e15b0213SAnti Sullin int wakeup = 0; 71178a56aabSPhil Blundell 712fd05d089SDavid Jander if (!pdata) { 713219edc71SAlexandre Pereira da Silva pdata = gpio_keys_get_devtree_pdata(dev); 714219edc71SAlexandre Pereira da Silva if (IS_ERR(pdata)) 715219edc71SAlexandre Pereira da Silva return PTR_ERR(pdata); 716fd05d089SDavid Jander } 717fd05d089SDavid Jander 7185d422f2eSAndy Shevchenko size = sizeof(struct gpio_keys_drvdata) + 7195d422f2eSAndy Shevchenko pdata->nbuttons * sizeof(struct gpio_button_data); 7205d422f2eSAndy Shevchenko ddata = devm_kzalloc(dev, size, GFP_KERNEL); 7215d422f2eSAndy Shevchenko if (!ddata) { 722db19fd8bSBen Dooks dev_err(dev, "failed to allocate state\n"); 7235d422f2eSAndy Shevchenko return -ENOMEM; 7245d422f2eSAndy Shevchenko } 7255d422f2eSAndy Shevchenko 7265d422f2eSAndy Shevchenko input = devm_input_allocate_device(dev); 7275d422f2eSAndy Shevchenko if (!input) { 7285d422f2eSAndy Shevchenko dev_err(dev, "failed to allocate input device\n"); 7295d422f2eSAndy Shevchenko return -ENOMEM; 730a33466e3SDmitry Baryshkov } 73178a56aabSPhil Blundell 732219edc71SAlexandre Pereira da Silva ddata->pdata = pdata; 7339e3af04fSMika Westerberg ddata->input = input; 7349e3af04fSMika Westerberg mutex_init(&ddata->disable_lock); 7359e3af04fSMika Westerberg 736a33466e3SDmitry Baryshkov platform_set_drvdata(pdev, ddata); 737173bdd74SShubhrajyoti D input_set_drvdata(input, ddata); 73878a56aabSPhil Blundell 73946711277SAlexander Stein input->name = pdata->name ? : pdev->name; 74078a56aabSPhil Blundell input->phys = "gpio-keys/input0"; 741469ba4dfSDmitry Torokhov input->dev.parent = &pdev->dev; 742173bdd74SShubhrajyoti D input->open = gpio_keys_open; 743173bdd74SShubhrajyoti D input->close = gpio_keys_close; 74478a56aabSPhil Blundell 74578a56aabSPhil Blundell input->id.bustype = BUS_HOST; 74678a56aabSPhil Blundell input->id.vendor = 0x0001; 74778a56aabSPhil Blundell input->id.product = 0x0001; 74878a56aabSPhil Blundell input->id.version = 0x0100; 74978a56aabSPhil Blundell 750b67b4b11SDominic Curran /* Enable auto repeat feature of Linux input subsystem */ 751b67b4b11SDominic Curran if (pdata->rep) 752b67b4b11SDominic Curran __set_bit(EV_REP, input->evbit); 753b67b4b11SDominic Curran 75478a56aabSPhil Blundell for (i = 0; i < pdata->nbuttons; i++) { 755d9080921SDmitry Torokhov const struct gpio_keys_button *button = &pdata->buttons[i]; 756a33466e3SDmitry Baryshkov struct gpio_button_data *bdata = &ddata->data[i]; 75778a56aabSPhil Blundell 758d9080921SDmitry Torokhov error = gpio_keys_setup_key(pdev, input, bdata, button); 759bc8f1eafSBen Dooks if (error) 76027245519SAlexander Shiyan return error; 76184767d00SRoman Moravcik 762e15b0213SAnti Sullin if (button->wakeup) 763e15b0213SAnti Sullin wakeup = 1; 76478a56aabSPhil Blundell } 76578a56aabSPhil Blundell 7669e3af04fSMika Westerberg error = sysfs_create_group(&pdev->dev.kobj, &gpio_keys_attr_group); 7679e3af04fSMika Westerberg if (error) { 7689e3af04fSMika Westerberg dev_err(dev, "Unable to export keys/switches, error: %d\n", 7699e3af04fSMika Westerberg error); 77027245519SAlexander Shiyan return error; 7719e3af04fSMika Westerberg } 7729e3af04fSMika Westerberg 77378a56aabSPhil Blundell error = input_register_device(input); 77478a56aabSPhil Blundell if (error) { 7759e3af04fSMika Westerberg dev_err(dev, "Unable to register input device, error: %d\n", 7769e3af04fSMika Westerberg error); 77727245519SAlexander Shiyan goto err_remove_group; 77878a56aabSPhil Blundell } 77978a56aabSPhil Blundell 780e15b0213SAnti Sullin device_init_wakeup(&pdev->dev, wakeup); 781e15b0213SAnti Sullin 78278a56aabSPhil Blundell return 0; 78378a56aabSPhil Blundell 78427245519SAlexander Shiyan err_remove_group: 7859e3af04fSMika Westerberg sysfs_remove_group(&pdev->dev.kobj, &gpio_keys_attr_group); 78678a56aabSPhil Blundell return error; 78778a56aabSPhil Blundell } 78878a56aabSPhil Blundell 789e2619cf7SBill Pemberton static int gpio_keys_remove(struct platform_device *pdev) 79078a56aabSPhil Blundell { 7919e3af04fSMika Westerberg sysfs_remove_group(&pdev->dev.kobj, &gpio_keys_attr_group); 7929e3af04fSMika Westerberg 793e15b0213SAnti Sullin device_init_wakeup(&pdev->dev, 0); 794e15b0213SAnti Sullin 79578a56aabSPhil Blundell return 0; 79678a56aabSPhil Blundell } 79778a56aabSPhil Blundell 798bdda8216SDmitry Torokhov #ifdef CONFIG_PM_SLEEP 799ae78e0e0SMike Rapoport static int gpio_keys_suspend(struct device *dev) 800e15b0213SAnti Sullin { 801fd05d089SDavid Jander struct gpio_keys_drvdata *ddata = dev_get_drvdata(dev); 802dda19a92SJonas Aaberg struct input_dev *input = ddata->input; 803e15b0213SAnti Sullin int i; 804e15b0213SAnti Sullin 805fd05d089SDavid Jander if (device_may_wakeup(dev)) { 806219edc71SAlexandre Pereira da Silva for (i = 0; i < ddata->pdata->nbuttons; i++) { 807d8ee4a1cSLaxman Dewangan struct gpio_button_data *bdata = &ddata->data[i]; 808d8ee4a1cSLaxman Dewangan if (bdata->button->wakeup) 809d8ee4a1cSLaxman Dewangan enable_irq_wake(bdata->irq); 810e15b0213SAnti Sullin } 811dda19a92SJonas Aaberg } else { 812dda19a92SJonas Aaberg mutex_lock(&input->mutex); 813dda19a92SJonas Aaberg if (input->users) 814dda19a92SJonas Aaberg gpio_keys_close(input); 815dda19a92SJonas Aaberg mutex_unlock(&input->mutex); 816e15b0213SAnti Sullin } 817e15b0213SAnti Sullin 818e15b0213SAnti Sullin return 0; 819e15b0213SAnti Sullin } 820e15b0213SAnti Sullin 821ae78e0e0SMike Rapoport static int gpio_keys_resume(struct device *dev) 822e15b0213SAnti Sullin { 823fd05d089SDavid Jander struct gpio_keys_drvdata *ddata = dev_get_drvdata(dev); 824dda19a92SJonas Aaberg struct input_dev *input = ddata->input; 825dda19a92SJonas Aaberg int error = 0; 826e15b0213SAnti Sullin int i; 827e15b0213SAnti Sullin 828dda19a92SJonas Aaberg if (device_may_wakeup(dev)) { 829219edc71SAlexandre Pereira da Silva for (i = 0; i < ddata->pdata->nbuttons; i++) { 830d8ee4a1cSLaxman Dewangan struct gpio_button_data *bdata = &ddata->data[i]; 831dda19a92SJonas Aaberg if (bdata->button->wakeup) 832d8ee4a1cSLaxman Dewangan disable_irq_wake(bdata->irq); 833e15b0213SAnti Sullin } 834dda19a92SJonas Aaberg } else { 835dda19a92SJonas Aaberg mutex_lock(&input->mutex); 836dda19a92SJonas Aaberg if (input->users) 837dda19a92SJonas Aaberg error = gpio_keys_open(input); 838dda19a92SJonas Aaberg mutex_unlock(&input->mutex); 839dda19a92SJonas Aaberg } 840dda19a92SJonas Aaberg 841dda19a92SJonas Aaberg if (error) 842dda19a92SJonas Aaberg return error; 8435b76d7b4SDmitry Torokhov 8445b76d7b4SDmitry Torokhov gpio_keys_report_state(ddata); 845e15b0213SAnti Sullin return 0; 846e15b0213SAnti Sullin } 847e15b0213SAnti Sullin #endif 848e15b0213SAnti Sullin 849bdda8216SDmitry Torokhov static SIMPLE_DEV_PM_OPS(gpio_keys_pm_ops, gpio_keys_suspend, gpio_keys_resume); 850bdda8216SDmitry Torokhov 8519b07044cSUwe Kleine-König static struct platform_driver gpio_keys_device_driver = { 85278a56aabSPhil Blundell .probe = gpio_keys_probe, 8531cb0aa88SBill Pemberton .remove = gpio_keys_remove, 85478a56aabSPhil Blundell .driver = { 85578a56aabSPhil Blundell .name = "gpio-keys", 856ae78e0e0SMike Rapoport .pm = &gpio_keys_pm_ops, 857219edc71SAlexandre Pereira da Silva .of_match_table = of_match_ptr(gpio_keys_of_match), 85878a56aabSPhil Blundell } 85978a56aabSPhil Blundell }; 86078a56aabSPhil Blundell 86178a56aabSPhil Blundell static int __init gpio_keys_init(void) 86278a56aabSPhil Blundell { 86378a56aabSPhil Blundell return platform_driver_register(&gpio_keys_device_driver); 86478a56aabSPhil Blundell } 86578a56aabSPhil Blundell 86678a56aabSPhil Blundell static void __exit gpio_keys_exit(void) 86778a56aabSPhil Blundell { 86878a56aabSPhil Blundell platform_driver_unregister(&gpio_keys_device_driver); 86978a56aabSPhil Blundell } 87078a56aabSPhil Blundell 871b2330205SDavid Jander late_initcall(gpio_keys_init); 87278a56aabSPhil Blundell module_exit(gpio_keys_exit); 87378a56aabSPhil Blundell 87478a56aabSPhil Blundell MODULE_LICENSE("GPL"); 87578a56aabSPhil Blundell MODULE_AUTHOR("Phil Blundell <pb@handhelds.org>"); 8767e2ecdf4SDavid Jander MODULE_DESCRIPTION("Keyboard driver for GPIOs"); 877d7b5247bSKay Sievers MODULE_ALIAS("platform:gpio-keys"); 878