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> 295feeca3cSGeert Uytterhoeven #include <linux/gpio/consumer.h> 30415a4caaSSachin Kamat #include <linux/of.h> 31f2d347ffSAlexander Stein #include <linux/of_irq.h> 32d8ee4a1cSLaxman Dewangan #include <linux/spinlock.h> 3378a56aabSPhil Blundell 34a33466e3SDmitry Baryshkov struct gpio_button_data { 35d9080921SDmitry Torokhov const struct gpio_keys_button *button; 36a33466e3SDmitry Baryshkov struct input_dev *input; 375feeca3cSGeert Uytterhoeven struct gpio_desc *gpiod; 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 */ 998679ee42SDmitry Torokhov static 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 /** 1078679ee42SDmitry Torokhov * get_bm_events_by_type() - returns bitmap of supported events per @type 1088679ee42SDmitry Torokhov * @input: input device from which bitmap is retrieved 1098679ee42SDmitry Torokhov * @type: type of button (%EV_KEY, %EV_SW) 1108679ee42SDmitry Torokhov * 1118679ee42SDmitry Torokhov * Return value of this function can be used to allocate bitmap 1128679ee42SDmitry Torokhov * large enough to hold all bits for given type. 1138679ee42SDmitry Torokhov */ 1148679ee42SDmitry Torokhov static const unsigned long *get_bm_events_by_type(struct input_dev *dev, 1158679ee42SDmitry Torokhov int type) 1168679ee42SDmitry Torokhov { 1178679ee42SDmitry Torokhov BUG_ON(type != EV_SW && type != EV_KEY); 1188679ee42SDmitry Torokhov 1198679ee42SDmitry Torokhov return (type == EV_KEY) ? dev->keybit : dev->swbit; 1208679ee42SDmitry Torokhov } 1218679ee42SDmitry Torokhov 1228679ee42SDmitry Torokhov /** 1239e3af04fSMika Westerberg * gpio_keys_disable_button() - disables given GPIO button 1249e3af04fSMika Westerberg * @bdata: button data for button to be disabled 1259e3af04fSMika Westerberg * 1269e3af04fSMika Westerberg * Disables button pointed by @bdata. This is done by masking 1279e3af04fSMika Westerberg * IRQ line. After this function is called, button won't generate 1289e3af04fSMika Westerberg * input events anymore. Note that one can only disable buttons 1299e3af04fSMika Westerberg * that don't share IRQs. 1309e3af04fSMika Westerberg * 1319e3af04fSMika Westerberg * Make sure that @bdata->disable_lock is locked when entering 1329e3af04fSMika Westerberg * this function to avoid races when concurrent threads are 1339e3af04fSMika Westerberg * disabling buttons at the same time. 1349e3af04fSMika Westerberg */ 1359e3af04fSMika Westerberg static void gpio_keys_disable_button(struct gpio_button_data *bdata) 1369e3af04fSMika Westerberg { 1379e3af04fSMika Westerberg if (!bdata->disabled) { 1389e3af04fSMika Westerberg /* 1398ed92556SDmitry Torokhov * Disable IRQ and associated timer/work structure. 1409e3af04fSMika Westerberg */ 141d8ee4a1cSLaxman Dewangan disable_irq(bdata->irq); 1428ed92556SDmitry Torokhov 1435feeca3cSGeert Uytterhoeven if (bdata->gpiod) 1448ed92556SDmitry Torokhov cancel_delayed_work_sync(&bdata->work); 1458ed92556SDmitry Torokhov else 1468ed92556SDmitry Torokhov del_timer_sync(&bdata->release_timer); 1479e3af04fSMika Westerberg 1489e3af04fSMika Westerberg bdata->disabled = true; 1499e3af04fSMika Westerberg } 1509e3af04fSMika Westerberg } 1519e3af04fSMika Westerberg 1529e3af04fSMika Westerberg /** 1539e3af04fSMika Westerberg * gpio_keys_enable_button() - enables given GPIO button 1549e3af04fSMika Westerberg * @bdata: button data for button to be disabled 1559e3af04fSMika Westerberg * 1569e3af04fSMika Westerberg * Enables given button pointed by @bdata. 1579e3af04fSMika Westerberg * 1589e3af04fSMika Westerberg * Make sure that @bdata->disable_lock is locked when entering 1599e3af04fSMika Westerberg * this function to avoid races with concurrent threads trying 1609e3af04fSMika Westerberg * to enable the same button at the same time. 1619e3af04fSMika Westerberg */ 1629e3af04fSMika Westerberg static void gpio_keys_enable_button(struct gpio_button_data *bdata) 1639e3af04fSMika Westerberg { 1649e3af04fSMika Westerberg if (bdata->disabled) { 165d8ee4a1cSLaxman Dewangan enable_irq(bdata->irq); 1669e3af04fSMika Westerberg bdata->disabled = false; 1679e3af04fSMika Westerberg } 1689e3af04fSMika Westerberg } 1699e3af04fSMika Westerberg 1709e3af04fSMika Westerberg /** 1719e3af04fSMika Westerberg * gpio_keys_attr_show_helper() - fill in stringified bitmap of buttons 1729e3af04fSMika Westerberg * @ddata: pointer to drvdata 1739e3af04fSMika Westerberg * @buf: buffer where stringified bitmap is written 1749e3af04fSMika Westerberg * @type: button type (%EV_KEY, %EV_SW) 1759e3af04fSMika Westerberg * @only_disabled: does caller want only those buttons that are 1769e3af04fSMika Westerberg * currently disabled or all buttons that can be 1779e3af04fSMika Westerberg * disabled 1789e3af04fSMika Westerberg * 1799e3af04fSMika Westerberg * This function writes buttons that can be disabled to @buf. If 1809e3af04fSMika Westerberg * @only_disabled is true, then @buf contains only those buttons 1819e3af04fSMika Westerberg * that are currently disabled. Returns 0 on success or negative 1829e3af04fSMika Westerberg * errno on failure. 1839e3af04fSMika Westerberg */ 1849e3af04fSMika Westerberg static ssize_t gpio_keys_attr_show_helper(struct gpio_keys_drvdata *ddata, 1859e3af04fSMika Westerberg char *buf, unsigned int type, 1869e3af04fSMika Westerberg bool only_disabled) 1879e3af04fSMika Westerberg { 1889e3af04fSMika Westerberg int n_events = get_n_events_by_type(type); 1899e3af04fSMika Westerberg unsigned long *bits; 1909e3af04fSMika Westerberg ssize_t ret; 1919e3af04fSMika Westerberg int i; 1929e3af04fSMika Westerberg 1939e3af04fSMika Westerberg bits = kcalloc(BITS_TO_LONGS(n_events), sizeof(*bits), GFP_KERNEL); 1949e3af04fSMika Westerberg if (!bits) 1959e3af04fSMika Westerberg return -ENOMEM; 1969e3af04fSMika Westerberg 197219edc71SAlexandre Pereira da Silva for (i = 0; i < ddata->pdata->nbuttons; i++) { 1989e3af04fSMika Westerberg struct gpio_button_data *bdata = &ddata->data[i]; 1999e3af04fSMika Westerberg 2009e3af04fSMika Westerberg if (bdata->button->type != type) 2019e3af04fSMika Westerberg continue; 2029e3af04fSMika Westerberg 2039e3af04fSMika Westerberg if (only_disabled && !bdata->disabled) 2049e3af04fSMika Westerberg continue; 2059e3af04fSMika Westerberg 2069e3af04fSMika Westerberg __set_bit(bdata->button->code, bits); 2079e3af04fSMika Westerberg } 2089e3af04fSMika Westerberg 2090b480037STejun Heo ret = scnprintf(buf, PAGE_SIZE - 1, "%*pbl", n_events, bits); 2109e3af04fSMika Westerberg buf[ret++] = '\n'; 2119e3af04fSMika Westerberg buf[ret] = '\0'; 2129e3af04fSMika Westerberg 2139e3af04fSMika Westerberg kfree(bits); 2149e3af04fSMika Westerberg 2159e3af04fSMika Westerberg return ret; 2169e3af04fSMika Westerberg } 2179e3af04fSMika Westerberg 2189e3af04fSMika Westerberg /** 2199e3af04fSMika Westerberg * gpio_keys_attr_store_helper() - enable/disable buttons based on given bitmap 2209e3af04fSMika Westerberg * @ddata: pointer to drvdata 2219e3af04fSMika Westerberg * @buf: buffer from userspace that contains stringified bitmap 2229e3af04fSMika Westerberg * @type: button type (%EV_KEY, %EV_SW) 2239e3af04fSMika Westerberg * 2249e3af04fSMika Westerberg * This function parses stringified bitmap from @buf and disables/enables 225a16ca239SDmitry Torokhov * GPIO buttons accordingly. Returns 0 on success and negative error 2269e3af04fSMika Westerberg * on failure. 2279e3af04fSMika Westerberg */ 2289e3af04fSMika Westerberg static ssize_t gpio_keys_attr_store_helper(struct gpio_keys_drvdata *ddata, 2299e3af04fSMika Westerberg const char *buf, unsigned int type) 2309e3af04fSMika Westerberg { 2319e3af04fSMika Westerberg int n_events = get_n_events_by_type(type); 2328679ee42SDmitry Torokhov const unsigned long *bitmap = get_bm_events_by_type(ddata->input, type); 2339e3af04fSMika Westerberg unsigned long *bits; 2349e3af04fSMika Westerberg ssize_t error; 2359e3af04fSMika Westerberg int i; 2369e3af04fSMika Westerberg 2379e3af04fSMika Westerberg bits = kcalloc(BITS_TO_LONGS(n_events), sizeof(*bits), GFP_KERNEL); 2389e3af04fSMika Westerberg if (!bits) 2399e3af04fSMika Westerberg return -ENOMEM; 2409e3af04fSMika Westerberg 2419e3af04fSMika Westerberg error = bitmap_parselist(buf, bits, n_events); 2429e3af04fSMika Westerberg if (error) 2439e3af04fSMika Westerberg goto out; 2449e3af04fSMika Westerberg 2459e3af04fSMika Westerberg /* First validate */ 2468679ee42SDmitry Torokhov if (!bitmap_subset(bits, bitmap, n_events)) { 2478679ee42SDmitry Torokhov error = -EINVAL; 2488679ee42SDmitry Torokhov goto out; 2498679ee42SDmitry Torokhov } 2508679ee42SDmitry Torokhov 251219edc71SAlexandre Pereira da Silva for (i = 0; i < ddata->pdata->nbuttons; i++) { 2529e3af04fSMika Westerberg struct gpio_button_data *bdata = &ddata->data[i]; 2539e3af04fSMika Westerberg 2549e3af04fSMika Westerberg if (bdata->button->type != type) 2559e3af04fSMika Westerberg continue; 2569e3af04fSMika Westerberg 2579e3af04fSMika Westerberg if (test_bit(bdata->button->code, bits) && 2589e3af04fSMika Westerberg !bdata->button->can_disable) { 2599e3af04fSMika Westerberg error = -EINVAL; 2609e3af04fSMika Westerberg goto out; 2619e3af04fSMika Westerberg } 2629e3af04fSMika Westerberg } 2639e3af04fSMika Westerberg 2649e3af04fSMika Westerberg mutex_lock(&ddata->disable_lock); 2659e3af04fSMika Westerberg 266219edc71SAlexandre Pereira da Silva for (i = 0; i < ddata->pdata->nbuttons; i++) { 2679e3af04fSMika Westerberg struct gpio_button_data *bdata = &ddata->data[i]; 2689e3af04fSMika Westerberg 2699e3af04fSMika Westerberg if (bdata->button->type != type) 2709e3af04fSMika Westerberg continue; 2719e3af04fSMika Westerberg 2729e3af04fSMika Westerberg if (test_bit(bdata->button->code, bits)) 2739e3af04fSMika Westerberg gpio_keys_disable_button(bdata); 2749e3af04fSMika Westerberg else 2759e3af04fSMika Westerberg gpio_keys_enable_button(bdata); 2769e3af04fSMika Westerberg } 2779e3af04fSMika Westerberg 2789e3af04fSMika Westerberg mutex_unlock(&ddata->disable_lock); 2799e3af04fSMika Westerberg 2809e3af04fSMika Westerberg out: 2819e3af04fSMika Westerberg kfree(bits); 2829e3af04fSMika Westerberg return error; 2839e3af04fSMika Westerberg } 2849e3af04fSMika Westerberg 2859e3af04fSMika Westerberg #define ATTR_SHOW_FN(name, type, only_disabled) \ 2869e3af04fSMika Westerberg static ssize_t gpio_keys_show_##name(struct device *dev, \ 2879e3af04fSMika Westerberg struct device_attribute *attr, \ 2889e3af04fSMika Westerberg char *buf) \ 2899e3af04fSMika Westerberg { \ 2909e3af04fSMika Westerberg struct platform_device *pdev = to_platform_device(dev); \ 2919e3af04fSMika Westerberg struct gpio_keys_drvdata *ddata = platform_get_drvdata(pdev); \ 2929e3af04fSMika Westerberg \ 2939e3af04fSMika Westerberg return gpio_keys_attr_show_helper(ddata, buf, \ 2949e3af04fSMika Westerberg type, only_disabled); \ 2959e3af04fSMika Westerberg } 2969e3af04fSMika Westerberg 2979e3af04fSMika Westerberg ATTR_SHOW_FN(keys, EV_KEY, false); 2989e3af04fSMika Westerberg ATTR_SHOW_FN(switches, EV_SW, false); 2999e3af04fSMika Westerberg ATTR_SHOW_FN(disabled_keys, EV_KEY, true); 3009e3af04fSMika Westerberg ATTR_SHOW_FN(disabled_switches, EV_SW, true); 3019e3af04fSMika Westerberg 3029e3af04fSMika Westerberg /* 3039e3af04fSMika Westerberg * ATTRIBUTES: 3049e3af04fSMika Westerberg * 3059e3af04fSMika Westerberg * /sys/devices/platform/gpio-keys/keys [ro] 3069e3af04fSMika Westerberg * /sys/devices/platform/gpio-keys/switches [ro] 3079e3af04fSMika Westerberg */ 3089e3af04fSMika Westerberg static DEVICE_ATTR(keys, S_IRUGO, gpio_keys_show_keys, NULL); 3099e3af04fSMika Westerberg static DEVICE_ATTR(switches, S_IRUGO, gpio_keys_show_switches, NULL); 3109e3af04fSMika Westerberg 3119e3af04fSMika Westerberg #define ATTR_STORE_FN(name, type) \ 3129e3af04fSMika Westerberg static ssize_t gpio_keys_store_##name(struct device *dev, \ 3139e3af04fSMika Westerberg struct device_attribute *attr, \ 3149e3af04fSMika Westerberg const char *buf, \ 3159e3af04fSMika Westerberg size_t count) \ 3169e3af04fSMika Westerberg { \ 3179e3af04fSMika Westerberg struct platform_device *pdev = to_platform_device(dev); \ 3189e3af04fSMika Westerberg struct gpio_keys_drvdata *ddata = platform_get_drvdata(pdev); \ 3199e3af04fSMika Westerberg ssize_t error; \ 3209e3af04fSMika Westerberg \ 3219e3af04fSMika Westerberg error = gpio_keys_attr_store_helper(ddata, buf, type); \ 3229e3af04fSMika Westerberg if (error) \ 3239e3af04fSMika Westerberg return error; \ 3249e3af04fSMika Westerberg \ 3259e3af04fSMika Westerberg return count; \ 3269e3af04fSMika Westerberg } 3279e3af04fSMika Westerberg 3289e3af04fSMika Westerberg ATTR_STORE_FN(disabled_keys, EV_KEY); 3299e3af04fSMika Westerberg ATTR_STORE_FN(disabled_switches, EV_SW); 3309e3af04fSMika Westerberg 3319e3af04fSMika Westerberg /* 3329e3af04fSMika Westerberg * ATTRIBUTES: 3339e3af04fSMika Westerberg * 3349e3af04fSMika Westerberg * /sys/devices/platform/gpio-keys/disabled_keys [rw] 3359e3af04fSMika Westerberg * /sys/devices/platform/gpio-keys/disables_switches [rw] 3369e3af04fSMika Westerberg */ 3379e3af04fSMika Westerberg static DEVICE_ATTR(disabled_keys, S_IWUSR | S_IRUGO, 3389e3af04fSMika Westerberg gpio_keys_show_disabled_keys, 3399e3af04fSMika Westerberg gpio_keys_store_disabled_keys); 3409e3af04fSMika Westerberg static DEVICE_ATTR(disabled_switches, S_IWUSR | S_IRUGO, 3419e3af04fSMika Westerberg gpio_keys_show_disabled_switches, 3429e3af04fSMika Westerberg gpio_keys_store_disabled_switches); 3439e3af04fSMika Westerberg 3449e3af04fSMika Westerberg static struct attribute *gpio_keys_attrs[] = { 3459e3af04fSMika Westerberg &dev_attr_keys.attr, 3469e3af04fSMika Westerberg &dev_attr_switches.attr, 3479e3af04fSMika Westerberg &dev_attr_disabled_keys.attr, 3489e3af04fSMika Westerberg &dev_attr_disabled_switches.attr, 3499e3af04fSMika Westerberg NULL, 3509e3af04fSMika Westerberg }; 3519e3af04fSMika Westerberg 3529e3af04fSMika Westerberg static struct attribute_group gpio_keys_attr_group = { 3539e3af04fSMika Westerberg .attrs = gpio_keys_attrs, 3549e3af04fSMika Westerberg }; 3559e3af04fSMika Westerberg 356d8ee4a1cSLaxman Dewangan static void gpio_keys_gpio_report_event(struct gpio_button_data *bdata) 35778a56aabSPhil Blundell { 358d9080921SDmitry Torokhov const struct gpio_keys_button *button = bdata->button; 359ce25d7e9SUwe Kleine-König struct input_dev *input = bdata->input; 36084767d00SRoman Moravcik unsigned int type = button->type ?: EV_KEY; 3615feeca3cSGeert Uytterhoeven int state; 36284767d00SRoman Moravcik 3635feeca3cSGeert Uytterhoeven state = gpiod_get_value_cansleep(bdata->gpiod); 36477fa0554SBjorn Andersson if (state < 0) { 3655feeca3cSGeert Uytterhoeven dev_err(input->dev.parent, 3665feeca3cSGeert Uytterhoeven "failed to get gpio state: %d\n", state); 36777fa0554SBjorn Andersson return; 36877fa0554SBjorn Andersson } 36977fa0554SBjorn Andersson 37092a47674SAlexander Stein if (type == EV_ABS) { 37192a47674SAlexander Stein if (state) 37292a47674SAlexander Stein input_event(input, type, button->code, button->value); 37392a47674SAlexander Stein } else { 3745feeca3cSGeert Uytterhoeven input_event(input, type, button->code, state); 37592a47674SAlexander Stein } 37678a56aabSPhil Blundell input_sync(input); 377a33466e3SDmitry Baryshkov } 378a33466e3SDmitry Baryshkov 379d8ee4a1cSLaxman Dewangan static void gpio_keys_gpio_work_func(struct work_struct *work) 3806ee88d71SDaniel Mack { 3816ee88d71SDaniel Mack struct gpio_button_data *bdata = 3828ed92556SDmitry Torokhov container_of(work, struct gpio_button_data, work.work); 3836ee88d71SDaniel Mack 384d8ee4a1cSLaxman Dewangan gpio_keys_gpio_report_event(bdata); 3852fba26c6SNeilBrown 3862fba26c6SNeilBrown if (bdata->button->wakeup) 3872fba26c6SNeilBrown pm_relax(bdata->input->dev.parent); 3886ee88d71SDaniel Mack } 3896ee88d71SDaniel Mack 390d8ee4a1cSLaxman Dewangan static irqreturn_t gpio_keys_gpio_isr(int irq, void *dev_id) 391a33466e3SDmitry Baryshkov { 39257ffe9d5SUwe Kleine-König struct gpio_button_data *bdata = dev_id; 393a33466e3SDmitry Baryshkov 394d8ee4a1cSLaxman Dewangan BUG_ON(irq != bdata->irq); 395a33466e3SDmitry Baryshkov 3962fba26c6SNeilBrown if (bdata->button->wakeup) 3972fba26c6SNeilBrown pm_stay_awake(bdata->input->dev.parent); 3988ed92556SDmitry Torokhov 3998ed92556SDmitry Torokhov mod_delayed_work(system_wq, 4008ed92556SDmitry Torokhov &bdata->work, 4018ed92556SDmitry Torokhov msecs_to_jiffies(bdata->software_debounce)); 402a33466e3SDmitry Baryshkov 4031164ec1aSDavid Brownell return IRQ_HANDLED; 40478a56aabSPhil Blundell } 40578a56aabSPhil Blundell 406d8ee4a1cSLaxman Dewangan static void gpio_keys_irq_timer(unsigned long _data) 407d8ee4a1cSLaxman Dewangan { 408d8ee4a1cSLaxman Dewangan struct gpio_button_data *bdata = (struct gpio_button_data *)_data; 409d8ee4a1cSLaxman Dewangan struct input_dev *input = bdata->input; 410d8ee4a1cSLaxman Dewangan unsigned long flags; 411d8ee4a1cSLaxman Dewangan 412d8ee4a1cSLaxman Dewangan spin_lock_irqsave(&bdata->lock, flags); 413d8ee4a1cSLaxman Dewangan if (bdata->key_pressed) { 414d8ee4a1cSLaxman Dewangan input_event(input, EV_KEY, bdata->button->code, 0); 415d8ee4a1cSLaxman Dewangan input_sync(input); 416d8ee4a1cSLaxman Dewangan bdata->key_pressed = false; 417d8ee4a1cSLaxman Dewangan } 418d8ee4a1cSLaxman Dewangan spin_unlock_irqrestore(&bdata->lock, flags); 419d8ee4a1cSLaxman Dewangan } 420d8ee4a1cSLaxman Dewangan 421d8ee4a1cSLaxman Dewangan static irqreturn_t gpio_keys_irq_isr(int irq, void *dev_id) 422d8ee4a1cSLaxman Dewangan { 423d8ee4a1cSLaxman Dewangan struct gpio_button_data *bdata = dev_id; 424d8ee4a1cSLaxman Dewangan const struct gpio_keys_button *button = bdata->button; 425d8ee4a1cSLaxman Dewangan struct input_dev *input = bdata->input; 426d8ee4a1cSLaxman Dewangan unsigned long flags; 427d8ee4a1cSLaxman Dewangan 428d8ee4a1cSLaxman Dewangan BUG_ON(irq != bdata->irq); 429d8ee4a1cSLaxman Dewangan 430d8ee4a1cSLaxman Dewangan spin_lock_irqsave(&bdata->lock, flags); 431d8ee4a1cSLaxman Dewangan 432d8ee4a1cSLaxman Dewangan if (!bdata->key_pressed) { 4332fba26c6SNeilBrown if (bdata->button->wakeup) 4342fba26c6SNeilBrown pm_wakeup_event(bdata->input->dev.parent, 0); 4352fba26c6SNeilBrown 436d8ee4a1cSLaxman Dewangan input_event(input, EV_KEY, button->code, 1); 437d8ee4a1cSLaxman Dewangan input_sync(input); 438d8ee4a1cSLaxman Dewangan 4398ed92556SDmitry Torokhov if (!bdata->release_delay) { 440d8ee4a1cSLaxman Dewangan input_event(input, EV_KEY, button->code, 0); 441d8ee4a1cSLaxman Dewangan input_sync(input); 442d8ee4a1cSLaxman Dewangan goto out; 443d8ee4a1cSLaxman Dewangan } 444d8ee4a1cSLaxman Dewangan 445d8ee4a1cSLaxman Dewangan bdata->key_pressed = true; 446d8ee4a1cSLaxman Dewangan } 447d8ee4a1cSLaxman Dewangan 4488ed92556SDmitry Torokhov if (bdata->release_delay) 4498ed92556SDmitry Torokhov mod_timer(&bdata->release_timer, 4508ed92556SDmitry Torokhov jiffies + msecs_to_jiffies(bdata->release_delay)); 451d8ee4a1cSLaxman Dewangan out: 452d8ee4a1cSLaxman Dewangan spin_unlock_irqrestore(&bdata->lock, flags); 453d8ee4a1cSLaxman Dewangan return IRQ_HANDLED; 454d8ee4a1cSLaxman Dewangan } 455d8ee4a1cSLaxman Dewangan 45627245519SAlexander Shiyan static void gpio_keys_quiesce_key(void *data) 45727245519SAlexander Shiyan { 45827245519SAlexander Shiyan struct gpio_button_data *bdata = data; 45927245519SAlexander Shiyan 4605feeca3cSGeert Uytterhoeven if (bdata->gpiod) 4618ed92556SDmitry Torokhov cancel_delayed_work_sync(&bdata->work); 4628ed92556SDmitry Torokhov else 4638ed92556SDmitry Torokhov del_timer_sync(&bdata->release_timer); 46427245519SAlexander Shiyan } 46527245519SAlexander Shiyan 4665298cc4cSBill Pemberton static int gpio_keys_setup_key(struct platform_device *pdev, 467d9080921SDmitry Torokhov struct input_dev *input, 468bc8f1eafSBen Dooks struct gpio_button_data *bdata, 469*700a38b2SDmitry Torokhov const struct gpio_keys_button *button, 470*700a38b2SDmitry Torokhov struct fwnode_handle *child) 471bc8f1eafSBen Dooks { 47292a47674SAlexander Stein const char *desc = button->desc ? button->desc : "gpio_keys"; 4739e3af04fSMika Westerberg struct device *dev = &pdev->dev; 474d8ee4a1cSLaxman Dewangan irq_handler_t isr; 4759e3af04fSMika Westerberg unsigned long irqflags; 47627245519SAlexander Shiyan int irq; 47727245519SAlexander Shiyan int error; 478bc8f1eafSBen Dooks 479d9080921SDmitry Torokhov bdata->input = input; 480d9080921SDmitry Torokhov bdata->button = button; 481d8ee4a1cSLaxman Dewangan spin_lock_init(&bdata->lock); 482d8ee4a1cSLaxman Dewangan 483*700a38b2SDmitry Torokhov if (child) { 484*700a38b2SDmitry Torokhov bdata->gpiod = devm_get_gpiod_from_child(dev, NULL, child); 485*700a38b2SDmitry Torokhov if (IS_ERR(bdata->gpiod)) { 486*700a38b2SDmitry Torokhov error = PTR_ERR(bdata->gpiod); 487*700a38b2SDmitry Torokhov if (error == -ENOENT) { 488*700a38b2SDmitry Torokhov /* 489*700a38b2SDmitry Torokhov * GPIO is optional, we may be dealing with 490*700a38b2SDmitry Torokhov * purely interrupt-driven setup. 491*700a38b2SDmitry Torokhov */ 492*700a38b2SDmitry Torokhov bdata->gpiod = NULL; 493*700a38b2SDmitry Torokhov } else { 494*700a38b2SDmitry Torokhov if (error != -EPROBE_DEFER) 495*700a38b2SDmitry Torokhov dev_err(dev, "failed to get gpio: %d\n", 496*700a38b2SDmitry Torokhov error); 497*700a38b2SDmitry Torokhov return error; 498*700a38b2SDmitry Torokhov } 499*700a38b2SDmitry Torokhov } 500*700a38b2SDmitry Torokhov } else if (gpio_is_valid(button->gpio)) { 5015feeca3cSGeert Uytterhoeven /* 5025feeca3cSGeert Uytterhoeven * Legacy GPIO number, so request the GPIO here and 5035feeca3cSGeert Uytterhoeven * convert it to descriptor. 5045feeca3cSGeert Uytterhoeven */ 5055feeca3cSGeert Uytterhoeven unsigned flags = GPIOF_IN; 506bc8f1eafSBen Dooks 5075feeca3cSGeert Uytterhoeven if (button->active_low) 5085feeca3cSGeert Uytterhoeven flags |= GPIOF_ACTIVE_LOW; 5095feeca3cSGeert Uytterhoeven 5105feeca3cSGeert Uytterhoeven error = devm_gpio_request_one(&pdev->dev, button->gpio, flags, 5115feeca3cSGeert Uytterhoeven desc); 512bc8f1eafSBen Dooks if (error < 0) { 513d8ee4a1cSLaxman Dewangan dev_err(dev, "Failed to request GPIO %d, error %d\n", 514bc8f1eafSBen Dooks button->gpio, error); 515d8ee4a1cSLaxman Dewangan return error; 516bc8f1eafSBen Dooks } 517bc8f1eafSBen Dooks 5185feeca3cSGeert Uytterhoeven bdata->gpiod = gpio_to_desc(button->gpio); 5195feeca3cSGeert Uytterhoeven if (!bdata->gpiod) 5205feeca3cSGeert Uytterhoeven return -EINVAL; 521*700a38b2SDmitry Torokhov } 5225feeca3cSGeert Uytterhoeven 523*700a38b2SDmitry Torokhov if (bdata->gpiod) { 52428ed684fSGrazvydas Ignotas if (button->debounce_interval) { 5255feeca3cSGeert Uytterhoeven error = gpiod_set_debounce(bdata->gpiod, 52628ed684fSGrazvydas Ignotas button->debounce_interval * 1000); 52728ed684fSGrazvydas Ignotas /* use timer if gpiolib doesn't provide debounce */ 52828ed684fSGrazvydas Ignotas if (error < 0) 5298ed92556SDmitry Torokhov bdata->software_debounce = 530d8ee4a1cSLaxman Dewangan button->debounce_interval; 53128ed684fSGrazvydas Ignotas } 53228ed684fSGrazvydas Ignotas 53397d86e07SDmitry Torokhov if (button->irq) { 53497d86e07SDmitry Torokhov bdata->irq = button->irq; 53597d86e07SDmitry Torokhov } else { 5365feeca3cSGeert Uytterhoeven irq = gpiod_to_irq(bdata->gpiod); 537bc8f1eafSBen Dooks if (irq < 0) { 538bc8f1eafSBen Dooks error = irq; 539d8ee4a1cSLaxman Dewangan dev_err(dev, 540d8ee4a1cSLaxman Dewangan "Unable to get irq number for GPIO %d, error %d\n", 541bc8f1eafSBen Dooks button->gpio, error); 54227245519SAlexander Shiyan return error; 543d8ee4a1cSLaxman Dewangan } 544d8ee4a1cSLaxman Dewangan bdata->irq = irq; 54597d86e07SDmitry Torokhov } 546d8ee4a1cSLaxman Dewangan 5478ed92556SDmitry Torokhov INIT_DELAYED_WORK(&bdata->work, gpio_keys_gpio_work_func); 548d8ee4a1cSLaxman Dewangan 549d8ee4a1cSLaxman Dewangan isr = gpio_keys_gpio_isr; 550d8ee4a1cSLaxman Dewangan irqflags = IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING; 551d8ee4a1cSLaxman Dewangan 552d8ee4a1cSLaxman Dewangan } else { 553d8ee4a1cSLaxman Dewangan if (!button->irq) { 554*700a38b2SDmitry Torokhov dev_err(dev, "Found button without gpio or irq\n"); 555d8ee4a1cSLaxman Dewangan return -EINVAL; 556d8ee4a1cSLaxman Dewangan } 557*700a38b2SDmitry Torokhov 558d8ee4a1cSLaxman Dewangan bdata->irq = button->irq; 559d8ee4a1cSLaxman Dewangan 560d8ee4a1cSLaxman Dewangan if (button->type && button->type != EV_KEY) { 561d8ee4a1cSLaxman Dewangan dev_err(dev, "Only EV_KEY allowed for IRQ buttons.\n"); 562d8ee4a1cSLaxman Dewangan return -EINVAL; 563bc8f1eafSBen Dooks } 564bc8f1eafSBen Dooks 5658ed92556SDmitry Torokhov bdata->release_delay = button->debounce_interval; 5668ed92556SDmitry Torokhov setup_timer(&bdata->release_timer, 567d8ee4a1cSLaxman Dewangan gpio_keys_irq_timer, (unsigned long)bdata); 568d8ee4a1cSLaxman Dewangan 569d8ee4a1cSLaxman Dewangan isr = gpio_keys_irq_isr; 570d8ee4a1cSLaxman Dewangan irqflags = 0; 571d8ee4a1cSLaxman Dewangan } 572d8ee4a1cSLaxman Dewangan 573d8ee4a1cSLaxman Dewangan input_set_capability(input, button->type ?: EV_KEY, button->code); 574d8ee4a1cSLaxman Dewangan 5759e3af04fSMika Westerberg /* 5768ed92556SDmitry Torokhov * Install custom action to cancel release timer and 57727245519SAlexander Shiyan * workqueue item. 57827245519SAlexander Shiyan */ 57927245519SAlexander Shiyan error = devm_add_action(&pdev->dev, gpio_keys_quiesce_key, bdata); 58027245519SAlexander Shiyan if (error) { 58127245519SAlexander Shiyan dev_err(&pdev->dev, 58227245519SAlexander Shiyan "failed to register quiesce action, error: %d\n", 58327245519SAlexander Shiyan error); 58427245519SAlexander Shiyan return error; 58527245519SAlexander Shiyan } 58627245519SAlexander Shiyan 58727245519SAlexander Shiyan /* 5889e3af04fSMika Westerberg * If platform has specified that the button can be disabled, 5899e3af04fSMika Westerberg * we don't want it to share the interrupt line. 5909e3af04fSMika Westerberg */ 5919e3af04fSMika Westerberg if (!button->can_disable) 5929e3af04fSMika Westerberg irqflags |= IRQF_SHARED; 5939e3af04fSMika Westerberg 59427245519SAlexander Shiyan error = devm_request_any_context_irq(&pdev->dev, bdata->irq, 59527245519SAlexander Shiyan isr, irqflags, desc, bdata); 59694a8cab8SPhilippe Langlais if (error < 0) { 597bc8f1eafSBen Dooks dev_err(dev, "Unable to claim irq %d; error %d\n", 598d8ee4a1cSLaxman Dewangan bdata->irq, error); 59927245519SAlexander Shiyan return error; 600bc8f1eafSBen Dooks } 601bc8f1eafSBen Dooks 602bc8f1eafSBen Dooks return 0; 603bc8f1eafSBen Dooks } 604bc8f1eafSBen Dooks 6055b76d7b4SDmitry Torokhov static void gpio_keys_report_state(struct gpio_keys_drvdata *ddata) 6065b76d7b4SDmitry Torokhov { 6075b76d7b4SDmitry Torokhov struct input_dev *input = ddata->input; 6085b76d7b4SDmitry Torokhov int i; 6095b76d7b4SDmitry Torokhov 6105b76d7b4SDmitry Torokhov for (i = 0; i < ddata->pdata->nbuttons; i++) { 6115b76d7b4SDmitry Torokhov struct gpio_button_data *bdata = &ddata->data[i]; 6125feeca3cSGeert Uytterhoeven if (bdata->gpiod) 6135b76d7b4SDmitry Torokhov gpio_keys_gpio_report_event(bdata); 6145b76d7b4SDmitry Torokhov } 6155b76d7b4SDmitry Torokhov input_sync(input); 6165b76d7b4SDmitry Torokhov } 6175b76d7b4SDmitry Torokhov 618173bdd74SShubhrajyoti D static int gpio_keys_open(struct input_dev *input) 619173bdd74SShubhrajyoti D { 620173bdd74SShubhrajyoti D struct gpio_keys_drvdata *ddata = input_get_drvdata(input); 621219edc71SAlexandre Pereira da Silva const struct gpio_keys_platform_data *pdata = ddata->pdata; 6225b76d7b4SDmitry Torokhov int error; 623173bdd74SShubhrajyoti D 6245b76d7b4SDmitry Torokhov if (pdata->enable) { 6255b76d7b4SDmitry Torokhov error = pdata->enable(input->dev.parent); 6265b76d7b4SDmitry Torokhov if (error) 6275b76d7b4SDmitry Torokhov return error; 6285b76d7b4SDmitry Torokhov } 6295b76d7b4SDmitry Torokhov 6305b76d7b4SDmitry Torokhov /* Report current state of buttons that are connected to GPIOs */ 6315b76d7b4SDmitry Torokhov gpio_keys_report_state(ddata); 6325b76d7b4SDmitry Torokhov 6335b76d7b4SDmitry Torokhov return 0; 634173bdd74SShubhrajyoti D } 635173bdd74SShubhrajyoti D 636173bdd74SShubhrajyoti D static void gpio_keys_close(struct input_dev *input) 637173bdd74SShubhrajyoti D { 638173bdd74SShubhrajyoti D struct gpio_keys_drvdata *ddata = input_get_drvdata(input); 639219edc71SAlexandre Pereira da Silva const struct gpio_keys_platform_data *pdata = ddata->pdata; 640173bdd74SShubhrajyoti D 641219edc71SAlexandre Pereira da Silva if (pdata->disable) 642219edc71SAlexandre Pereira da Silva pdata->disable(input->dev.parent); 643173bdd74SShubhrajyoti D } 644173bdd74SShubhrajyoti D 645fd05d089SDavid Jander /* 646fd05d089SDavid Jander * Handlers for alternative sources of platform_data 647fd05d089SDavid Jander */ 648219edc71SAlexandre Pereira da Silva 649fd05d089SDavid Jander /* 650*700a38b2SDmitry Torokhov * Translate properties into platform_data 651fd05d089SDavid Jander */ 6525298cc4cSBill Pemberton static struct gpio_keys_platform_data * 653219edc71SAlexandre Pereira da Silva gpio_keys_get_devtree_pdata(struct device *dev) 654fd05d089SDavid Jander { 655219edc71SAlexandre Pereira da Silva struct gpio_keys_platform_data *pdata; 656219edc71SAlexandre Pereira da Silva struct gpio_keys_button *button; 657*700a38b2SDmitry Torokhov struct fwnode_handle *child; 658219edc71SAlexandre Pereira da Silva int nbuttons; 659fd05d089SDavid Jander 660*700a38b2SDmitry Torokhov nbuttons = device_get_child_node_count(dev); 6615d422f2eSAndy Shevchenko if (nbuttons == 0) 6625d422f2eSAndy Shevchenko return ERR_PTR(-ENODEV); 663219edc71SAlexandre Pereira da Silva 6645d422f2eSAndy Shevchenko pdata = devm_kzalloc(dev, 6655d422f2eSAndy Shevchenko sizeof(*pdata) + nbuttons * sizeof(*button), 666219edc71SAlexandre Pereira da Silva GFP_KERNEL); 6675d422f2eSAndy Shevchenko if (!pdata) 6685d422f2eSAndy Shevchenko return ERR_PTR(-ENOMEM); 669219edc71SAlexandre Pereira da Silva 6700f78ba96SDmitry Torokhov button = (struct gpio_keys_button *)(pdata + 1); 6710f78ba96SDmitry Torokhov 6720f78ba96SDmitry Torokhov pdata->buttons = button; 673219edc71SAlexandre Pereira da Silva pdata->nbuttons = nbuttons; 674fd05d089SDavid Jander 675*700a38b2SDmitry Torokhov pdata->rep = device_property_read_bool(dev, "autorepeat"); 676fd05d089SDavid Jander 677*700a38b2SDmitry Torokhov device_property_read_string(dev, "label", &pdata->name); 678c4dc5f8cSLaxman Dewangan 679*700a38b2SDmitry Torokhov device_for_each_child_node(dev, child) { 680*700a38b2SDmitry Torokhov if (is_of_node(child)) 681*700a38b2SDmitry Torokhov button->irq = 682*700a38b2SDmitry Torokhov irq_of_parse_and_map(to_of_node(child), 0); 683fd05d089SDavid Jander 684*700a38b2SDmitry Torokhov if (fwnode_property_read_u32(child, "linux,code", 685*700a38b2SDmitry Torokhov &button->code)) { 686*700a38b2SDmitry Torokhov dev_err(dev, "Button without keycode\n"); 687*700a38b2SDmitry Torokhov fwnode_handle_put(child); 68897d86e07SDmitry Torokhov return ERR_PTR(-EINVAL); 68997d86e07SDmitry Torokhov } 690fd05d089SDavid Jander 691*700a38b2SDmitry Torokhov fwnode_property_read_string(child, "label", &button->desc); 692fd05d089SDavid Jander 693*700a38b2SDmitry Torokhov if (fwnode_property_read_u32(child, "linux,input-type", 694*700a38b2SDmitry Torokhov &button->type)) 695219edc71SAlexandre Pereira da Silva button->type = EV_KEY; 696fd05d089SDavid Jander 697*700a38b2SDmitry Torokhov button->wakeup = 698*700a38b2SDmitry Torokhov fwnode_property_read_bool(child, "wakeup-source") || 69999b4ffbdSDmitry Torokhov /* legacy name */ 700*700a38b2SDmitry Torokhov fwnode_property_read_bool(child, "gpio-key,wakeup"); 701219edc71SAlexandre Pereira da Silva 702*700a38b2SDmitry Torokhov button->can_disable = 703*700a38b2SDmitry Torokhov fwnode_property_read_bool(child, "linux,can-disable"); 70497d86e07SDmitry Torokhov 705*700a38b2SDmitry Torokhov if (fwnode_property_read_u32(child, "debounce-interval", 706219edc71SAlexandre Pereira da Silva &button->debounce_interval)) 707219edc71SAlexandre Pereira da Silva button->debounce_interval = 5; 7080f78ba96SDmitry Torokhov 7090f78ba96SDmitry Torokhov button++; 710219edc71SAlexandre Pereira da Silva } 711219edc71SAlexandre Pereira da Silva 712219edc71SAlexandre Pereira da Silva return pdata; 713fd05d089SDavid Jander } 714fd05d089SDavid Jander 71522daae31SJingoo Han static const struct of_device_id gpio_keys_of_match[] = { 716fd05d089SDavid Jander { .compatible = "gpio-keys", }, 717fd05d089SDavid Jander { }, 718fd05d089SDavid Jander }; 719fd05d089SDavid Jander MODULE_DEVICE_TABLE(of, gpio_keys_of_match); 720fd05d089SDavid Jander 7215298cc4cSBill Pemberton static int gpio_keys_probe(struct platform_device *pdev) 72278a56aabSPhil Blundell { 723db19fd8bSBen Dooks struct device *dev = &pdev->dev; 724219edc71SAlexandre Pereira da Silva const struct gpio_keys_platform_data *pdata = dev_get_platdata(dev); 725*700a38b2SDmitry Torokhov struct fwnode_handle *child = NULL; 726219edc71SAlexandre Pereira da Silva struct gpio_keys_drvdata *ddata; 72778a56aabSPhil Blundell struct input_dev *input; 7285d422f2eSAndy Shevchenko size_t size; 72978a56aabSPhil Blundell int i, error; 730e15b0213SAnti Sullin int wakeup = 0; 73178a56aabSPhil Blundell 732fd05d089SDavid Jander if (!pdata) { 733219edc71SAlexandre Pereira da Silva pdata = gpio_keys_get_devtree_pdata(dev); 734219edc71SAlexandre Pereira da Silva if (IS_ERR(pdata)) 735219edc71SAlexandre Pereira da Silva return PTR_ERR(pdata); 736fd05d089SDavid Jander } 737fd05d089SDavid Jander 7385d422f2eSAndy Shevchenko size = sizeof(struct gpio_keys_drvdata) + 7395d422f2eSAndy Shevchenko pdata->nbuttons * sizeof(struct gpio_button_data); 7405d422f2eSAndy Shevchenko ddata = devm_kzalloc(dev, size, GFP_KERNEL); 7415d422f2eSAndy Shevchenko if (!ddata) { 742db19fd8bSBen Dooks dev_err(dev, "failed to allocate state\n"); 7435d422f2eSAndy Shevchenko return -ENOMEM; 7445d422f2eSAndy Shevchenko } 7455d422f2eSAndy Shevchenko 7465d422f2eSAndy Shevchenko input = devm_input_allocate_device(dev); 7475d422f2eSAndy Shevchenko if (!input) { 7485d422f2eSAndy Shevchenko dev_err(dev, "failed to allocate input device\n"); 7495d422f2eSAndy Shevchenko return -ENOMEM; 750a33466e3SDmitry Baryshkov } 75178a56aabSPhil Blundell 752219edc71SAlexandre Pereira da Silva ddata->pdata = pdata; 7539e3af04fSMika Westerberg ddata->input = input; 7549e3af04fSMika Westerberg mutex_init(&ddata->disable_lock); 7559e3af04fSMika Westerberg 756a33466e3SDmitry Baryshkov platform_set_drvdata(pdev, ddata); 757173bdd74SShubhrajyoti D input_set_drvdata(input, ddata); 75878a56aabSPhil Blundell 75946711277SAlexander Stein input->name = pdata->name ? : pdev->name; 76078a56aabSPhil Blundell input->phys = "gpio-keys/input0"; 761469ba4dfSDmitry Torokhov input->dev.parent = &pdev->dev; 762173bdd74SShubhrajyoti D input->open = gpio_keys_open; 763173bdd74SShubhrajyoti D input->close = gpio_keys_close; 76478a56aabSPhil Blundell 76578a56aabSPhil Blundell input->id.bustype = BUS_HOST; 76678a56aabSPhil Blundell input->id.vendor = 0x0001; 76778a56aabSPhil Blundell input->id.product = 0x0001; 76878a56aabSPhil Blundell input->id.version = 0x0100; 76978a56aabSPhil Blundell 770b67b4b11SDominic Curran /* Enable auto repeat feature of Linux input subsystem */ 771b67b4b11SDominic Curran if (pdata->rep) 772b67b4b11SDominic Curran __set_bit(EV_REP, input->evbit); 773b67b4b11SDominic Curran 77478a56aabSPhil Blundell for (i = 0; i < pdata->nbuttons; i++) { 775d9080921SDmitry Torokhov const struct gpio_keys_button *button = &pdata->buttons[i]; 776a33466e3SDmitry Baryshkov struct gpio_button_data *bdata = &ddata->data[i]; 77778a56aabSPhil Blundell 778*700a38b2SDmitry Torokhov if (!dev_get_platdata(dev)) { 779*700a38b2SDmitry Torokhov child = device_get_next_child_node(&pdev->dev, child); 780*700a38b2SDmitry Torokhov if (!child) { 781*700a38b2SDmitry Torokhov dev_err(&pdev->dev, 782*700a38b2SDmitry Torokhov "missing child device node for entry %d\n", 783*700a38b2SDmitry Torokhov i); 784*700a38b2SDmitry Torokhov return -EINVAL; 785*700a38b2SDmitry Torokhov } 786*700a38b2SDmitry Torokhov } 787*700a38b2SDmitry Torokhov 788*700a38b2SDmitry Torokhov error = gpio_keys_setup_key(pdev, input, bdata, button, child); 789*700a38b2SDmitry Torokhov if (error) { 790*700a38b2SDmitry Torokhov fwnode_handle_put(child); 79127245519SAlexander Shiyan return error; 792*700a38b2SDmitry Torokhov } 79384767d00SRoman Moravcik 794e15b0213SAnti Sullin if (button->wakeup) 795e15b0213SAnti Sullin wakeup = 1; 79678a56aabSPhil Blundell } 79778a56aabSPhil Blundell 798*700a38b2SDmitry Torokhov fwnode_handle_put(child); 799*700a38b2SDmitry Torokhov 8009e3af04fSMika Westerberg error = sysfs_create_group(&pdev->dev.kobj, &gpio_keys_attr_group); 8019e3af04fSMika Westerberg if (error) { 8029e3af04fSMika Westerberg dev_err(dev, "Unable to export keys/switches, error: %d\n", 8039e3af04fSMika Westerberg error); 80427245519SAlexander Shiyan return error; 8059e3af04fSMika Westerberg } 8069e3af04fSMika Westerberg 80778a56aabSPhil Blundell error = input_register_device(input); 80878a56aabSPhil Blundell if (error) { 8099e3af04fSMika Westerberg dev_err(dev, "Unable to register input device, error: %d\n", 8109e3af04fSMika Westerberg error); 81127245519SAlexander Shiyan goto err_remove_group; 81278a56aabSPhil Blundell } 81378a56aabSPhil Blundell 814e15b0213SAnti Sullin device_init_wakeup(&pdev->dev, wakeup); 815e15b0213SAnti Sullin 81678a56aabSPhil Blundell return 0; 81778a56aabSPhil Blundell 81827245519SAlexander Shiyan err_remove_group: 8199e3af04fSMika Westerberg sysfs_remove_group(&pdev->dev.kobj, &gpio_keys_attr_group); 82078a56aabSPhil Blundell return error; 82178a56aabSPhil Blundell } 82278a56aabSPhil Blundell 823e2619cf7SBill Pemberton static int gpio_keys_remove(struct platform_device *pdev) 82478a56aabSPhil Blundell { 8259e3af04fSMika Westerberg sysfs_remove_group(&pdev->dev.kobj, &gpio_keys_attr_group); 8269e3af04fSMika Westerberg 827e15b0213SAnti Sullin device_init_wakeup(&pdev->dev, 0); 828e15b0213SAnti Sullin 82978a56aabSPhil Blundell return 0; 83078a56aabSPhil Blundell } 83178a56aabSPhil Blundell 832f9645f22SDmitry Torokhov static int __maybe_unused gpio_keys_suspend(struct device *dev) 833e15b0213SAnti Sullin { 834fd05d089SDavid Jander struct gpio_keys_drvdata *ddata = dev_get_drvdata(dev); 835dda19a92SJonas Aaberg struct input_dev *input = ddata->input; 836e15b0213SAnti Sullin int i; 837e15b0213SAnti Sullin 838fd05d089SDavid Jander if (device_may_wakeup(dev)) { 839219edc71SAlexandre Pereira da Silva for (i = 0; i < ddata->pdata->nbuttons; i++) { 840d8ee4a1cSLaxman Dewangan struct gpio_button_data *bdata = &ddata->data[i]; 841d8ee4a1cSLaxman Dewangan if (bdata->button->wakeup) 842d8ee4a1cSLaxman Dewangan enable_irq_wake(bdata->irq); 843e15b0213SAnti Sullin } 844dda19a92SJonas Aaberg } else { 845dda19a92SJonas Aaberg mutex_lock(&input->mutex); 846dda19a92SJonas Aaberg if (input->users) 847dda19a92SJonas Aaberg gpio_keys_close(input); 848dda19a92SJonas Aaberg mutex_unlock(&input->mutex); 849e15b0213SAnti Sullin } 850e15b0213SAnti Sullin 851e15b0213SAnti Sullin return 0; 852e15b0213SAnti Sullin } 853e15b0213SAnti Sullin 854f9645f22SDmitry Torokhov static int __maybe_unused gpio_keys_resume(struct device *dev) 855e15b0213SAnti Sullin { 856fd05d089SDavid Jander struct gpio_keys_drvdata *ddata = dev_get_drvdata(dev); 857dda19a92SJonas Aaberg struct input_dev *input = ddata->input; 858dda19a92SJonas Aaberg int error = 0; 859e15b0213SAnti Sullin int i; 860e15b0213SAnti Sullin 861dda19a92SJonas Aaberg if (device_may_wakeup(dev)) { 862219edc71SAlexandre Pereira da Silva for (i = 0; i < ddata->pdata->nbuttons; i++) { 863d8ee4a1cSLaxman Dewangan struct gpio_button_data *bdata = &ddata->data[i]; 864dda19a92SJonas Aaberg if (bdata->button->wakeup) 865d8ee4a1cSLaxman Dewangan disable_irq_wake(bdata->irq); 866e15b0213SAnti Sullin } 867dda19a92SJonas Aaberg } else { 868dda19a92SJonas Aaberg mutex_lock(&input->mutex); 869dda19a92SJonas Aaberg if (input->users) 870dda19a92SJonas Aaberg error = gpio_keys_open(input); 871dda19a92SJonas Aaberg mutex_unlock(&input->mutex); 872dda19a92SJonas Aaberg } 873dda19a92SJonas Aaberg 874dda19a92SJonas Aaberg if (error) 875dda19a92SJonas Aaberg return error; 8765b76d7b4SDmitry Torokhov 8775b76d7b4SDmitry Torokhov gpio_keys_report_state(ddata); 878e15b0213SAnti Sullin return 0; 879e15b0213SAnti Sullin } 880e15b0213SAnti Sullin 881bdda8216SDmitry Torokhov static SIMPLE_DEV_PM_OPS(gpio_keys_pm_ops, gpio_keys_suspend, gpio_keys_resume); 882bdda8216SDmitry Torokhov 8839b07044cSUwe Kleine-König static struct platform_driver gpio_keys_device_driver = { 88478a56aabSPhil Blundell .probe = gpio_keys_probe, 8851cb0aa88SBill Pemberton .remove = gpio_keys_remove, 88678a56aabSPhil Blundell .driver = { 88778a56aabSPhil Blundell .name = "gpio-keys", 888ae78e0e0SMike Rapoport .pm = &gpio_keys_pm_ops, 889*700a38b2SDmitry Torokhov .of_match_table = gpio_keys_of_match, 89078a56aabSPhil Blundell } 89178a56aabSPhil Blundell }; 89278a56aabSPhil Blundell 89378a56aabSPhil Blundell static int __init gpio_keys_init(void) 89478a56aabSPhil Blundell { 89578a56aabSPhil Blundell return platform_driver_register(&gpio_keys_device_driver); 89678a56aabSPhil Blundell } 89778a56aabSPhil Blundell 89878a56aabSPhil Blundell static void __exit gpio_keys_exit(void) 89978a56aabSPhil Blundell { 90078a56aabSPhil Blundell platform_driver_unregister(&gpio_keys_device_driver); 90178a56aabSPhil Blundell } 90278a56aabSPhil Blundell 903b2330205SDavid Jander late_initcall(gpio_keys_init); 90478a56aabSPhil Blundell module_exit(gpio_keys_exit); 90578a56aabSPhil Blundell 90678a56aabSPhil Blundell MODULE_LICENSE("GPL"); 90778a56aabSPhil Blundell MODULE_AUTHOR("Phil Blundell <pb@handhelds.org>"); 9087e2ecdf4SDavid Jander MODULE_DESCRIPTION("Keyboard driver for GPIOs"); 909d7b5247bSKay Sievers MODULE_ALIAS("platform:gpio-keys"); 910