ANDROID: Input: Generic GPIO Input device. (ca984139) · Commits · e / devices / android_kernel_fairphone_FP3

drivers/input/misc/Kconfig

+5 −0

Original line number	Diff line number	Diff line
		@@ -535,6 +535,11 @@ config INPUT_SGI_BTNS
		To compile this driver as a module, choose M here: the
		module will be called sgi_btns.

		config INPUT_GPIO
		tristate "GPIO driver support"
		help
		Say Y here if you want to support gpio based keys, wheels etc...

		config HP_SDC_RTC
		tristate "HP SDC Real Time Clock"
		depends on (GSC \|\| HP300) && SERIO

drivers/input/misc/Makefile

+1 −0

Original line number	Diff line number	Diff line
		@@ -36,6 +36,7 @@ obj-$(CONFIG_INPUT_GP2A) += gp2ap002a00f.o
		obj-$(CONFIG_INPUT_GPIO_BEEPER) += gpio-beeper.o
		obj-$(CONFIG_INPUT_GPIO_TILT_POLLED) += gpio_tilt_polled.o
		obj-$(CONFIG_INPUT_GPIO_DECODER) += gpio_decoder.o
		obj-$(CONFIG_INPUT_GPIO) += gpio_event.o gpio_matrix.o gpio_input.o gpio_output.o gpio_axis.o
		obj-$(CONFIG_INPUT_HISI_POWERKEY) += hisi_powerkey.o
		obj-$(CONFIG_HP_SDC_RTC) += hp_sdc_rtc.o
		obj-$(CONFIG_INPUT_IMS_PCU) += ims-pcu.o

drivers/input/misc/gpio_axis.c

0 → 100644

+192 −0

Original line number	Diff line number	Diff line
		/* drivers/input/misc/gpio_axis.c
		*
		* Copyright (C) 2007 Google, Inc.
		*
		* This software is licensed under the terms of the GNU General Public
		* License version 2, as published by the Free Software Foundation, and
		* may be copied, distributed, and modified under those terms.
		*
		* This program is distributed in the hope that it will be useful,
		* but WITHOUT ANY WARRANTY; without even the implied warranty of
		* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
		* GNU General Public License for more details.
		*
		*/

		#include <linux/kernel.h>
		#include <linux/gpio.h>
		#include <linux/gpio_event.h>
		#include <linux/interrupt.h>
		#include <linux/slab.h>

		struct gpio_axis_state {
		struct gpio_event_input_devs *input_devs;
		struct gpio_event_axis_info *info;
		uint32_t pos;
		};

		uint16_t gpio_axis_4bit_gray_map_table[] = {
		[0x0] = 0x0, [0x1] = 0x1, /* 0000 0001 */
		[0x3] = 0x2, [0x2] = 0x3, /* 0011 0010 */
		[0x6] = 0x4, [0x7] = 0x5, /* 0110 0111 */
		[0x5] = 0x6, [0x4] = 0x7, /* 0101 0100 */
		[0xc] = 0x8, [0xd] = 0x9, /* 1100 1101 */
		[0xf] = 0xa, [0xe] = 0xb, /* 1111 1110 */
		[0xa] = 0xc, [0xb] = 0xd, /* 1010 1011 */
		[0x9] = 0xe, [0x8] = 0xf, /* 1001 1000 */
		};
		uint16_t gpio_axis_4bit_gray_map(struct gpio_event_axis_info *info, uint16_t in)
		{
		return gpio_axis_4bit_gray_map_table[in];
		}

		uint16_t gpio_axis_5bit_singletrack_map_table[] = {
		[0x10] = 0x00, [0x14] = 0x01, [0x1c] = 0x02, /* 10000 10100 11100 */
		[0x1e] = 0x03, [0x1a] = 0x04, [0x18] = 0x05, /* 11110 11010 11000 */
		[0x08] = 0x06, [0x0a] = 0x07, [0x0e] = 0x08, /* 01000 01010 01110 */
		[0x0f] = 0x09, [0x0d] = 0x0a, [0x0c] = 0x0b, /* 01111 01101 01100 */
		[0x04] = 0x0c, [0x05] = 0x0d, [0x07] = 0x0e, /* 00100 00101 00111 */
		[0x17] = 0x0f, [0x16] = 0x10, [0x06] = 0x11, /* 10111 10110 00110 */
		[0x02] = 0x12, [0x12] = 0x13, [0x13] = 0x14, /* 00010 10010 10011 */
		[0x1b] = 0x15, [0x0b] = 0x16, [0x03] = 0x17, /* 11011 01011 00011 */
		[0x01] = 0x18, [0x09] = 0x19, [0x19] = 0x1a, /* 00001 01001 11001 */
		[0x1d] = 0x1b, [0x15] = 0x1c, [0x11] = 0x1d, /* 11101 10101 10001 */
		};
		uint16_t gpio_axis_5bit_singletrack_map(
		struct gpio_event_axis_info *info, uint16_t in)
		{
		return gpio_axis_5bit_singletrack_map_table[in];
		}

		static void gpio_event_update_axis(struct gpio_axis_state *as, int report)
		{
		struct gpio_event_axis_info *ai = as->info;
		int i;
		int change;
		uint16_t state = 0;
		uint16_t pos;
		uint16_t old_pos = as->pos;
		for (i = ai->count - 1; i >= 0; i--)
		state = (state << 1) \| gpio_get_value(ai->gpio[i]);
		pos = ai->map(ai, state);
		if (ai->flags & GPIOEAF_PRINT_RAW)
		pr_info("axis %d-%d raw %x, pos %d -> %d\n",
		ai->type, ai->code, state, old_pos, pos);
		if (report && pos != old_pos) {
		if (ai->type == EV_REL) {
		change = (ai->decoded_size + pos - old_pos) %
		ai->decoded_size;
		if (change > ai->decoded_size / 2)
		change -= ai->decoded_size;
		if (change == ai->decoded_size / 2) {
		if (ai->flags & GPIOEAF_PRINT_EVENT)
		pr_info("axis %d-%d unknown direction, "
		"pos %d -> %d\n", ai->type,
		ai->code, old_pos, pos);
		change = 0; /* no closest direction */
		}
		if (ai->flags & GPIOEAF_PRINT_EVENT)
		pr_info("axis %d-%d change %d\n",
		ai->type, ai->code, change);
		input_report_rel(as->input_devs->dev[ai->dev],
		ai->code, change);
		} else {
		if (ai->flags & GPIOEAF_PRINT_EVENT)
		pr_info("axis %d-%d now %d\n",
		ai->type, ai->code, pos);
		input_event(as->input_devs->dev[ai->dev],
		ai->type, ai->code, pos);
		}
		input_sync(as->input_devs->dev[ai->dev]);
		}
		as->pos = pos;
		}

		static irqreturn_t gpio_axis_irq_handler(int irq, void *dev_id)
		{
		struct gpio_axis_state *as = dev_id;
		gpio_event_update_axis(as, 1);
		return IRQ_HANDLED;
		}

		int gpio_event_axis_func(struct gpio_event_input_devs *input_devs,
		struct gpio_event_info info, void *data, int func)
		{
		int ret;
		int i;
		int irq;
		struct gpio_event_axis_info *ai;
		struct gpio_axis_state *as;

		ai = container_of(info, struct gpio_event_axis_info, info);
		if (func == GPIO_EVENT_FUNC_SUSPEND) {
		for (i = 0; i < ai->count; i++)
		disable_irq(gpio_to_irq(ai->gpio[i]));
		return 0;
		}
		if (func == GPIO_EVENT_FUNC_RESUME) {
		for (i = 0; i < ai->count; i++)
		enable_irq(gpio_to_irq(ai->gpio[i]));
		return 0;
		}

		if (func == GPIO_EVENT_FUNC_INIT) {
		data = as = kmalloc(sizeof(as), GFP_KERNEL);
		if (as == NULL) {
		ret = -ENOMEM;
		goto err_alloc_axis_state_failed;
		}
		as->input_devs = input_devs;
		as->info = ai;
		if (ai->dev >= input_devs->count) {
		pr_err("gpio_event_axis: bad device index %d >= %d "
		"for %d:%d\n", ai->dev, input_devs->count,
		ai->type, ai->code);
		ret = -EINVAL;
		goto err_bad_device_index;
		}

		input_set_capability(input_devs->dev[ai->dev],
		ai->type, ai->code);
		if (ai->type == EV_ABS) {
		input_set_abs_params(input_devs->dev[ai->dev], ai->code,
		0, ai->decoded_size - 1, 0, 0);
		}
		for (i = 0; i < ai->count; i++) {
		ret = gpio_request(ai->gpio[i], "gpio_event_axis");
		if (ret < 0)
		goto err_request_gpio_failed;
		ret = gpio_direction_input(ai->gpio[i]);
		if (ret < 0)
		goto err_gpio_direction_input_failed;
		ret = irq = gpio_to_irq(ai->gpio[i]);
		if (ret < 0)
		goto err_get_irq_num_failed;
		ret = request_irq(irq, gpio_axis_irq_handler,
		IRQF_TRIGGER_RISING \|
		IRQF_TRIGGER_FALLING,
		"gpio_event_axis", as);
		if (ret < 0)
		goto err_request_irq_failed;
		}
		gpio_event_update_axis(as, 0);
		return 0;
		}

		ret = 0;
		as = *data;
		for (i = ai->count - 1; i >= 0; i--) {
		free_irq(gpio_to_irq(ai->gpio[i]), as);
		err_request_irq_failed:
		err_get_irq_num_failed:
		err_gpio_direction_input_failed:
		gpio_free(ai->gpio[i]);
		err_request_gpio_failed:
		;
		}
		err_bad_device_index:
		kfree(as);
		*data = NULL;
		err_alloc_axis_state_failed:
		return ret;
		}

drivers/input/misc/gpio_event.c

0 → 100644

+249 −0

Original line number	Diff line number	Diff line
		/* drivers/input/misc/gpio_event.c
		*
		* Copyright (C) 2007 Google, Inc.
		*
		* This software is licensed under the terms of the GNU General Public
		* License version 2, as published by the Free Software Foundation, and
		* may be copied, distributed, and modified under those terms.
		*
		* This program is distributed in the hope that it will be useful,
		* but WITHOUT ANY WARRANTY; without even the implied warranty of
		* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
		* GNU General Public License for more details.
		*
		*/

		#include <linux/earlysuspend.h>
		#include <linux/module.h>
		#include <linux/input.h>
		#include <linux/gpio_event.h>
		#include <linux/hrtimer.h>
		#include <linux/platform_device.h>
		#include <linux/slab.h>

		struct gpio_event {
		struct gpio_event_input_devs *input_devs;
		const struct gpio_event_platform_data *info;
		struct early_suspend early_suspend;
		void *state[0];
		};

		static int gpio_input_event(
		struct input_dev *dev, unsigned int type, unsigned int code, int value)
		{
		int i;
		int devnr;
		int ret = 0;
		int tmp_ret;
		struct gpio_event_info **ii;
		struct gpio_event *ip = input_get_drvdata(dev);

		for (devnr = 0; devnr < ip->input_devs->count; devnr++)
		if (ip->input_devs->dev[devnr] == dev)
		break;
		if (devnr == ip->input_devs->count) {
		pr_err("gpio_input_event: unknown device %p\n", dev);
		return -EIO;
		}

		for (i = 0, ii = ip->info->info; i < ip->info->info_count; i++, ii++) {
		if ((*ii)->event) {
		tmp_ret = (ii)->event(ip->input_devs, ii,
		&ip->state[i],
		devnr, type, code, value);
		if (tmp_ret)
		ret = tmp_ret;
		}
		}
		return ret;
		}

		static int gpio_event_call_all_func(struct gpio_event *ip, int func)
		{
		int i;
		int ret;
		struct gpio_event_info **ii;

		if (func == GPIO_EVENT_FUNC_INIT \|\| func == GPIO_EVENT_FUNC_RESUME) {
		ii = ip->info->info;
		for (i = 0; i < ip->info->info_count; i++, ii++) {
		if ((*ii)->func == NULL) {
		ret = -ENODEV;
		pr_err("gpio_event_probe: Incomplete pdata, "
		"no function\n");
		goto err_no_func;
		}
		if (func == GPIO_EVENT_FUNC_RESUME && (*ii)->no_suspend)
		continue;
		ret = (ii)->func(ip->input_devs, ii, &ip->state[i],
		func);
		if (ret) {
		pr_err("gpio_event_probe: function failed\n");
		goto err_func_failed;
		}
		}
		return 0;
		}

		ret = 0;
		i = ip->info->info_count;
		ii = ip->info->info + i;
		while (i > 0) {
		i--;
		ii--;
		if ((func & ~1) == GPIO_EVENT_FUNC_SUSPEND && (*ii)->no_suspend)
		continue;
		(ii)->func(ip->input_devs, ii, &ip->state[i], func & ~1);
		err_func_failed:
		err_no_func:
		;
		}
		return ret;
		}

		#ifdef CONFIG_HAS_EARLYSUSPEND
		void gpio_event_suspend(struct early_suspend *h)
		{
		struct gpio_event *ip;
		ip = container_of(h, struct gpio_event, early_suspend);
		gpio_event_call_all_func(ip, GPIO_EVENT_FUNC_SUSPEND);
		ip->info->power(ip->info, 0);
		}

		void gpio_event_resume(struct early_suspend *h)
		{
		struct gpio_event *ip;
		ip = container_of(h, struct gpio_event, early_suspend);
		ip->info->power(ip->info, 1);
		gpio_event_call_all_func(ip, GPIO_EVENT_FUNC_RESUME);
		}
		#endif

		static int gpio_event_probe(struct platform_device *pdev)
		{
		int err;
		struct gpio_event *ip;
		struct gpio_event_platform_data *event_info;
		int dev_count = 1;
		int i;
		int registered = 0;

		event_info = pdev->dev.platform_data;
		if (event_info == NULL) {
		pr_err("gpio_event_probe: No pdata\n");
		return -ENODEV;
		}
		if ((!event_info->name && !event_info->names[0]) \|\|
		!event_info->info \|\| !event_info->info_count) {
		pr_err("gpio_event_probe: Incomplete pdata\n");
		return -ENODEV;
		}
		if (!event_info->name)
		while (event_info->names[dev_count])
		dev_count++;
		ip = kzalloc(sizeof(*ip) +
		sizeof(ip->state[0]) * event_info->info_count +
		sizeof(*ip->input_devs) +
		sizeof(ip->input_devs->dev[0]) * dev_count, GFP_KERNEL);
		if (ip == NULL) {
		err = -ENOMEM;
		pr_err("gpio_event_probe: Failed to allocate private data\n");
		goto err_kp_alloc_failed;
		}
		ip->input_devs = (void*)&ip->state[event_info->info_count];
		platform_set_drvdata(pdev, ip);

		for (i = 0; i < dev_count; i++) {
		struct input_dev *input_dev = input_allocate_device();
		if (input_dev == NULL) {
		err = -ENOMEM;
		pr_err("gpio_event_probe: "
		"Failed to allocate input device\n");
		goto err_input_dev_alloc_failed;
		}
		input_set_drvdata(input_dev, ip);
		input_dev->name = event_info->name ?
		event_info->name : event_info->names[i];
		input_dev->event = gpio_input_event;
		ip->input_devs->dev[i] = input_dev;
		}
		ip->input_devs->count = dev_count;
		ip->info = event_info;
		if (event_info->power) {
		#ifdef CONFIG_HAS_EARLYSUSPEND
		ip->early_suspend.level = EARLY_SUSPEND_LEVEL_BLANK_SCREEN + 1;
		ip->early_suspend.suspend = gpio_event_suspend;
		ip->early_suspend.resume = gpio_event_resume;
		register_early_suspend(&ip->early_suspend);
		#endif
		ip->info->power(ip->info, 1);
		}

		err = gpio_event_call_all_func(ip, GPIO_EVENT_FUNC_INIT);
		if (err)
		goto err_call_all_func_failed;

		for (i = 0; i < dev_count; i++) {
		err = input_register_device(ip->input_devs->dev[i]);
		if (err) {
		pr_err("gpio_event_probe: Unable to register %s "
		"input device\n", ip->input_devs->dev[i]->name);
		goto err_input_register_device_failed;
		}
		registered++;
		}

		return 0;

		err_input_register_device_failed:
		gpio_event_call_all_func(ip, GPIO_EVENT_FUNC_UNINIT);
		err_call_all_func_failed:
		if (event_info->power) {
		#ifdef CONFIG_HAS_EARLYSUSPEND
		unregister_early_suspend(&ip->early_suspend);
		#endif
		ip->info->power(ip->info, 0);
		}
		for (i = 0; i < registered; i++)
		input_unregister_device(ip->input_devs->dev[i]);
		for (i = dev_count - 1; i >= registered; i--) {
		input_free_device(ip->input_devs->dev[i]);
		err_input_dev_alloc_failed:
		;
		}
		kfree(ip);
		err_kp_alloc_failed:
		return err;
		}

		static int gpio_event_remove(struct platform_device *pdev)
		{
		struct gpio_event *ip = platform_get_drvdata(pdev);
		int i;

		gpio_event_call_all_func(ip, GPIO_EVENT_FUNC_UNINIT);
		if (ip->info->power) {
		#ifdef CONFIG_HAS_EARLYSUSPEND
		unregister_early_suspend(&ip->early_suspend);
		#endif
		ip->info->power(ip->info, 0);
		}
		for (i = 0; i < ip->input_devs->count; i++)
		input_unregister_device(ip->input_devs->dev[i]);
		kfree(ip);
		return 0;
		}

		static struct platform_driver gpio_event_driver = {
		.probe = gpio_event_probe,
		.remove = gpio_event_remove,
		.driver = {
		.name = GPIO_EVENT_DEV_NAME,
		},
		};

		module_platform_driver(gpio_event_driver);

		MODULE_DESCRIPTION("GPIO Event Driver");
		MODULE_LICENSE("GPL");

drivers/input/misc/gpio_input.c

0 → 100644

+376 −0

Original line number	Diff line number	Diff line
		/* drivers/input/misc/gpio_input.c
		*
		* Copyright (C) 2007 Google, Inc.
		*
		* This software is licensed under the terms of the GNU General Public
		* License version 2, as published by the Free Software Foundation, and
		* may be copied, distributed, and modified under those terms.
		*
		* This program is distributed in the hope that it will be useful,
		* but WITHOUT ANY WARRANTY; without even the implied warranty of
		* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
		* GNU General Public License for more details.
		*
		*/

		#include <linux/kernel.h>
		#include <linux/gpio.h>
		#include <linux/gpio_event.h>
		#include <linux/hrtimer.h>
		#include <linux/input.h>
		#include <linux/interrupt.h>
		#include <linux/slab.h>
		#include <linux/wakelock.h>

		enum {
		DEBOUNCE_UNSTABLE = BIT(0), /* Got irq, while debouncing */
		DEBOUNCE_PRESSED = BIT(1),
		DEBOUNCE_NOTPRESSED = BIT(2),
		DEBOUNCE_WAIT_IRQ = BIT(3), /* Stable irq state */
		DEBOUNCE_POLL = BIT(4), /* Stable polling state */

		DEBOUNCE_UNKNOWN =
		DEBOUNCE_PRESSED \| DEBOUNCE_NOTPRESSED,
		};

		struct gpio_key_state {
		struct gpio_input_state *ds;
		uint8_t debounce;
		};

		struct gpio_input_state {
		struct gpio_event_input_devs *input_devs;
		const struct gpio_event_input_info *info;
		struct hrtimer timer;
		int use_irq;
		int debounce_count;
		spinlock_t irq_lock;
		struct wake_lock wake_lock;
		struct gpio_key_state key_state[0];
		};

		static enum hrtimer_restart gpio_event_input_timer_func(struct hrtimer *timer)
		{
		int i;
		int pressed;
		struct gpio_input_state *ds =
		container_of(timer, struct gpio_input_state, timer);
		unsigned gpio_flags = ds->info->flags;
		unsigned npolarity;
		int nkeys = ds->info->keymap_size;
		const struct gpio_event_direct_entry *key_entry;
		struct gpio_key_state *key_state;
		unsigned long irqflags;
		uint8_t debounce;
		bool sync_needed;

		#if 0
		key_entry = kp->keys_info->keymap;
		key_state = kp->key_state;
		for (i = 0; i < nkeys; i++, key_entry++, key_state++)
		pr_info("gpio_read_detect_status %d %d\n", key_entry->gpio,
		gpio_read_detect_status(key_entry->gpio));
		#endif
		key_entry = ds->info->keymap;
		key_state = ds->key_state;
		sync_needed = false;
		spin_lock_irqsave(&ds->irq_lock, irqflags);
		for (i = 0; i < nkeys; i++, key_entry++, key_state++) {
		debounce = key_state->debounce;
		if (debounce & DEBOUNCE_WAIT_IRQ)
		continue;
		if (key_state->debounce & DEBOUNCE_UNSTABLE) {
		debounce = key_state->debounce = DEBOUNCE_UNKNOWN;
		enable_irq(gpio_to_irq(key_entry->gpio));
		if (gpio_flags & GPIOEDF_PRINT_KEY_UNSTABLE)
		pr_info("gpio_keys_scan_keys: key %x-%x, %d "
		"(%d) continue debounce\n",
		ds->info->type, key_entry->code,
		i, key_entry->gpio);
		}
		npolarity = !(gpio_flags & GPIOEDF_ACTIVE_HIGH);
		pressed = gpio_get_value(key_entry->gpio) ^ npolarity;
		if (debounce & DEBOUNCE_POLL) {
		if (pressed == !(debounce & DEBOUNCE_PRESSED)) {
		ds->debounce_count++;
		key_state->debounce = DEBOUNCE_UNKNOWN;
		if (gpio_flags & GPIOEDF_PRINT_KEY_DEBOUNCE)
		pr_info("gpio_keys_scan_keys: key %x-"
		"%x, %d (%d) start debounce\n",
		ds->info->type, key_entry->code,
		i, key_entry->gpio);
		}
		continue;
		}
		if (pressed && (debounce & DEBOUNCE_NOTPRESSED)) {
		if (gpio_flags & GPIOEDF_PRINT_KEY_DEBOUNCE)
		pr_info("gpio_keys_scan_keys: key %x-%x, %d "
		"(%d) debounce pressed 1\n",
		ds->info->type, key_entry->code,
		i, key_entry->gpio);
		key_state->debounce = DEBOUNCE_PRESSED;
		continue;
		}
		if (!pressed && (debounce & DEBOUNCE_PRESSED)) {
		if (gpio_flags & GPIOEDF_PRINT_KEY_DEBOUNCE)
		pr_info("gpio_keys_scan_keys: key %x-%x, %d "
		"(%d) debounce pressed 0\n",
		ds->info->type, key_entry->code,
		i, key_entry->gpio);
		key_state->debounce = DEBOUNCE_NOTPRESSED;
		continue;
		}
		/* key is stable */
		ds->debounce_count--;
		if (ds->use_irq)
		key_state->debounce \|= DEBOUNCE_WAIT_IRQ;
		else
		key_state->debounce \|= DEBOUNCE_POLL;
		if (gpio_flags & GPIOEDF_PRINT_KEYS)
		pr_info("gpio_keys_scan_keys: key %x-%x, %d (%d) "
		"changed to %d\n", ds->info->type,
		key_entry->code, i, key_entry->gpio, pressed);
		input_event(ds->input_devs->dev[key_entry->dev], ds->info->type,
		key_entry->code, pressed);
		sync_needed = true;
		}
		if (sync_needed) {
		for (i = 0; i < ds->input_devs->count; i++)
		input_sync(ds->input_devs->dev[i]);
		}

		#if 0
		key_entry = kp->keys_info->keymap;
		key_state = kp->key_state;
		for (i = 0; i < nkeys; i++, key_entry++, key_state++) {
		pr_info("gpio_read_detect_status %d %d\n", key_entry->gpio,
		gpio_read_detect_status(key_entry->gpio));
		}
		#endif

		if (ds->debounce_count)
		hrtimer_start(timer, ds->info->debounce_time, HRTIMER_MODE_REL);
		else if (!ds->use_irq)
		hrtimer_start(timer, ds->info->poll_time, HRTIMER_MODE_REL);
		else
		wake_unlock(&ds->wake_lock);

		spin_unlock_irqrestore(&ds->irq_lock, irqflags);

		return HRTIMER_NORESTART;
		}

		static irqreturn_t gpio_event_input_irq_handler(int irq, void *dev_id)
		{
		struct gpio_key_state *ks = dev_id;
		struct gpio_input_state *ds = ks->ds;
		int keymap_index = ks - ds->key_state;
		const struct gpio_event_direct_entry *key_entry;
		unsigned long irqflags;
		int pressed;

		if (!ds->use_irq)
		return IRQ_HANDLED;

		key_entry = &ds->info->keymap[keymap_index];

		if (ds->info->debounce_time.tv64) {
		spin_lock_irqsave(&ds->irq_lock, irqflags);
		if (ks->debounce & DEBOUNCE_WAIT_IRQ) {
		ks->debounce = DEBOUNCE_UNKNOWN;
		if (ds->debounce_count++ == 0) {
		wake_lock(&ds->wake_lock);
		hrtimer_start(
		&ds->timer, ds->info->debounce_time,
		HRTIMER_MODE_REL);
		}
		if (ds->info->flags & GPIOEDF_PRINT_KEY_DEBOUNCE)
		pr_info("gpio_event_input_irq_handler: "
		"key %x-%x, %d (%d) start debounce\n",
		ds->info->type, key_entry->code,
		keymap_index, key_entry->gpio);
		} else {
		disable_irq_nosync(irq);
		ks->debounce = DEBOUNCE_UNSTABLE;
		}
		spin_unlock_irqrestore(&ds->irq_lock, irqflags);
		} else {
		pressed = gpio_get_value(key_entry->gpio) ^
		!(ds->info->flags & GPIOEDF_ACTIVE_HIGH);
		if (ds->info->flags & GPIOEDF_PRINT_KEYS)
		pr_info("gpio_event_input_irq_handler: key %x-%x, %d "
		"(%d) changed to %d\n",
		ds->info->type, key_entry->code, keymap_index,
		key_entry->gpio, pressed);
		input_event(ds->input_devs->dev[key_entry->dev], ds->info->type,
		key_entry->code, pressed);
		input_sync(ds->input_devs->dev[key_entry->dev]);
		}
		return IRQ_HANDLED;
		}

		static int gpio_event_input_request_irqs(struct gpio_input_state *ds)
		{
		int i;
		int err;
		unsigned int irq;
		unsigned long req_flags = IRQF_TRIGGER_RISING \| IRQF_TRIGGER_FALLING;

		for (i = 0; i < ds->info->keymap_size; i++) {
		err = irq = gpio_to_irq(ds->info->keymap[i].gpio);
		if (err < 0)
		goto err_gpio_get_irq_num_failed;
		err = request_irq(irq, gpio_event_input_irq_handler,
		req_flags, "gpio_keys", &ds->key_state[i]);
		if (err) {
		pr_err("gpio_event_input_request_irqs: request_irq "
		"failed for input %d, irq %d\n",
		ds->info->keymap[i].gpio, irq);
		goto err_request_irq_failed;
		}
		if (ds->info->info.no_suspend) {
		err = enable_irq_wake(irq);
		if (err) {
		pr_err("gpio_event_input_request_irqs: "
		"enable_irq_wake failed for input %d, "
		"irq %d\n",
		ds->info->keymap[i].gpio, irq);
		goto err_enable_irq_wake_failed;
		}
		}
		}
		return 0;

		for (i = ds->info->keymap_size - 1; i >= 0; i--) {
		irq = gpio_to_irq(ds->info->keymap[i].gpio);
		if (ds->info->info.no_suspend)
		disable_irq_wake(irq);
		err_enable_irq_wake_failed:
		free_irq(irq, &ds->key_state[i]);
		err_request_irq_failed:
		err_gpio_get_irq_num_failed:
		;
		}
		return err;
		}

		int gpio_event_input_func(struct gpio_event_input_devs *input_devs,
		struct gpio_event_info info, void *data, int func)
		{
		int ret;
		int i;
		unsigned long irqflags;
		struct gpio_event_input_info *di;
		struct gpio_input_state ds = data;

		di = container_of(info, struct gpio_event_input_info, info);

		if (func == GPIO_EVENT_FUNC_SUSPEND) {
		if (ds->use_irq)
		for (i = 0; i < di->keymap_size; i++)
		disable_irq(gpio_to_irq(di->keymap[i].gpio));
		hrtimer_cancel(&ds->timer);
		return 0;
		}
		if (func == GPIO_EVENT_FUNC_RESUME) {
		spin_lock_irqsave(&ds->irq_lock, irqflags);
		if (ds->use_irq)
		for (i = 0; i < di->keymap_size; i++)
		enable_irq(gpio_to_irq(di->keymap[i].gpio));
		hrtimer_start(&ds->timer, ktime_set(0, 0), HRTIMER_MODE_REL);
		spin_unlock_irqrestore(&ds->irq_lock, irqflags);
		return 0;
		}

		if (func == GPIO_EVENT_FUNC_INIT) {
		if (ktime_to_ns(di->poll_time) <= 0)
		di->poll_time = ktime_set(0, 20 * NSEC_PER_MSEC);

		data = ds = kzalloc(sizeof(ds) + sizeof(ds->key_state[0]) *
		di->keymap_size, GFP_KERNEL);
		if (ds == NULL) {
		ret = -ENOMEM;
		pr_err("gpio_event_input_func: "
		"Failed to allocate private data\n");
		goto err_ds_alloc_failed;
		}
		ds->debounce_count = di->keymap_size;
		ds->input_devs = input_devs;
		ds->info = di;
		wake_lock_init(&ds->wake_lock, WAKE_LOCK_SUSPEND, "gpio_input");
		spin_lock_init(&ds->irq_lock);

		for (i = 0; i < di->keymap_size; i++) {
		int dev = di->keymap[i].dev;
		if (dev >= input_devs->count) {
		pr_err("gpio_event_input_func: bad device "
		"index %d >= %d for key code %d\n",
		dev, input_devs->count,
		di->keymap[i].code);
		ret = -EINVAL;
		goto err_bad_keymap;
		}
		input_set_capability(input_devs->dev[dev], di->type,
		di->keymap[i].code);
		ds->key_state[i].ds = ds;
		ds->key_state[i].debounce = DEBOUNCE_UNKNOWN;
		}

		for (i = 0; i < di->keymap_size; i++) {
		ret = gpio_request(di->keymap[i].gpio, "gpio_kp_in");
		if (ret) {
		pr_err("gpio_event_input_func: gpio_request "
		"failed for %d\n", di->keymap[i].gpio);
		goto err_gpio_request_failed;
		}
		ret = gpio_direction_input(di->keymap[i].gpio);
		if (ret) {
		pr_err("gpio_event_input_func: "
		"gpio_direction_input failed for %d\n",
		di->keymap[i].gpio);
		goto err_gpio_configure_failed;
		}
		}

		ret = gpio_event_input_request_irqs(ds);

		spin_lock_irqsave(&ds->irq_lock, irqflags);
		ds->use_irq = ret == 0;

		pr_info("GPIO Input Driver: Start gpio inputs for %s%s in %s "
		"mode\n", input_devs->dev[0]->name,
		(input_devs->count > 1) ? "..." : "",
		ret == 0 ? "interrupt" : "polling");

		hrtimer_init(&ds->timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
		ds->timer.function = gpio_event_input_timer_func;
		hrtimer_start(&ds->timer, ktime_set(0, 0), HRTIMER_MODE_REL);
		spin_unlock_irqrestore(&ds->irq_lock, irqflags);
		return 0;
		}

		ret = 0;
		spin_lock_irqsave(&ds->irq_lock, irqflags);
		hrtimer_cancel(&ds->timer);
		if (ds->use_irq) {
		for (i = di->keymap_size - 1; i >= 0; i--) {
		int irq = gpio_to_irq(di->keymap[i].gpio);
		if (ds->info->info.no_suspend)
		disable_irq_wake(irq);
		free_irq(irq, &ds->key_state[i]);
		}
		}
		spin_unlock_irqrestore(&ds->irq_lock, irqflags);

		for (i = di->keymap_size - 1; i >= 0; i--) {
		err_gpio_configure_failed:
		gpio_free(di->keymap[i].gpio);
		err_gpio_request_failed:
		;
		}
		err_bad_keymap:
		wake_lock_destroy(&ds->wake_lock);
		kfree(ds);
		err_ds_alloc_failed:
		return ret;
		}