add the 'goldfish' target, useful for experimenting with virtual phone hardware (includes the emulator)

SVN-Revision: 16459

1 files changed, 1460 insertions, 0 deletions

diff --git a/target/linux/goldfish/patches-2.6.30/0086-Input-Generic-GPIO-Input-device.patch b/target/linux/goldfish/patches-2.6.30/0086-Input-Generic-GPIO-Input-device.patch
new file mode 100644
index 0000000000..1025633802
--- /dev/null
+++ b/target/linux/goldfish/patches-2.6.30/0086-Input-Generic-GPIO-Input-device.patch
@@ -0,0 +1,1460 @@
+From 6730377482c05a1742abb92f1463701f5d084a27 Mon Sep 17 00:00:00 2001
+From: =?utf-8?q?Arve=20Hj=C3=B8nnev=C3=A5g?= <arve@android.com>
+Date: Wed, 15 Oct 2008 18:23:47 -0700
+Subject: [PATCH 086/134] Input: Generic GPIO Input device.
+MIME-Version: 1.0
+Content-Type: text/plain; charset=utf-8
+Content-Transfer-Encoding: 8bit
+
+Supports keyboard matrixces, direct inputs, direct outputs and axes connected to gpios.
+
+Signed-off-by: Arve Hjønnevåg <arve@android.com>
+Signed-off-by: Nick Pelly <npelly@google.com>
+---
+ drivers/input/misc/Kconfig       |    5 +
+ drivers/input/misc/Makefile      |    1 +
+ drivers/input/misc/gpio_axis.c   |  180 +++++++++++++++++
+ drivers/input/misc/gpio_event.c  |  224 +++++++++++++++++++++
+ drivers/input/misc/gpio_input.c  |  343 ++++++++++++++++++++++++++++++++
+ drivers/input/misc/gpio_matrix.c |  406 ++++++++++++++++++++++++++++++++++++++
+ drivers/input/misc/gpio_output.c |   84 ++++++++
+ include/linux/gpio_event.h       |  154 ++++++++++++++
+ 8 files changed, 1397 insertions(+), 0 deletions(-)
+ create mode 100644 drivers/input/misc/gpio_axis.c
+ create mode 100644 drivers/input/misc/gpio_event.c
+ create mode 100644 drivers/input/misc/gpio_input.c
+ create mode 100644 drivers/input/misc/gpio_matrix.c
+ create mode 100644 drivers/input/misc/gpio_output.c
+ create mode 100644 include/linux/gpio_event.h
+
+--- a/drivers/input/misc/Kconfig
++++ b/drivers/input/misc/Kconfig
+@@ -212,6 +212,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
+--- a/drivers/input/misc/Makefile
++++ b/drivers/input/misc/Makefile
+@@ -25,3 +25,5 @@ obj-$(CONFIG_INPUT_UINPUT)		+= uinput.o
+ obj-$(CONFIG_INPUT_WISTRON_BTNS)	+= wistron_btns.o
+ obj-$(CONFIG_INPUT_YEALINK)		+= yealink.o
+ obj-$(CONFIG_INPUT_GPIO_BUTTONS)	+= gpio_buttons.o
++obj-$(CONFIG_INPUT_GPIO)		+= gpio_event.o gpio_matrix.o gpio_input.o gpio_output.o gpio_axis.o
++
+--- /dev/null
++++ b/drivers/input/misc/gpio_axis.c
+@@ -0,0 +1,180 @@
++/* 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>
++
++struct gpio_axis_state {
++	struct input_dev *input_dev;
++	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_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_dev, ai->type, ai->code, pos);
++		}
++		input_sync(as->input_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 input_dev *input_dev,
++			 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_dev = input_dev;
++		as->info = ai;
++
++		input_set_capability(input_dev, ai->type, ai->code);
++		if (ai->type == EV_ABS) {
++			input_set_abs_params(input_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:
++		;
++	}
++	kfree(as);
++	*data = NULL;
++err_alloc_axis_state_failed:
++	return ret;
++}
+--- /dev/null
++++ b/drivers/input/misc/gpio_event.c
+@@ -0,0 +1,224 @@
++/* 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>
++
++struct gpio_event {
++	struct input_dev *input_dev;
++	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 ret = 0;
++	int tmp_ret;
++	struct gpio_event_info **ii;
++	struct gpio_event *ip = input_get_drvdata(dev);
++
++	for (i = 0, ii = ip->info->info; i < ip->info->info_count; i++, ii++) {
++		if ((*ii)->event) {
++			tmp_ret = (*ii)->event(ip->input_dev, *ii,
++					&ip->state[i], 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;
++			}
++			ret = (*ii)->func(ip->input_dev, *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--;
++		(*ii)->func(ip->input_dev, *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 __init gpio_event_probe(struct platform_device *pdev)
++{
++	int err;
++	struct gpio_event *ip;
++	struct input_dev *input_dev;
++	struct gpio_event_platform_data *event_info;
++
++	event_info = pdev->dev.platform_data;
++	if (event_info == NULL) {
++		pr_err("gpio_event_probe: No pdata\n");
++		return -ENODEV;
++	}
++	if (event_info->name == NULL ||
++	   event_info->info == NULL ||
++	   event_info->info_count == 0) {
++		pr_err("gpio_event_probe: Incomplete pdata\n");
++		return -ENODEV;
++	}
++	ip = kzalloc(sizeof(*ip) +
++		     sizeof(ip->state[0]) * event_info->info_count, GFP_KERNEL);
++	if (ip == NULL) {
++		err = -ENOMEM;
++		pr_err("gpio_event_probe: Failed to allocate private data\n");
++		goto err_kp_alloc_failed;
++	}
++	platform_set_drvdata(pdev, ip);
++
++	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);
++	ip->input_dev = input_dev;
++	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);
++	}
++
++	input_dev->name = ip->info->name;
++	input_dev->event = gpio_input_event;
++
++	err = gpio_event_call_all_func(ip, GPIO_EVENT_FUNC_INIT);
++	if (err)
++		goto err_call_all_func_failed;
++
++	err = input_register_device(input_dev);
++	if (err) {
++		pr_err("gpio_event_probe: Unable to register %s input device\n",
++			input_dev->name);
++		goto err_input_register_device_failed;
++	}
++
++	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);
++	}
++	input_free_device(input_dev);
++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);
++
++	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);
++	}
++	input_unregister_device(ip->input_dev);
++	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,
++	},
++};
++
++static int __devinit gpio_event_init(void)
++{
++	return platform_driver_register(&gpio_event_driver);
++}
++
++static void __exit gpio_event_exit(void)
++{
++	platform_driver_unregister(&gpio_event_driver);
++}
++
++module_init(gpio_event_init);
++module_exit(gpio_event_exit);
++
++MODULE_DESCRIPTION("GPIO Event Driver");
++MODULE_LICENSE("GPL");
++
+--- /dev/null
++++ b/drivers/input/misc/gpio_input.c
+@@ -0,0 +1,343 @@
++/* 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/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 input_dev *input_dev;
++	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;
++
++#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;
++	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));
++			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_dev, ds->info->type,
++			    key_entry->code, pressed);
++	}
++
++#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(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_dev, ds->info->type,
++			    key_entry->code, pressed);
++	}
++	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;
++		}
++		enable_irq_wake(irq);
++	}
++	return 0;
++
++	for (i = ds->info->keymap_size - 1; i >= 0; i--) {
++		free_irq(gpio_to_irq(ds->info->keymap[i].gpio),
++			 &ds->key_state[i]);
++err_request_irq_failed:
++err_gpio_get_irq_num_failed:
++		;
++	}
++	return err;
++}
++
++int gpio_event_input_func(struct input_dev *input_dev,
++			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) {
++		spin_lock_irqsave(&ds->irq_lock, irqflags);
++		if (ds->use_irq)
++			for (i = 0; i < di->keymap_size; i++)
++				disable_irq(gpio_to_irq(di->keymap[i].gpio));
++		spin_unlock_irqrestore(&ds->irq_lock, irqflags);
++		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_dev = input_dev;
++		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++) {
++			input_set_capability(input_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 in %s "
++			"mode\n",
++			input_dev->name, 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--) {
++			free_irq(gpio_to_irq(di->keymap[i].gpio),
++				 &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:
++		;
++	}
++	wake_lock_destroy(&ds->wake_lock);
++	kfree(ds);
++err_ds_alloc_failed:
++	return ret;
++}
+--- /dev/null
++++ b/drivers/input/misc/gpio_matrix.c
+@@ -0,0 +1,406 @@
++/* drivers/input/misc/gpio_matrix.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/interrupt.h>
++#include <linux/wakelock.h>
++
++struct gpio_kp {
++	struct input_dev *input_dev;
++	struct gpio_event_matrix_info *keypad_info;
++	struct hrtimer timer;
++	struct wake_lock wake_lock;
++	int current_output;
++	unsigned int use_irq:1;
++	unsigned int key_state_changed:1;
++	unsigned int last_key_state_changed:1;
++	unsigned int some_keys_pressed:2;
++	unsigned long keys_pressed[0];
++};
++
++static void clear_phantom_key(struct gpio_kp *kp, int out, int in)
++{
++	struct gpio_event_matrix_info *mi = kp->keypad_info;
++	int key_index = out * mi->ninputs + in;
++	unsigned short keycode = mi->keymap[key_index];;
++
++	if (!test_bit(keycode, kp->input_dev->key)) {
++		if (mi->flags & GPIOKPF_PRINT_PHANTOM_KEYS)
++			pr_info("gpiomatrix: phantom key %x, %d-%d (%d-%d) "
++				"cleared\n", keycode, out, in,
++				mi->output_gpios[out], mi->input_gpios[in]);
++		__clear_bit(key_index, kp->keys_pressed);
++	} else {
++		if (mi->flags & GPIOKPF_PRINT_PHANTOM_KEYS)
++			pr_info("gpiomatrix: phantom key %x, %d-%d (%d-%d) "
++				"not cleared\n", keycode, out, in,
++				mi->output_gpios[out], mi->input_gpios[in]);
++	}
++}
++
++static int restore_keys_for_input(struct gpio_kp *kp, int out, int in)
++{
++	int rv = 0;
++	int key_index;
++
++	key_index = out * kp->keypad_info->ninputs + in;
++	while (out < kp->keypad_info->noutputs) {
++		if (test_bit(key_index, kp->keys_pressed)) {
++			rv = 1;
++			clear_phantom_key(kp, out, in);
++		}
++		key_index += kp->keypad_info->ninputs;
++		out++;
++	}
++	return rv;
++}
++
++static void remove_phantom_keys(struct gpio_kp *kp)
++{
++	int out, in, inp;
++	int key_index;
++
++	if (kp->some_keys_pressed < 3)
++		return;
++
++	for (out = 0; out < kp->keypad_info->noutputs; out++) {
++		inp = -1;
++		key_index = out * kp->keypad_info->ninputs;
++		for (in = 0; in < kp->keypad_info->ninputs; in++, key_index++) {
++			if (test_bit(key_index, kp->keys_pressed)) {
++				if (inp == -1) {
++					inp = in;
++					continue;
++				}
++				if (inp >= 0) {
++					if (!restore_keys_for_input(kp, out + 1,
++									inp))
++						break;
++					clear_phantom_key(kp, out, inp);
++					inp = -2;
++				}
++				restore_keys_for_input(kp, out, in);
++			}
++		}
++	}
++}
++
++static void report_key(struct gpio_kp *kp, int key_index, int out, int in)
++{
++	struct gpio_event_matrix_info *mi = kp->keypad_info;
++	int pressed = test_bit(key_index, kp->keys_pressed);
++	unsigned short keycode = mi->keymap[key_index];
++	if (pressed != test_bit(keycode, kp->input_dev->key)) {
++		if (keycode == KEY_RESERVED) {
++			if (mi->flags & GPIOKPF_PRINT_UNMAPPED_KEYS)
++				pr_info("gpiomatrix: unmapped key, %d-%d "
++					"(%d-%d) changed to %d\n",
++					out, in, mi->output_gpios[out],
++					mi->input_gpios[in], pressed);
++		} else {
++			if (mi->flags & GPIOKPF_PRINT_MAPPED_KEYS)
++				pr_info("gpiomatrix: key %x, %d-%d (%d-%d) "
++					"changed to %d\n", keycode,
++					out, in, mi->output_gpios[out],
++					mi->input_gpios[in], pressed);
++			input_report_key(kp->input_dev, keycode, pressed);
++		}
++	}
++}
++
++static enum hrtimer_restart gpio_keypad_timer_func(struct hrtimer *timer)
++{
++	int out, in;
++	int key_index;
++	int gpio;
++	struct gpio_kp *kp = container_of(timer, struct gpio_kp, timer);
++	struct gpio_event_matrix_info *mi = kp->keypad_info;
++	unsigned gpio_keypad_flags = mi->flags;
++	unsigned polarity = !!(gpio_keypad_flags & GPIOKPF_ACTIVE_HIGH);
++
++	out = kp->current_output;
++	if (out == mi->noutputs) {
++		out = 0;
++		kp->last_key_state_changed = kp->key_state_changed;
++		kp->key_state_changed = 0;
++		kp->some_keys_pressed = 0;
++	} else {
++		key_index = out * mi->ninputs;
++		for (in = 0; in < mi->ninputs; in++, key_index++) {
++			gpio = mi->input_gpios[in];
++			if (gpio_get_value(gpio) ^ !polarity) {
++				if (kp->some_keys_pressed < 3)
++					kp->some_keys_pressed++;
++				kp->key_state_changed |= !__test_and_set_bit(
++						key_index, kp->keys_pressed);
++			} else
++				kp->key_state_changed |= __test_and_clear_bit(
++						key_index, kp->keys_pressed);
++		}
++		gpio = mi->output_gpios[out];
++		if (gpio_keypad_flags & GPIOKPF_DRIVE_INACTIVE)
++			gpio_set_value(gpio, !polarity);
++		else
++			gpio_direction_input(gpio);
++		out++;
++	}
++	kp->current_output = out;
++	if (out < mi->noutputs) {
++		gpio = mi->output_gpios[out];
++		if (gpio_keypad_flags & GPIOKPF_DRIVE_INACTIVE)
++			gpio_set_value(gpio, polarity);
++		else
++			gpio_direction_output(gpio, polarity);
++		hrtimer_start(timer, mi->settle_time, HRTIMER_MODE_REL);
++		return HRTIMER_NORESTART;
++	}
++	if (gpio_keypad_flags & GPIOKPF_DEBOUNCE) {
++		if (kp->key_state_changed) {
++			hrtimer_start(&kp->timer, mi->debounce_delay,
++				      HRTIMER_MODE_REL);
++			return HRTIMER_NORESTART;
++		}
++		kp->key_state_changed = kp->last_key_state_changed;
++	}
++	if (kp->key_state_changed) {
++		if (gpio_keypad_flags & GPIOKPF_REMOVE_SOME_PHANTOM_KEYS)
++			remove_phantom_keys(kp);
++		key_index = 0;
++		for (out = 0; out < mi->noutputs; out++)
++			for (in = 0; in < mi->ninputs; in++, key_index++)
++				report_key(kp, key_index, out, in);
++	}
++	if (!kp->use_irq || kp->some_keys_pressed) {
++		hrtimer_start(timer, mi->poll_time, HRTIMER_MODE_REL);
++		return HRTIMER_NORESTART;
++	}
++
++	/* No keys are pressed, reenable interrupt */
++	for (out = 0; out < mi->noutputs; out++) {
++		if (gpio_keypad_flags & GPIOKPF_DRIVE_INACTIVE)
++			gpio_set_value(mi->output_gpios[out], polarity);
++		else
++			gpio_direction_output(mi->output_gpios[out], polarity);
++	}
++	for (in = 0; in < mi->ninputs; in++)
++		enable_irq(gpio_to_irq(mi->input_gpios[in]));
++	wake_unlock(&kp->wake_lock);
++	return HRTIMER_NORESTART;
++}
++
++static irqreturn_t gpio_keypad_irq_handler(int irq_in, void *dev_id)
++{
++	int i;
++	struct gpio_kp *kp = dev_id;
++	struct gpio_event_matrix_info *mi = kp->keypad_info;
++	unsigned gpio_keypad_flags = mi->flags;
++
++	if (!kp->use_irq) /* ignore interrupt while registering the handler */
++		return IRQ_HANDLED;
++
++	for (i = 0; i < mi->ninputs; i++)
++		disable_irq(gpio_to_irq(mi->input_gpios[i]));
++	for (i = 0; i < mi->noutputs; i++) {
++		if (gpio_keypad_flags & GPIOKPF_DRIVE_INACTIVE)
++			gpio_set_value(mi->output_gpios[i],
++				!(gpio_keypad_flags & GPIOKPF_ACTIVE_HIGH));
++		else
++			gpio_direction_input(mi->output_gpios[i]);
++	}
++	wake_lock(&kp->wake_lock);
++	hrtimer_start(&kp->timer, ktime_set(0, 0), HRTIMER_MODE_REL);
++	return IRQ_HANDLED;
++}
++
++static int gpio_keypad_request_irqs(struct gpio_kp *kp)
++{
++	int i;
++	int err;
++	unsigned int irq;
++	unsigned long request_flags;
++	struct gpio_event_matrix_info *mi = kp->keypad_info;
++
++	switch (mi->flags & (GPIOKPF_ACTIVE_HIGH|GPIOKPF_LEVEL_TRIGGERED_IRQ)) {
++	default:
++		request_flags = IRQF_TRIGGER_FALLING;
++		break;
++	case GPIOKPF_ACTIVE_HIGH:
++		request_flags = IRQF_TRIGGER_RISING;
++		break;
++	case GPIOKPF_LEVEL_TRIGGERED_IRQ:
++		request_flags = IRQF_TRIGGER_LOW;
++		break;
++	case GPIOKPF_LEVEL_TRIGGERED_IRQ | GPIOKPF_ACTIVE_HIGH:
++		request_flags = IRQF_TRIGGER_HIGH;
++		break;
++	}
++
++	for (i = 0; i < mi->ninputs; i++) {
++		err = irq = gpio_to_irq(mi->input_gpios[i]);
++		if (err < 0)
++			goto err_gpio_get_irq_num_failed;
++		err = request_irq(irq, gpio_keypad_irq_handler, request_flags,
++				  "gpio_kp", kp);
++		if (err) {
++			pr_err("gpiomatrix: request_irq failed for input %d, "
++				"irq %d\n", mi->input_gpios[i], irq);
++			goto err_request_irq_failed;
++		}
++		err = set_irq_wake(irq, 1);
++		if (err) {
++			pr_err("gpiomatrix: set_irq_wake failed for input %d, "
++				"irq %d\n", mi->input_gpios[i], irq);
++		}
++		disable_irq(irq);
++	}
++	return 0;
++
++	for (i = mi->noutputs - 1; i >= 0; i--) {
++		free_irq(gpio_to_irq(mi->input_gpios[i]), kp);
++err_request_irq_failed:
++err_gpio_get_irq_num_failed:
++		;
++	}
++	return err;
++}
++
++int gpio_event_matrix_func(struct input_dev *input_dev,
++	struct gpio_event_info *info, void **data, int func)
++{
++	int i;
++	int err;
++	int key_count;
++	struct gpio_kp *kp;
++	struct gpio_event_matrix_info *mi;
++
++	mi = container_of(info, struct gpio_event_matrix_info, info);
++	if (func == GPIO_EVENT_FUNC_SUSPEND || func == GPIO_EVENT_FUNC_RESUME) {
++		/* TODO: disable scanning */
++		return 0;
++	}
++
++	if (func == GPIO_EVENT_FUNC_INIT) {
++		if (mi->keymap == NULL ||
++		   mi->input_gpios == NULL ||
++		   mi->output_gpios == NULL) {
++			err = -ENODEV;
++			pr_err("gpiomatrix: Incomplete pdata\n");
++			goto err_invalid_platform_data;
++		}
++		key_count = mi->ninputs * mi->noutputs;
++
++		*data = kp = kzalloc(sizeof(*kp) + sizeof(kp->keys_pressed[0]) *
++				     BITS_TO_LONGS(key_count), GFP_KERNEL);
++		if (kp == NULL) {
++			err = -ENOMEM;
++			pr_err("gpiomatrix: Failed to allocate private data\n");
++			goto err_kp_alloc_failed;
++		}
++		kp->input_dev = input_dev;
++		kp->keypad_info = mi;
++		set_bit(EV_KEY, input_dev->evbit);
++		for (i = 0; i < key_count; i++) {
++			if (mi->keymap[i])
++				set_bit(mi->keymap[i] & KEY_MAX,
++					input_dev->keybit);
++		}
++
++		for (i = 0; i < mi->noutputs; i++) {
++			if (gpio_cansleep(mi->output_gpios[i])) {
++				pr_err("gpiomatrix: unsupported output gpio %d,"
++					" can sleep\n", mi->output_gpios[i]);
++				err = -EINVAL;
++				goto err_request_output_gpio_failed;
++			}
++			err = gpio_request(mi->output_gpios[i], "gpio_kp_out");
++			if (err) {
++				pr_err("gpiomatrix: gpio_request failed for "
++					"output %d\n", mi->output_gpios[i]);
++				goto err_request_output_gpio_failed;
++			}
++			if (mi->flags & GPIOKPF_DRIVE_INACTIVE)
++				err = gpio_direction_output(mi->output_gpios[i],
++					!(mi->flags & GPIOKPF_ACTIVE_HIGH));
++			else
++				err = gpio_direction_input(mi->output_gpios[i]);
++			if (err) {
++				pr_err("gpiomatrix: gpio_configure failed for "
++					"output %d\n", mi->output_gpios[i]);
++				goto err_output_gpio_configure_failed;
++			}
++		}
++		for (i = 0; i < mi->ninputs; i++) {
++			err = gpio_request(mi->input_gpios[i], "gpio_kp_in");
++			if (err) {
++				pr_err("gpiomatrix: gpio_request failed for "
++					"input %d\n", mi->input_gpios[i]);
++				goto err_request_input_gpio_failed;
++			}
++			err = gpio_direction_input(mi->input_gpios[i]);
++			if (err) {
++				pr_err("gpiomatrix: gpio_direction_input failed"
++					" for input %d\n", mi->input_gpios[i]);
++				goto err_gpio_direction_input_failed;
++			}
++		}
++		kp->current_output = mi->noutputs;
++		kp->key_state_changed = 1;
++
++		hrtimer_init(&kp->timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
++		kp->timer.function = gpio_keypad_timer_func;
++		wake_lock_init(&kp->wake_lock, WAKE_LOCK_SUSPEND, "gpio_kp");
++		err = gpio_keypad_request_irqs(kp);
++		kp->use_irq = err == 0;
++
++		pr_info("GPIO Matrix Keypad Driver: Start keypad matrix for %s "
++			"in %s mode\n", input_dev->name,
++			kp->use_irq ? "interrupt" : "polling");
++
++		if (kp->use_irq)
++			wake_lock(&kp->wake_lock);
++		hrtimer_start(&kp->timer, ktime_set(0, 0), HRTIMER_MODE_REL);
++
++		return 0;
++	}
++
++	err = 0;
++	kp = *data;
++
++	if (kp->use_irq)
++		for (i = mi->noutputs - 1; i >= 0; i--)
++			free_irq(gpio_to_irq(mi->input_gpios[i]), kp);
++
++	hrtimer_cancel(&kp->timer);
++	wake_lock_destroy(&kp->wake_lock);
++	for (i = mi->noutputs - 1; i >= 0; i--) {
++err_gpio_direction_input_failed:
++		gpio_free(mi->input_gpios[i]);
++err_request_input_gpio_failed:
++		;
++	}
++	for (i = mi->noutputs - 1; i >= 0; i--) {
++err_output_gpio_configure_failed:
++		gpio_free(mi->output_gpios[i]);
++err_request_output_gpio_failed:
++		;
++	}
++	kfree(kp);
++err_kp_alloc_failed:
++err_invalid_platform_data:
++	return err;
++}
+--- /dev/null
++++ b/drivers/input/misc/gpio_output.c
+@@ -0,0 +1,84 @@
++/* drivers/input/misc/gpio_output.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>
++
++int gpio_event_output_event(
++	struct input_dev *input_dev, struct gpio_event_info *info, void **data,
++	unsigned int type, unsigned int code, int value)
++{
++	int i;
++	struct gpio_event_output_info *oi;
++	oi = container_of(info, struct gpio_event_output_info, info);
++	if (type != oi->type)
++		return 0;
++	if (!(oi->flags & GPIOEDF_ACTIVE_HIGH))
++		value = !value;
++	for (i = 0; i < oi->keymap_size; i++)
++		if (code == oi->keymap[i].code)
++			gpio_set_value(oi->keymap[i].gpio, value);
++	return 0;
++}
++
++int gpio_event_output_func(
++	struct input_dev *input_dev, struct gpio_event_info *info, void **data,
++	int func)
++{
++	int ret;
++	int i;
++	struct gpio_event_output_info *oi;
++	oi = container_of(info, struct gpio_event_output_info, info);
++
++	if (func == GPIO_EVENT_FUNC_SUSPEND || func == GPIO_EVENT_FUNC_RESUME)
++		return 0;
++
++	if (func == GPIO_EVENT_FUNC_INIT) {
++		int output_level = !(oi->flags & GPIOEDF_ACTIVE_HIGH);
++		for (i = 0; i < oi->keymap_size; i++)
++			input_set_capability(input_dev, oi->type,
++					     oi->keymap[i].code);
++
++		for (i = 0; i < oi->keymap_size; i++) {
++			ret = gpio_request(oi->keymap[i].gpio,
++					   "gpio_event_output");
++			if (ret) {
++				pr_err("gpio_event_output_func: gpio_request "
++					"failed for %d\n", oi->keymap[i].gpio);
++				goto err_gpio_request_failed;
++			}
++			ret = gpio_direction_output(oi->keymap[i].gpio,
++						    output_level);
++			if (ret) {
++				pr_err("gpio_event_output_func: "
++					"gpio_direction_output failed for %d\n",
++					oi->keymap[i].gpio);
++				goto err_gpio_direction_output_failed;
++			}
++		}
++		return 0;
++	}
++
++	ret = 0;
++	for (i = oi->keymap_size - 1; i >= 0; i--) {
++err_gpio_direction_output_failed:
++		gpio_free(oi->keymap[i].gpio);
++err_gpio_request_failed:
++		;
++	}
++	return ret;
++}
++
+--- /dev/null
++++ b/include/linux/gpio_event.h
+@@ -0,0 +1,154 @@
++/* include/linux/gpio_event.h
++ *
++ * 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.
++ *
++ */
++
++#ifndef _LINUX_GPIO_EVENT_H
++#define _LINUX_GPIO_EVENT_H
++
++#include <linux/input.h>
++
++enum {
++	GPIO_EVENT_FUNC_UNINIT  = 0x0,
++	GPIO_EVENT_FUNC_INIT    = 0x1,
++	GPIO_EVENT_FUNC_SUSPEND = 0x2,
++	GPIO_EVENT_FUNC_RESUME  = 0x3,
++};
++struct gpio_event_info {
++	int (*func)(struct input_dev *input_dev,
++		    struct gpio_event_info *info,
++		    void **data, int func);
++	int (*event)(struct input_dev *input_dev,
++		     struct gpio_event_info *info,
++		     void **data, unsigned int type,
++		     unsigned int code, int value); /* out events */
++};
++
++struct gpio_event_platform_data {
++	const char *name;
++	struct gpio_event_info **info;
++	size_t info_count;
++	int (*power)(const struct gpio_event_platform_data *pdata, bool on);
++};
++
++#define GPIO_EVENT_DEV_NAME "gpio-event"
++
++/* Key matrix */
++
++enum gpio_event_matrix_flags {
++	/* unset: drive active output low, set: drive active output high */
++	GPIOKPF_ACTIVE_HIGH              = 1U << 0,
++	GPIOKPF_DEBOUNCE                 = 1U << 1,
++	GPIOKPF_REMOVE_SOME_PHANTOM_KEYS = 1U << 2,
++	GPIOKPF_REMOVE_PHANTOM_KEYS      = GPIOKPF_REMOVE_SOME_PHANTOM_KEYS |
++					   GPIOKPF_DEBOUNCE,
++	GPIOKPF_DRIVE_INACTIVE           = 1U << 3,
++	GPIOKPF_LEVEL_TRIGGERED_IRQ      = 1U << 4,
++	GPIOKPF_PRINT_UNMAPPED_KEYS      = 1U << 16,
++	GPIOKPF_PRINT_MAPPED_KEYS        = 1U << 17,
++	GPIOKPF_PRINT_PHANTOM_KEYS       = 1U << 18,
++};
++
++extern int gpio_event_matrix_func(struct input_dev *input_dev,
++			struct gpio_event_info *info, void **data, int func);
++struct gpio_event_matrix_info {
++	/* initialize to gpio_event_matrix_func */
++	struct gpio_event_info info;
++	/* size must be ninputs * noutputs */
++	const unsigned short *keymap;
++	unsigned int *input_gpios;
++	unsigned int *output_gpios;
++	unsigned int ninputs;
++	unsigned int noutputs;
++	/* time to wait before reading inputs after driving each output */
++	ktime_t settle_time;
++	/* time to wait before scanning the keypad a second time */
++	ktime_t debounce_delay;
++	ktime_t poll_time;
++	unsigned flags;
++};
++
++/* Directly connected inputs and outputs */
++
++enum gpio_event_direct_flags {
++	GPIOEDF_ACTIVE_HIGH         = 1U << 0,
++/*	GPIOEDF_USE_DOWN_IRQ        = 1U << 1, */
++/*	GPIOEDF_USE_IRQ             = (1U << 2) | GPIOIDF_USE_DOWN_IRQ, */
++	GPIOEDF_PRINT_KEYS          = 1U << 8,
++	GPIOEDF_PRINT_KEY_DEBOUNCE  = 1U << 9,
++};
++
++struct gpio_event_direct_entry {
++	uint32_t gpio:23;
++	uint32_t code:9;
++};
++
++/* inputs */
++extern int gpio_event_input_func(struct input_dev *input_dev,
++			struct gpio_event_info *info, void **data, int func);
++struct gpio_event_input_info {
++	/* initialize to gpio_event_input_func */
++	struct gpio_event_info info;
++	ktime_t debounce_time;
++	ktime_t poll_time;
++	uint16_t flags;
++	uint16_t type;
++	const struct gpio_event_direct_entry *keymap;
++	size_t keymap_size;
++};
++
++/* outputs */
++extern int gpio_event_output_func(struct input_dev *input_dev,
++			struct gpio_event_info *info, void **data, int func);
++extern int gpio_event_output_event(struct input_dev *input_dev,
++			struct gpio_event_info *info, void **data,
++			unsigned int type, unsigned int code, int value);
++struct gpio_event_output_info {
++	/* initialize to gpio_event_output_func and gpio_event_output_event */
++	struct gpio_event_info info;
++	uint16_t flags;
++	uint16_t type;
++	const struct gpio_event_direct_entry *keymap;
++	size_t keymap_size;
++};
++
++
++/* axes */
++
++enum gpio_event_axis_flags {
++	GPIOEAF_PRINT_UNKNOWN_DIRECTION  = 1U << 16,
++	GPIOEAF_PRINT_RAW                = 1U << 17,
++	GPIOEAF_PRINT_EVENT              = 1U << 18,
++};
++
++extern int gpio_event_axis_func(struct input_dev *input_dev,
++			struct gpio_event_info *info, void **data, int func);
++struct gpio_event_axis_info {
++	/* initialize to gpio_event_axis_func */
++	struct gpio_event_info info;
++	uint8_t  count;
++	uint8_t  type; /* EV_REL or EV_ABS */
++	uint16_t code;
++	uint16_t decoded_size;
++	uint16_t (*map)(struct gpio_event_axis_info *info, uint16_t in);
++	uint32_t *gpio;
++	uint32_t flags;
++};
++#define gpio_axis_2bit_gray_map gpio_axis_4bit_gray_map
++#define gpio_axis_3bit_gray_map gpio_axis_4bit_gray_map
++uint16_t gpio_axis_4bit_gray_map(
++			struct gpio_event_axis_info *info, uint16_t in);
++uint16_t gpio_axis_5bit_singletrack_map(
++			struct gpio_event_axis_info *info, uint16_t in);
++
++#endif