target/linux/goldfish/patches-2.6.30/0086-Input-Generic-GPIO-Input-device.patch

   1 From 6730377482c05a1742abb92f1463701f5d084a27 Mon Sep 17 00:00:00 2001
   2 From: =?utf-8?q?Arve=20Hj=C3=B8nnev=C3=A5g?= <arve@android.com>
   3 Date: Wed, 15 Oct 2008 18:23:47 -0700
   4 Subject: [PATCH 086/134] Input: Generic GPIO Input device.
   5 MIME-Version: 1.0
   6 Content-Type: text/plain; charset=utf-8
   7 Content-Transfer-Encoding: 8bit
   8
   9 Supports keyboard matrixces, direct inputs, direct outputs and axes connected to gpios.
  10
  11 Signed-off-by: Arve Hjønnevåg <arve@android.com>
  12 Signed-off-by: Nick Pelly <npelly@google.com>
  13 ---
  14  drivers/input/misc/Kconfig       |    5 +
  15  drivers/input/misc/Makefile      |    1 +
  16  drivers/input/misc/gpio_axis.c   |  180 +++++++++++++++++
  17  drivers/input/misc/gpio_event.c  |  224 +++++++++++++++++++++
  18  drivers/input/misc/gpio_input.c  |  343 ++++++++++++++++++++++++++++++++
  19  drivers/input/misc/gpio_matrix.c |  406 ++++++++++++++++++++++++++++++++++++++
  20  drivers/input/misc/gpio_output.c |   84 ++++++++
  21  include/linux/gpio_event.h       |  154 ++++++++++++++
  22  8 files changed, 1397 insertions(+), 0 deletions(-)
  23  create mode 100644 drivers/input/misc/gpio_axis.c
  24  create mode 100644 drivers/input/misc/gpio_event.c
  25  create mode 100644 drivers/input/misc/gpio_input.c
  26  create mode 100644 drivers/input/misc/gpio_matrix.c
  27  create mode 100644 drivers/input/misc/gpio_output.c
  28  create mode 100644 include/linux/gpio_event.h
  29
  30 --- a/drivers/input/misc/Kconfig
  31 +++ b/drivers/input/misc/Kconfig
  32 @@ -212,6 +212,11 @@ config INPUT_SGI_BTNS
  33           To compile this driver as a module, choose M here: the
  34           module will be called sgi_btns.
  35
  36 +config INPUT_GPIO
  37 +       tristate "GPIO driver support"
  38 +       help
  39 +         Say Y here if you want to support gpio based keys, wheels etc...
  40 +
  41  config HP_SDC_RTC
  42         tristate "HP SDC Real Time Clock"
  43         depends on (GSC || HP300) && SERIO
  44 --- a/drivers/input/misc/Makefile
  45 +++ b/drivers/input/misc/Makefile
  46 @@ -25,3 +25,5 @@ obj-$(CONFIG_INPUT_UINPUT)            += uinput.o
  47  obj-$(CONFIG_INPUT_WISTRON_BTNS)       += wistron_btns.o
  48  obj-$(CONFIG_INPUT_YEALINK)            += yealink.o
  49  obj-$(CONFIG_INPUT_GPIO_BUTTONS)       += gpio_buttons.o
  50 +obj-$(CONFIG_INPUT_GPIO)               += gpio_event.o gpio_matrix.o gpio_input.o gpio_output.o gpio_axis.o
  51 +
  52 --- /dev/null
  53 +++ b/drivers/input/misc/gpio_axis.c
  54 @@ -0,0 +1,180 @@
  55 +/* drivers/input/misc/gpio_axis.c
  56 + *
  57 + * Copyright (C) 2007 Google, Inc.
  58 + *
  59 + * This software is licensed under the terms of the GNU General Public
  60 + * License version 2, as published by the Free Software Foundation, and
  61 + * may be copied, distributed, and modified under those terms.
  62 + *
  63 + * This program is distributed in the hope that it will be useful,
  64 + * but WITHOUT ANY WARRANTY; without even the implied warranty of
  65 + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  66 + * GNU General Public License for more details.
  67 + *
  68 + */
  69 +
  70 +#include <linux/kernel.h>
  71 +#include <linux/gpio.h>
  72 +#include <linux/gpio_event.h>
  73 +#include <linux/interrupt.h>
  74 +
  75 +struct gpio_axis_state {
  76 +       struct input_dev *input_dev;
  77 +       struct gpio_event_axis_info *info;
  78 +       uint32_t pos;
  79 +};
  80 +
  81 +uint16_t gpio_axis_4bit_gray_map_table[] = {
  82 +       [0x0] = 0x0, [0x1] = 0x1, /* 0000 0001 */
  83 +       [0x3] = 0x2, [0x2] = 0x3, /* 0011 0010 */
  84 +       [0x6] = 0x4, [0x7] = 0x5, /* 0110 0111 */
  85 +       [0x5] = 0x6, [0x4] = 0x7, /* 0101 0100 */
  86 +       [0xc] = 0x8, [0xd] = 0x9, /* 1100 1101 */
  87 +       [0xf] = 0xa, [0xe] = 0xb, /* 1111 1110 */
  88 +       [0xa] = 0xc, [0xb] = 0xd, /* 1010 1011 */
  89 +       [0x9] = 0xe, [0x8] = 0xf, /* 1001 1000 */
  90 +};
  91 +uint16_t gpio_axis_4bit_gray_map(struct gpio_event_axis_info *info, uint16_t in)
  92 +{
  93 +       return gpio_axis_4bit_gray_map_table[in];
  94 +}
  95 +
  96 +uint16_t gpio_axis_5bit_singletrack_map_table[] = {
  97 +       [0x10] = 0x00, [0x14] = 0x01, [0x1c] = 0x02, /*     10000 10100 11100 */
  98 +       [0x1e] = 0x03, [0x1a] = 0x04, [0x18] = 0x05, /*     11110 11010 11000 */
  99 +       [0x08] = 0x06, [0x0a] = 0x07, [0x0e] = 0x08, /*    01000 01010 01110  */
 100 +       [0x0f] = 0x09, [0x0d] = 0x0a, [0x0c] = 0x0b, /*    01111 01101 01100  */
 101 +       [0x04] = 0x0c, [0x05] = 0x0d, [0x07] = 0x0e, /*   00100 00101 00111   */
 102 +       [0x17] = 0x0f, [0x16] = 0x10, [0x06] = 0x11, /*   10111 10110 00110   */
 103 +       [0x02] = 0x12, [0x12] = 0x13, [0x13] = 0x14, /*  00010 10010 10011    */
 104 +       [0x1b] = 0x15, [0x0b] = 0x16, [0x03] = 0x17, /*  11011 01011 00011    */
 105 +       [0x01] = 0x18, [0x09] = 0x19, [0x19] = 0x1a, /* 00001 01001 11001     */
 106 +       [0x1d] = 0x1b, [0x15] = 0x1c, [0x11] = 0x1d, /* 11101 10101 10001     */
 107 +};
 108 +uint16_t gpio_axis_5bit_singletrack_map(
 109 +       struct gpio_event_axis_info *info, uint16_t in)
 110 +{
 111 +       return gpio_axis_5bit_singletrack_map_table[in];
 112 +}
 113 +
 114 +static void gpio_event_update_axis(struct gpio_axis_state *as, int report)
 115 +{
 116 +       struct gpio_event_axis_info *ai = as->info;
 117 +       int i;
 118 +       int change;
 119 +       uint16_t state = 0;
 120 +       uint16_t pos;
 121 +       uint16_t old_pos = as->pos;
 122 +       for (i = ai->count - 1; i >= 0; i--)
 123 +               state = (state << 1) | gpio_get_value(ai->gpio[i]);
 124 +       pos = ai->map(ai, state);
 125 +       if (ai->flags & GPIOEAF_PRINT_RAW)
 126 +               pr_info("axis %d-%d raw %x, pos %d -> %d\n",
 127 +                       ai->type, ai->code, state, old_pos, pos);
 128 +       if (report && pos != old_pos) {
 129 +               if (ai->type == EV_REL) {
 130 +                       change = (ai->decoded_size + pos - old_pos) %
 131 +                                 ai->decoded_size;
 132 +                       if (change > ai->decoded_size / 2)
 133 +                               change -= ai->decoded_size;
 134 +                       if (change == ai->decoded_size / 2) {
 135 +                               if (ai->flags & GPIOEAF_PRINT_EVENT)
 136 +                                       pr_info("axis %d-%d unknown direction, "
 137 +                                               "pos %d -> %d\n", ai->type,
 138 +                                               ai->code, old_pos, pos);
 139 +                               change = 0; /* no closest direction */
 140 +                       }
 141 +                       if (ai->flags & GPIOEAF_PRINT_EVENT)
 142 +                               pr_info("axis %d-%d change %d\n",
 143 +                                       ai->type, ai->code, change);
 144 +                       input_report_rel(as->input_dev, ai->code, change);
 145 +               } else {
 146 +                       if (ai->flags & GPIOEAF_PRINT_EVENT)
 147 +                               pr_info("axis %d-%d now %d\n",
 148 +                                       ai->type, ai->code, pos);
 149 +                       input_event(as->input_dev, ai->type, ai->code, pos);
 150 +               }
 151 +               input_sync(as->input_dev);
 152 +       }
 153 +       as->pos = pos;
 154 +}
 155 +
 156 +static irqreturn_t gpio_axis_irq_handler(int irq, void *dev_id)
 157 +{
 158 +       struct gpio_axis_state *as = dev_id;
 159 +       gpio_event_update_axis(as, 1);
 160 +       return IRQ_HANDLED;
 161 +}
 162 +
 163 +int gpio_event_axis_func(struct input_dev *input_dev,
 164 +                        struct gpio_event_info *info, void **data, int func)
 165 +{
 166 +       int ret;
 167 +       int i;
 168 +       int irq;
 169 +       struct gpio_event_axis_info *ai;
 170 +       struct gpio_axis_state *as;
 171 +
 172 +       ai = container_of(info, struct gpio_event_axis_info, info);
 173 +       if (func == GPIO_EVENT_FUNC_SUSPEND) {
 174 +               for (i = 0; i < ai->count; i++)
 175 +                       disable_irq(gpio_to_irq(ai->gpio[i]));
 176 +               return 0;
 177 +       }
 178 +       if (func == GPIO_EVENT_FUNC_RESUME) {
 179 +               for (i = 0; i < ai->count; i++)
 180 +                       enable_irq(gpio_to_irq(ai->gpio[i]));
 181 +               return 0;
 182 +       }
 183 +
 184 +       if (func == GPIO_EVENT_FUNC_INIT) {
 185 +               *data = as = kmalloc(sizeof(*as), GFP_KERNEL);
 186 +               if (as == NULL) {
 187 +                       ret = -ENOMEM;
 188 +                       goto err_alloc_axis_state_failed;
 189 +               }
 190 +               as->input_dev = input_dev;
 191 +               as->info = ai;
 192 +
 193 +               input_set_capability(input_dev, ai->type, ai->code);
 194 +               if (ai->type == EV_ABS) {
 195 +                       input_set_abs_params(input_dev, ai->code, 0,
 196 +                                            ai->decoded_size - 1, 0, 0);
 197 +               }
 198 +               for (i = 0; i < ai->count; i++) {
 199 +                       ret = gpio_request(ai->gpio[i], "gpio_event_axis");
 200 +                       if (ret < 0)
 201 +                               goto err_request_gpio_failed;
 202 +                       ret = gpio_direction_input(ai->gpio[i]);
 203 +                       if (ret < 0)
 204 +                               goto err_gpio_direction_input_failed;
 205 +                       ret = irq = gpio_to_irq(ai->gpio[i]);
 206 +                       if (ret < 0)
 207 +                               goto err_get_irq_num_failed;
 208 +                       ret = request_irq(irq, gpio_axis_irq_handler,
 209 +                                         IRQF_TRIGGER_RISING |
 210 +                                         IRQF_TRIGGER_FALLING,
 211 +                                         "gpio_event_axis", as);
 212 +                       if (ret < 0)
 213 +                               goto err_request_irq_failed;
 214 +               }
 215 +               gpio_event_update_axis(as, 0);
 216 +               return 0;
 217 +       }
 218 +
 219 +       ret = 0;
 220 +       as = *data;
 221 +       for (i = ai->count - 1; i >= 0; i--) {
 222 +               free_irq(gpio_to_irq(ai->gpio[i]), as);
 223 +err_request_irq_failed:
 224 +err_get_irq_num_failed:
 225 +err_gpio_direction_input_failed:
 226 +               gpio_free(ai->gpio[i]);
 227 +err_request_gpio_failed:
 228 +               ;
 229 +       }
 230 +       kfree(as);
 231 +       *data = NULL;
 232 +err_alloc_axis_state_failed:
 233 +       return ret;
 234 +}
 235 --- /dev/null
 236 +++ b/drivers/input/misc/gpio_event.c
 237 @@ -0,0 +1,224 @@
 238 +/* drivers/input/misc/gpio_event.c
 239 + *
 240 + * Copyright (C) 2007 Google, Inc.
 241 + *
 242 + * This software is licensed under the terms of the GNU General Public
 243 + * License version 2, as published by the Free Software Foundation, and
 244 + * may be copied, distributed, and modified under those terms.
 245 + *
 246 + * This program is distributed in the hope that it will be useful,
 247 + * but WITHOUT ANY WARRANTY; without even the implied warranty of
 248 + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 249 + * GNU General Public License for more details.
 250 + *
 251 + */
 252 +
 253 +#include <linux/earlysuspend.h>
 254 +#include <linux/module.h>
 255 +#include <linux/input.h>
 256 +#include <linux/gpio_event.h>
 257 +#include <linux/hrtimer.h>
 258 +#include <linux/platform_device.h>
 259 +
 260 +struct gpio_event {
 261 +       struct input_dev *input_dev;
 262 +       const struct gpio_event_platform_data *info;
 263 +       struct early_suspend early_suspend;
 264 +       void *state[0];
 265 +};
 266 +
 267 +static int gpio_input_event(
 268 +       struct input_dev *dev, unsigned int type, unsigned int code, int value)
 269 +{
 270 +       int i;
 271 +       int ret = 0;
 272 +       int tmp_ret;
 273 +       struct gpio_event_info **ii;
 274 +       struct gpio_event *ip = input_get_drvdata(dev);
 275 +
 276 +       for (i = 0, ii = ip->info->info; i < ip->info->info_count; i++, ii++) {
 277 +               if ((*ii)->event) {
 278 +                       tmp_ret = (*ii)->event(ip->input_dev, *ii,
 279 +                                       &ip->state[i], type, code, value);
 280 +                       if (tmp_ret)
 281 +                               ret = tmp_ret;
 282 +               }
 283 +       }
 284 +       return ret;
 285 +}
 286 +
 287 +static int gpio_event_call_all_func(struct gpio_event *ip, int func)
 288 +{
 289 +       int i;
 290 +       int ret;
 291 +       struct gpio_event_info **ii;
 292 +
 293 +       if (func == GPIO_EVENT_FUNC_INIT || func == GPIO_EVENT_FUNC_RESUME) {
 294 +               ii = ip->info->info;
 295 +               for (i = 0; i < ip->info->info_count; i++, ii++) {
 296 +                       if ((*ii)->func == NULL) {
 297 +                               ret = -ENODEV;
 298 +                               pr_err("gpio_event_probe: Incomplete pdata, "
 299 +                                       "no function\n");
 300 +                               goto err_no_func;
 301 +                       }
 302 +                       ret = (*ii)->func(ip->input_dev, *ii, &ip->state[i],
 303 +                                         func);
 304 +                       if (ret) {
 305 +                               pr_err("gpio_event_probe: function failed\n");
 306 +                               goto err_func_failed;
 307 +                       }
 308 +               }
 309 +               return 0;
 310 +       }
 311 +
 312 +       ret = 0;
 313 +       i = ip->info->info_count;
 314 +       ii = ip->info->info + i;
 315 +       while (i > 0) {
 316 +               i--;
 317 +               ii--;
 318 +               (*ii)->func(ip->input_dev, *ii, &ip->state[i], func & ~1);
 319 +err_func_failed:
 320 +err_no_func:
 321 +               ;
 322 +       }
 323 +       return ret;
 324 +}
 325 +
 326 +#ifdef CONFIG_HAS_EARLYSUSPEND
 327 +void gpio_event_suspend(struct early_suspend *h)
 328 +{
 329 +       struct gpio_event *ip;
 330 +       ip = container_of(h, struct gpio_event, early_suspend);
 331 +       gpio_event_call_all_func(ip, GPIO_EVENT_FUNC_SUSPEND);
 332 +       ip->info->power(ip->info, 0);
 333 +}
 334 +
 335 +void gpio_event_resume(struct early_suspend *h)
 336 +{
 337 +       struct gpio_event *ip;
 338 +       ip = container_of(h, struct gpio_event, early_suspend);
 339 +       ip->info->power(ip->info, 1);
 340 +       gpio_event_call_all_func(ip, GPIO_EVENT_FUNC_RESUME);
 341 +}
 342 +#endif
 343 +
 344 +static int __init gpio_event_probe(struct platform_device *pdev)
 345 +{
 346 +       int err;
 347 +       struct gpio_event *ip;
 348 +       struct input_dev *input_dev;
 349 +       struct gpio_event_platform_data *event_info;
 350 +
 351 +       event_info = pdev->dev.platform_data;
 352 +       if (event_info == NULL) {
 353 +               pr_err("gpio_event_probe: No pdata\n");
 354 +               return -ENODEV;
 355 +       }
 356 +       if (event_info->name == NULL ||
 357 +          event_info->info == NULL ||
 358 +          event_info->info_count == 0) {
 359 +               pr_err("gpio_event_probe: Incomplete pdata\n");
 360 +               return -ENODEV;
 361 +       }
 362 +       ip = kzalloc(sizeof(*ip) +
 363 +                    sizeof(ip->state[0]) * event_info->info_count, GFP_KERNEL);
 364 +       if (ip == NULL) {
 365 +               err = -ENOMEM;
 366 +               pr_err("gpio_event_probe: Failed to allocate private data\n");
 367 +               goto err_kp_alloc_failed;
 368 +       }
 369 +       platform_set_drvdata(pdev, ip);
 370 +
 371 +       input_dev = input_allocate_device();
 372 +       if (input_dev == NULL) {
 373 +               err = -ENOMEM;
 374 +               pr_err("gpio_event_probe: Failed to allocate input device\n");
 375 +               goto err_input_dev_alloc_failed;
 376 +       }
 377 +       input_set_drvdata(input_dev, ip);
 378 +       ip->input_dev = input_dev;
 379 +       ip->info = event_info;
 380 +       if (event_info->power) {
 381 +#ifdef CONFIG_HAS_EARLYSUSPEND
 382 +               ip->early_suspend.level = EARLY_SUSPEND_LEVEL_BLANK_SCREEN + 1;
 383 +               ip->early_suspend.suspend = gpio_event_suspend;
 384 +               ip->early_suspend.resume = gpio_event_resume;
 385 +               register_early_suspend(&ip->early_suspend);
 386 +#endif
 387 +               ip->info->power(ip->info, 1);
 388 +       }
 389 +
 390 +       input_dev->name = ip->info->name;
 391 +       input_dev->event = gpio_input_event;
 392 +
 393 +       err = gpio_event_call_all_func(ip, GPIO_EVENT_FUNC_INIT);
 394 +       if (err)
 395 +               goto err_call_all_func_failed;
 396 +
 397 +       err = input_register_device(input_dev);
 398 +       if (err) {
 399 +               pr_err("gpio_event_probe: Unable to register %s input device\n",
 400 +                       input_dev->name);
 401 +               goto err_input_register_device_failed;
 402 +       }
 403 +
 404 +       return 0;
 405 +
 406 +err_input_register_device_failed:
 407 +       gpio_event_call_all_func(ip, GPIO_EVENT_FUNC_UNINIT);
 408 +err_call_all_func_failed:
 409 +       if (event_info->power) {
 410 +#ifdef CONFIG_HAS_EARLYSUSPEND
 411 +               unregister_early_suspend(&ip->early_suspend);
 412 +#endif
 413 +               ip->info->power(ip->info, 0);
 414 +       }
 415 +       input_free_device(input_dev);
 416 +err_input_dev_alloc_failed:
 417 +       kfree(ip);
 418 +err_kp_alloc_failed:
 419 +       return err;
 420 +}
 421 +
 422 +static int gpio_event_remove(struct platform_device *pdev)
 423 +{
 424 +       struct gpio_event *ip = platform_get_drvdata(pdev);
 425 +
 426 +       gpio_event_call_all_func(ip, GPIO_EVENT_FUNC_UNINIT);
 427 +       if (ip->info->power) {
 428 +#ifdef CONFIG_HAS_EARLYSUSPEND
 429 +               unregister_early_suspend(&ip->early_suspend);
 430 +#endif
 431 +               ip->info->power(ip->info, 0);
 432 +       }
 433 +       input_unregister_device(ip->input_dev);
 434 +       kfree(ip);
 435 +       return 0;
 436 +}
 437 +
 438 +static struct platform_driver gpio_event_driver = {
 439 +       .probe          = gpio_event_probe,
 440 +       .remove         = gpio_event_remove,
 441 +       .driver         = {
 442 +               .name   = GPIO_EVENT_DEV_NAME,
 443 +       },
 444 +};
 445 +
 446 +static int __devinit gpio_event_init(void)
 447 +{
 448 +       return platform_driver_register(&gpio_event_driver);
 449 +}
 450 +
 451 +static void __exit gpio_event_exit(void)
 452 +{
 453 +       platform_driver_unregister(&gpio_event_driver);
 454 +}
 455 +
 456 +module_init(gpio_event_init);
 457 +module_exit(gpio_event_exit);
 458 +
 459 +MODULE_DESCRIPTION("GPIO Event Driver");
 460 +MODULE_LICENSE("GPL");
 461 +
 462 --- /dev/null
 463 +++ b/drivers/input/misc/gpio_input.c
 464 @@ -0,0 +1,343 @@
 465 +/* drivers/input/misc/gpio_input.c
 466 + *
 467 + * Copyright (C) 2007 Google, Inc.
 468 + *
 469 + * This software is licensed under the terms of the GNU General Public
 470 + * License version 2, as published by the Free Software Foundation, and
 471 + * may be copied, distributed, and modified under those terms.
 472 + *
 473 + * This program is distributed in the hope that it will be useful,
 474 + * but WITHOUT ANY WARRANTY; without even the implied warranty of
 475 + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 476 + * GNU General Public License for more details.
 477 + *
 478 + */
 479 +
 480 +#include <linux/kernel.h>
 481 +#include <linux/gpio.h>
 482 +#include <linux/gpio_event.h>
 483 +#include <linux/hrtimer.h>
 484 +#include <linux/input.h>
 485 +#include <linux/interrupt.h>
 486 +#include <linux/wakelock.h>
 487 +
 488 +enum {
 489 +       DEBOUNCE_UNSTABLE     = BIT(0), /* Got irq, while debouncing */
 490 +       DEBOUNCE_PRESSED      = BIT(1),
 491 +       DEBOUNCE_NOTPRESSED   = BIT(2),
 492 +       DEBOUNCE_WAIT_IRQ     = BIT(3), /* Stable irq state */
 493 +       DEBOUNCE_POLL         = BIT(4), /* Stable polling state */
 494 +
 495 +       DEBOUNCE_UNKNOWN =
 496 +               DEBOUNCE_PRESSED | DEBOUNCE_NOTPRESSED,
 497 +};
 498 +
 499 +struct gpio_key_state {
 500 +       struct gpio_input_state *ds;
 501 +       uint8_t debounce;
 502 +};
 503 +
 504 +struct gpio_input_state {
 505 +       struct input_dev *input_dev;
 506 +       const struct gpio_event_input_info *info;
 507 +       struct hrtimer timer;
 508 +       int use_irq;
 509 +       int debounce_count;
 510 +       spinlock_t irq_lock;
 511 +       struct wake_lock wake_lock;
 512 +       struct gpio_key_state key_state[0];
 513 +};
 514 +
 515 +static enum hrtimer_restart gpio_event_input_timer_func(struct hrtimer *timer)
 516 +{
 517 +       int i;
 518 +       int pressed;
 519 +       struct gpio_input_state *ds =
 520 +               container_of(timer, struct gpio_input_state, timer);
 521 +       unsigned gpio_flags = ds->info->flags;
 522 +       unsigned npolarity;
 523 +       int nkeys = ds->info->keymap_size;
 524 +       const struct gpio_event_direct_entry *key_entry;
 525 +       struct gpio_key_state *key_state;
 526 +       unsigned long irqflags;
 527 +       uint8_t debounce;
 528 +
 529 +#if 0
 530 +       key_entry = kp->keys_info->keymap;
 531 +       key_state = kp->key_state;
 532 +       for (i = 0; i < nkeys; i++, key_entry++, key_state++)
 533 +               pr_info("gpio_read_detect_status %d %d\n", key_entry->gpio,
 534 +                       gpio_read_detect_status(key_entry->gpio));
 535 +#endif
 536 +       key_entry = ds->info->keymap;
 537 +       key_state = ds->key_state;
 538 +       spin_lock_irqsave(&ds->irq_lock, irqflags);
 539 +       for (i = 0; i < nkeys; i++, key_entry++, key_state++) {
 540 +               debounce = key_state->debounce;
 541 +               if (debounce & DEBOUNCE_WAIT_IRQ)
 542 +                       continue;
 543 +               if (key_state->debounce & DEBOUNCE_UNSTABLE) {
 544 +                       debounce = key_state->debounce = DEBOUNCE_UNKNOWN;
 545 +                       enable_irq(gpio_to_irq(key_entry->gpio));
 546 +                       pr_info("gpio_keys_scan_keys: key %x-%x, %d "
 547 +                               "(%d) continue debounce\n",
 548 +                               ds->info->type, key_entry->code,
 549 +                               i, key_entry->gpio);
 550 +               }
 551 +               npolarity = !(gpio_flags & GPIOEDF_ACTIVE_HIGH);
 552 +               pressed = gpio_get_value(key_entry->gpio) ^ npolarity;
 553 +               if (debounce & DEBOUNCE_POLL) {
 554 +                       if (pressed == !(debounce & DEBOUNCE_PRESSED)) {
 555 +                               ds->debounce_count++;
 556 +                               key_state->debounce = DEBOUNCE_UNKNOWN;
 557 +                               if (gpio_flags & GPIOEDF_PRINT_KEY_DEBOUNCE)
 558 +                                       pr_info("gpio_keys_scan_keys: key %x-"
 559 +                                               "%x, %d (%d) start debounce\n",
 560 +                                               ds->info->type, key_entry->code,
 561 +                                               i, key_entry->gpio);
 562 +                       }
 563 +                       continue;
 564 +               }
 565 +               if (pressed && (debounce & DEBOUNCE_NOTPRESSED)) {
 566 +                       if (gpio_flags & GPIOEDF_PRINT_KEY_DEBOUNCE)
 567 +                               pr_info("gpio_keys_scan_keys: key %x-%x, %d "
 568 +                                       "(%d) debounce pressed 1\n",
 569 +                                       ds->info->type, key_entry->code,
 570 +                                       i, key_entry->gpio);
 571 +                       key_state->debounce = DEBOUNCE_PRESSED;
 572 +                       continue;
 573 +               }
 574 +               if (!pressed && (debounce & DEBOUNCE_PRESSED)) {
 575 +                       if (gpio_flags & GPIOEDF_PRINT_KEY_DEBOUNCE)
 576 +                               pr_info("gpio_keys_scan_keys: key %x-%x, %d "
 577 +                                       "(%d) debounce pressed 0\n",
 578 +                                       ds->info->type, key_entry->code,
 579 +                                       i, key_entry->gpio);
 580 +                       key_state->debounce = DEBOUNCE_NOTPRESSED;
 581 +                       continue;
 582 +               }
 583 +               /* key is stable */
 584 +               ds->debounce_count--;
 585 +               if (ds->use_irq)
 586 +                       key_state->debounce |= DEBOUNCE_WAIT_IRQ;
 587 +               else
 588 +                       key_state->debounce |= DEBOUNCE_POLL;
 589 +               if (gpio_flags & GPIOEDF_PRINT_KEYS)
 590 +                       pr_info("gpio_keys_scan_keys: key %x-%x, %d (%d) "
 591 +                               "changed to %d\n", ds->info->type,
 592 +                               key_entry->code, i, key_entry->gpio, pressed);
 593 +               input_event(ds->input_dev, ds->info->type,
 594 +                           key_entry->code, pressed);
 595 +       }
 596 +
 597 +#if 0
 598 +       key_entry = kp->keys_info->keymap;
 599 +       key_state = kp->key_state;
 600 +       for (i = 0; i < nkeys; i++, key_entry++, key_state++) {
 601 +               pr_info("gpio_read_detect_status %d %d\n", key_entry->gpio,
 602 +                       gpio_read_detect_status(key_entry->gpio));
 603 +       }
 604 +#endif
 605 +
 606 +       if (ds->debounce_count)
 607 +               hrtimer_start(timer, ds->info->debounce_time, HRTIMER_MODE_REL);
 608 +       else if (!ds->use_irq)
 609 +               hrtimer_start(timer, ds->info->poll_time, HRTIMER_MODE_REL);
 610 +       else
 611 +               wake_unlock(&ds->wake_lock);
 612 +
 613 +       spin_unlock_irqrestore(&ds->irq_lock, irqflags);
 614 +
 615 +       return HRTIMER_NORESTART;
 616 +}
 617 +
 618 +static irqreturn_t gpio_event_input_irq_handler(int irq, void *dev_id)
 619 +{
 620 +       struct gpio_key_state *ks = dev_id;
 621 +       struct gpio_input_state *ds = ks->ds;
 622 +       int keymap_index = ks - ds->key_state;
 623 +       const struct gpio_event_direct_entry *key_entry;
 624 +       unsigned long irqflags;
 625 +       int pressed;
 626 +
 627 +       if (!ds->use_irq)
 628 +               return IRQ_HANDLED;
 629 +
 630 +       key_entry = &ds->info->keymap[keymap_index];
 631 +
 632 +       if (ds->info->debounce_time.tv64) {
 633 +               spin_lock_irqsave(&ds->irq_lock, irqflags);
 634 +               if (ks->debounce & DEBOUNCE_WAIT_IRQ) {
 635 +                       ks->debounce = DEBOUNCE_UNKNOWN;
 636 +                       if (ds->debounce_count++ == 0) {
 637 +                               wake_lock(&ds->wake_lock);
 638 +                               hrtimer_start(
 639 +                                       &ds->timer, ds->info->debounce_time,
 640 +                                       HRTIMER_MODE_REL);
 641 +                       }
 642 +                       if (ds->info->flags & GPIOEDF_PRINT_KEY_DEBOUNCE)
 643 +                               pr_info("gpio_event_input_irq_handler: "
 644 +                                       "key %x-%x, %d (%d) start debounce\n",
 645 +                                       ds->info->type, key_entry->code,
 646 +                                       keymap_index, key_entry->gpio);
 647 +               } else {
 648 +                       disable_irq(irq);
 649 +                       ks->debounce = DEBOUNCE_UNSTABLE;
 650 +               }
 651 +               spin_unlock_irqrestore(&ds->irq_lock, irqflags);
 652 +       } else {
 653 +               pressed = gpio_get_value(key_entry->gpio) ^
 654 +                       !(ds->info->flags & GPIOEDF_ACTIVE_HIGH);
 655 +               if (ds->info->flags & GPIOEDF_PRINT_KEYS)
 656 +                       pr_info("gpio_event_input_irq_handler: key %x-%x, %d "
 657 +                               "(%d) changed to %d\n",
 658 +                               ds->info->type, key_entry->code, keymap_index,
 659 +                               key_entry->gpio, pressed);
 660 +               input_event(ds->input_dev, ds->info->type,
 661 +                           key_entry->code, pressed);
 662 +       }
 663 +       return IRQ_HANDLED;
 664 +}
 665 +
 666 +static int gpio_event_input_request_irqs(struct gpio_input_state *ds)
 667 +{
 668 +       int i;
 669 +       int err;
 670 +       unsigned int irq;
 671 +       unsigned long req_flags = IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING;
 672 +
 673 +       for (i = 0; i < ds->info->keymap_size; i++) {
 674 +               err = irq = gpio_to_irq(ds->info->keymap[i].gpio);
 675 +               if (err < 0)
 676 +                       goto err_gpio_get_irq_num_failed;
 677 +               err = request_irq(irq, gpio_event_input_irq_handler,
 678 +                                 req_flags, "gpio_keys", &ds->key_state[i]);
 679 +               if (err) {
 680 +                       pr_err("gpio_event_input_request_irqs: request_irq "
 681 +                               "failed for input %d, irq %d\n",
 682 +                               ds->info->keymap[i].gpio, irq);
 683 +                       goto err_request_irq_failed;
 684 +               }
 685 +               enable_irq_wake(irq);
 686 +       }
 687 +       return 0;
 688 +
 689 +       for (i = ds->info->keymap_size - 1; i >= 0; i--) {
 690 +               free_irq(gpio_to_irq(ds->info->keymap[i].gpio),
 691 +                        &ds->key_state[i]);
 692 +err_request_irq_failed:
 693 +err_gpio_get_irq_num_failed:
 694 +               ;
 695 +       }
 696 +       return err;
 697 +}
 698 +
 699 +int gpio_event_input_func(struct input_dev *input_dev,
 700 +                       struct gpio_event_info *info, void **data, int func)
 701 +{
 702 +       int ret;
 703 +       int i;
 704 +       unsigned long irqflags;
 705 +       struct gpio_event_input_info *di;
 706 +       struct gpio_input_state *ds = *data;
 707 +
 708 +       di = container_of(info, struct gpio_event_input_info, info);
 709 +
 710 +       if (func == GPIO_EVENT_FUNC_SUSPEND) {
 711 +               spin_lock_irqsave(&ds->irq_lock, irqflags);
 712 +               if (ds->use_irq)
 713 +                       for (i = 0; i < di->keymap_size; i++)
 714 +                               disable_irq(gpio_to_irq(di->keymap[i].gpio));
 715 +               spin_unlock_irqrestore(&ds->irq_lock, irqflags);
 716 +               hrtimer_cancel(&ds->timer);
 717 +               return 0;
 718 +       }
 719 +       if (func == GPIO_EVENT_FUNC_RESUME) {
 720 +               spin_lock_irqsave(&ds->irq_lock, irqflags);
 721 +               if (ds->use_irq)
 722 +                       for (i = 0; i < di->keymap_size; i++)
 723 +                               enable_irq(gpio_to_irq(di->keymap[i].gpio));
 724 +               hrtimer_start(&ds->timer, ktime_set(0, 0), HRTIMER_MODE_REL);
 725 +               spin_unlock_irqrestore(&ds->irq_lock, irqflags);
 726 +               return 0;
 727 +       }
 728 +
 729 +       if (func == GPIO_EVENT_FUNC_INIT) {
 730 +               if (ktime_to_ns(di->poll_time) <= 0)
 731 +                       di->poll_time = ktime_set(0, 20 * NSEC_PER_MSEC);
 732 +
 733 +               *data = ds = kzalloc(sizeof(*ds) + sizeof(ds->key_state[0]) *
 734 +                                       di->keymap_size, GFP_KERNEL);
 735 +               if (ds == NULL) {
 736 +                       ret = -ENOMEM;
 737 +                       pr_err("gpio_event_input_func: "
 738 +                               "Failed to allocate private data\n");
 739 +                       goto err_ds_alloc_failed;
 740 +               }
 741 +               ds->debounce_count = di->keymap_size;
 742 +               ds->input_dev = input_dev;
 743 +               ds->info = di;
 744 +               wake_lock_init(&ds->wake_lock, WAKE_LOCK_SUSPEND, "gpio_input");
 745 +               spin_lock_init(&ds->irq_lock);
 746 +
 747 +               for (i = 0; i < di->keymap_size; i++) {
 748 +                       input_set_capability(input_dev, di->type,
 749 +                                            di->keymap[i].code);
 750 +                       ds->key_state[i].ds = ds;
 751 +                       ds->key_state[i].debounce = DEBOUNCE_UNKNOWN;
 752 +               }
 753 +
 754 +               for (i = 0; i < di->keymap_size; i++) {
 755 +                       ret = gpio_request(di->keymap[i].gpio, "gpio_kp_in");
 756 +                       if (ret) {
 757 +                               pr_err("gpio_event_input_func: gpio_request "
 758 +                                       "failed for %d\n", di->keymap[i].gpio);
 759 +                               goto err_gpio_request_failed;
 760 +                       }
 761 +                       ret = gpio_direction_input(di->keymap[i].gpio);
 762 +                       if (ret) {
 763 +                               pr_err("gpio_event_input_func: "
 764 +                                       "gpio_direction_input failed for %d\n",
 765 +                                       di->keymap[i].gpio);
 766 +                               goto err_gpio_configure_failed;
 767 +                       }
 768 +               }
 769 +
 770 +               ret = gpio_event_input_request_irqs(ds);
 771 +
 772 +               spin_lock_irqsave(&ds->irq_lock, irqflags);
 773 +               ds->use_irq = ret == 0;
 774 +
 775 +               pr_info("GPIO Input Driver: Start gpio inputs for %s in %s "
 776 +                       "mode\n",
 777 +                       input_dev->name, ret == 0 ? "interrupt" : "polling");
 778 +
 779 +               hrtimer_init(&ds->timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
 780 +               ds->timer.function = gpio_event_input_timer_func;
 781 +               hrtimer_start(&ds->timer, ktime_set(0, 0), HRTIMER_MODE_REL);
 782 +               spin_unlock_irqrestore(&ds->irq_lock, irqflags);
 783 +               return 0;
 784 +       }
 785 +
 786 +       ret = 0;
 787 +       spin_lock_irqsave(&ds->irq_lock, irqflags);
 788 +       hrtimer_cancel(&ds->timer);
 789 +       if (ds->use_irq) {
 790 +               for (i = di->keymap_size - 1; i >= 0; i--) {
 791 +                       free_irq(gpio_to_irq(di->keymap[i].gpio),
 792 +                                &ds->key_state[i]);
 793 +               }
 794 +       }
 795 +       spin_unlock_irqrestore(&ds->irq_lock, irqflags);
 796 +
 797 +       for (i = di->keymap_size - 1; i >= 0; i--) {
 798 +err_gpio_configure_failed:
 799 +               gpio_free(di->keymap[i].gpio);
 800 +err_gpio_request_failed:
 801 +               ;
 802 +       }
 803 +       wake_lock_destroy(&ds->wake_lock);
 804 +       kfree(ds);
 805 +err_ds_alloc_failed:
 806 +       return ret;
 807 +}
 808 --- /dev/null
 809 +++ b/drivers/input/misc/gpio_matrix.c
 810 @@ -0,0 +1,406 @@
 811 +/* drivers/input/misc/gpio_matrix.c
 812 + *
 813 + * Copyright (C) 2007 Google, Inc.
 814 + *
 815 + * This software is licensed under the terms of the GNU General Public
 816 + * License version 2, as published by the Free Software Foundation, and
 817 + * may be copied, distributed, and modified under those terms.
 818 + *
 819 + * This program is distributed in the hope that it will be useful,
 820 + * but WITHOUT ANY WARRANTY; without even the implied warranty of
 821 + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 822 + * GNU General Public License for more details.
 823 + *
 824 + */
 825 +
 826 +#include <linux/kernel.h>
 827 +#include <linux/gpio.h>
 828 +#include <linux/gpio_event.h>
 829 +#include <linux/hrtimer.h>
 830 +#include <linux/interrupt.h>
 831 +#include <linux/wakelock.h>
 832 +
 833 +struct gpio_kp {
 834 +       struct input_dev *input_dev;
 835 +       struct gpio_event_matrix_info *keypad_info;
 836 +       struct hrtimer timer;
 837 +       struct wake_lock wake_lock;
 838 +       int current_output;
 839 +       unsigned int use_irq:1;
 840 +       unsigned int key_state_changed:1;
 841 +       unsigned int last_key_state_changed:1;
 842 +       unsigned int some_keys_pressed:2;
 843 +       unsigned long keys_pressed[0];
 844 +};
 845 +
 846 +static void clear_phantom_key(struct gpio_kp *kp, int out, int in)
 847 +{
 848 +       struct gpio_event_matrix_info *mi = kp->keypad_info;
 849 +       int key_index = out * mi->ninputs + in;
 850 +       unsigned short keycode = mi->keymap[key_index];;
 851 +
 852 +       if (!test_bit(keycode, kp->input_dev->key)) {
 853 +               if (mi->flags & GPIOKPF_PRINT_PHANTOM_KEYS)
 854 +                       pr_info("gpiomatrix: phantom key %x, %d-%d (%d-%d) "
 855 +                               "cleared\n", keycode, out, in,
 856 +                               mi->output_gpios[out], mi->input_gpios[in]);
 857 +               __clear_bit(key_index, kp->keys_pressed);
 858 +       } else {
 859 +               if (mi->flags & GPIOKPF_PRINT_PHANTOM_KEYS)
 860 +                       pr_info("gpiomatrix: phantom key %x, %d-%d (%d-%d) "
 861 +                               "not cleared\n", keycode, out, in,
 862 +                               mi->output_gpios[out], mi->input_gpios[in]);
 863 +       }
 864 +}
 865 +
 866 +static int restore_keys_for_input(struct gpio_kp *kp, int out, int in)
 867 +{
 868 +       int rv = 0;
 869 +       int key_index;
 870 +
 871 +       key_index = out * kp->keypad_info->ninputs + in;
 872 +       while (out < kp->keypad_info->noutputs) {
 873 +               if (test_bit(key_index, kp->keys_pressed)) {
 874 +                       rv = 1;
 875 +                       clear_phantom_key(kp, out, in);
 876 +               }
 877 +               key_index += kp->keypad_info->ninputs;
 878 +               out++;
 879 +       }
 880 +       return rv;
 881 +}
 882 +
 883 +static void remove_phantom_keys(struct gpio_kp *kp)
 884 +{
 885 +       int out, in, inp;
 886 +       int key_index;
 887 +
 888 +       if (kp->some_keys_pressed < 3)
 889 +               return;
 890 +
 891 +       for (out = 0; out < kp->keypad_info->noutputs; out++) {
 892 +               inp = -1;
 893 +               key_index = out * kp->keypad_info->ninputs;
 894 +               for (in = 0; in < kp->keypad_info->ninputs; in++, key_index++) {
 895 +                       if (test_bit(key_index, kp->keys_pressed)) {
 896 +                               if (inp == -1) {
 897 +                                       inp = in;
 898 +                                       continue;
 899 +                               }
 900 +                               if (inp >= 0) {
 901 +                                       if (!restore_keys_for_input(kp, out + 1,
 902 +                                                                       inp))
 903 +                                               break;
 904 +                                       clear_phantom_key(kp, out, inp);
 905 +                                       inp = -2;
 906 +                               }
 907 +                               restore_keys_for_input(kp, out, in);
 908 +                       }
 909 +               }
 910 +       }
 911 +}
 912 +
 913 +static void report_key(struct gpio_kp *kp, int key_index, int out, int in)
 914 +{
 915 +       struct gpio_event_matrix_info *mi = kp->keypad_info;
 916 +       int pressed = test_bit(key_index, kp->keys_pressed);
 917 +       unsigned short keycode = mi->keymap[key_index];
 918 +       if (pressed != test_bit(keycode, kp->input_dev->key)) {
 919 +               if (keycode == KEY_RESERVED) {
 920 +                       if (mi->flags & GPIOKPF_PRINT_UNMAPPED_KEYS)
 921 +                               pr_info("gpiomatrix: unmapped key, %d-%d "
 922 +                                       "(%d-%d) changed to %d\n",
 923 +                                       out, in, mi->output_gpios[out],
 924 +                                       mi->input_gpios[in], pressed);
 925 +               } else {
 926 +                       if (mi->flags & GPIOKPF_PRINT_MAPPED_KEYS)
 927 +                               pr_info("gpiomatrix: key %x, %d-%d (%d-%d) "
 928 +                                       "changed to %d\n", keycode,
 929 +                                       out, in, mi->output_gpios[out],
 930 +                                       mi->input_gpios[in], pressed);
 931 +                       input_report_key(kp->input_dev, keycode, pressed);
 932 +               }
 933 +       }
 934 +}
 935 +
 936 +static enum hrtimer_restart gpio_keypad_timer_func(struct hrtimer *timer)
 937 +{
 938 +       int out, in;
 939 +       int key_index;
 940 +       int gpio;
 941 +       struct gpio_kp *kp = container_of(timer, struct gpio_kp, timer);
 942 +       struct gpio_event_matrix_info *mi = kp->keypad_info;
 943 +       unsigned gpio_keypad_flags = mi->flags;
 944 +       unsigned polarity = !!(gpio_keypad_flags & GPIOKPF_ACTIVE_HIGH);
 945 +
 946 +       out = kp->current_output;
 947 +       if (out == mi->noutputs) {
 948 +               out = 0;
 949 +               kp->last_key_state_changed = kp->key_state_changed;
 950 +               kp->key_state_changed = 0;
 951 +               kp->some_keys_pressed = 0;
 952 +       } else {
 953 +               key_index = out * mi->ninputs;
 954 +               for (in = 0; in < mi->ninputs; in++, key_index++) {
 955 +                       gpio = mi->input_gpios[in];
 956 +                       if (gpio_get_value(gpio) ^ !polarity) {
 957 +                               if (kp->some_keys_pressed < 3)
 958 +                                       kp->some_keys_pressed++;
 959 +                               kp->key_state_changed |= !__test_and_set_bit(
 960 +                                               key_index, kp->keys_pressed);
 961 +                       } else
 962 +                               kp->key_state_changed |= __test_and_clear_bit(
 963 +                                               key_index, kp->keys_pressed);
 964 +               }
 965 +               gpio = mi->output_gpios[out];
 966 +               if (gpio_keypad_flags & GPIOKPF_DRIVE_INACTIVE)
 967 +                       gpio_set_value(gpio, !polarity);
 968 +               else
 969 +                       gpio_direction_input(gpio);
 970 +               out++;
 971 +       }
 972 +       kp->current_output = out;
 973 +       if (out < mi->noutputs) {
 974 +               gpio = mi->output_gpios[out];
 975 +               if (gpio_keypad_flags & GPIOKPF_DRIVE_INACTIVE)
 976 +                       gpio_set_value(gpio, polarity);
 977 +               else
 978 +                       gpio_direction_output(gpio, polarity);
 979 +               hrtimer_start(timer, mi->settle_time, HRTIMER_MODE_REL);
 980 +               return HRTIMER_NORESTART;
 981 +       }
 982 +       if (gpio_keypad_flags & GPIOKPF_DEBOUNCE) {
 983 +               if (kp->key_state_changed) {
 984 +                       hrtimer_start(&kp->timer, mi->debounce_delay,
 985 +                                     HRTIMER_MODE_REL);
 986 +                       return HRTIMER_NORESTART;
 987 +               }
 988 +               kp->key_state_changed = kp->last_key_state_changed;
 989 +       }
 990 +       if (kp->key_state_changed) {
 991 +               if (gpio_keypad_flags & GPIOKPF_REMOVE_SOME_PHANTOM_KEYS)
 992 +                       remove_phantom_keys(kp);
 993 +               key_index = 0;
 994 +               for (out = 0; out < mi->noutputs; out++)
 995 +                       for (in = 0; in < mi->ninputs; in++, key_index++)
 996 +                               report_key(kp, key_index, out, in);
 997 +       }
 998 +       if (!kp->use_irq || kp->some_keys_pressed) {
 999 +               hrtimer_start(timer, mi->poll_time, HRTIMER_MODE_REL);
1000 +               return HRTIMER_NORESTART;
1001 +       }
1002 +
1003 +       /* No keys are pressed, reenable interrupt */
1004 +       for (out = 0; out < mi->noutputs; out++) {
1005 +               if (gpio_keypad_flags & GPIOKPF_DRIVE_INACTIVE)
1006 +                       gpio_set_value(mi->output_gpios[out], polarity);
1007 +               else
1008 +                       gpio_direction_output(mi->output_gpios[out], polarity);
1009 +       }
1010 +       for (in = 0; in < mi->ninputs; in++)
1011 +               enable_irq(gpio_to_irq(mi->input_gpios[in]));
1012 +       wake_unlock(&kp->wake_lock);
1013 +       return HRTIMER_NORESTART;
1014 +}
1015 +
1016 +static irqreturn_t gpio_keypad_irq_handler(int irq_in, void *dev_id)
1017 +{
1018 +       int i;
1019 +       struct gpio_kp *kp = dev_id;
1020 +       struct gpio_event_matrix_info *mi = kp->keypad_info;
1021 +       unsigned gpio_keypad_flags = mi->flags;
1022 +
1023 +       if (!kp->use_irq) /* ignore interrupt while registering the handler */
1024 +               return IRQ_HANDLED;
1025 +
1026 +       for (i = 0; i < mi->ninputs; i++)
1027 +               disable_irq(gpio_to_irq(mi->input_gpios[i]));
1028 +       for (i = 0; i < mi->noutputs; i++) {
1029 +               if (gpio_keypad_flags & GPIOKPF_DRIVE_INACTIVE)
1030 +                       gpio_set_value(mi->output_gpios[i],
1031 +                               !(gpio_keypad_flags & GPIOKPF_ACTIVE_HIGH));
1032 +               else
1033 +                       gpio_direction_input(mi->output_gpios[i]);
1034 +       }
1035 +       wake_lock(&kp->wake_lock);
1036 +       hrtimer_start(&kp->timer, ktime_set(0, 0), HRTIMER_MODE_REL);
1037 +       return IRQ_HANDLED;
1038 +}
1039 +
1040 +static int gpio_keypad_request_irqs(struct gpio_kp *kp)
1041 +{
1042 +       int i;
1043 +       int err;
1044 +       unsigned int irq;
1045 +       unsigned long request_flags;
1046 +       struct gpio_event_matrix_info *mi = kp->keypad_info;
1047 +
1048 +       switch (mi->flags & (GPIOKPF_ACTIVE_HIGH|GPIOKPF_LEVEL_TRIGGERED_IRQ)) {
1049 +       default:
1050 +               request_flags = IRQF_TRIGGER_FALLING;
1051 +               break;
1052 +       case GPIOKPF_ACTIVE_HIGH:
1053 +               request_flags = IRQF_TRIGGER_RISING;
1054 +               break;
1055 +       case GPIOKPF_LEVEL_TRIGGERED_IRQ:
1056 +               request_flags = IRQF_TRIGGER_LOW;
1057 +               break;
1058 +       case GPIOKPF_LEVEL_TRIGGERED_IRQ | GPIOKPF_ACTIVE_HIGH:
1059 +               request_flags = IRQF_TRIGGER_HIGH;
1060 +               break;
1061 +       }
1062 +
1063 +       for (i = 0; i < mi->ninputs; i++) {
1064 +               err = irq = gpio_to_irq(mi->input_gpios[i]);
1065 +               if (err < 0)
1066 +                       goto err_gpio_get_irq_num_failed;
1067 +               err = request_irq(irq, gpio_keypad_irq_handler, request_flags,
1068 +                                 "gpio_kp", kp);
1069 +               if (err) {
1070 +                       pr_err("gpiomatrix: request_irq failed for input %d, "
1071 +                               "irq %d\n", mi->input_gpios[i], irq);
1072 +                       goto err_request_irq_failed;
1073 +               }
1074 +               err = set_irq_wake(irq, 1);
1075 +               if (err) {
1076 +                       pr_err("gpiomatrix: set_irq_wake failed for input %d, "
1077 +                               "irq %d\n", mi->input_gpios[i], irq);
1078 +               }
1079 +               disable_irq(irq);
1080 +       }
1081 +       return 0;
1082 +
1083 +       for (i = mi->noutputs - 1; i >= 0; i--) {
1084 +               free_irq(gpio_to_irq(mi->input_gpios[i]), kp);
1085 +err_request_irq_failed:
1086 +err_gpio_get_irq_num_failed:
1087 +               ;
1088 +       }
1089 +       return err;
1090 +}
1091 +
1092 +int gpio_event_matrix_func(struct input_dev *input_dev,
1093 +       struct gpio_event_info *info, void **data, int func)
1094 +{
1095 +       int i;
1096 +       int err;
1097 +       int key_count;
1098 +       struct gpio_kp *kp;
1099 +       struct gpio_event_matrix_info *mi;
1100 +
1101 +       mi = container_of(info, struct gpio_event_matrix_info, info);
1102 +       if (func == GPIO_EVENT_FUNC_SUSPEND || func == GPIO_EVENT_FUNC_RESUME) {
1103 +               /* TODO: disable scanning */
1104 +               return 0;
1105 +       }
1106 +
1107 +       if (func == GPIO_EVENT_FUNC_INIT) {
1108 +               if (mi->keymap == NULL ||
1109 +                  mi->input_gpios == NULL ||
1110 +                  mi->output_gpios == NULL) {
1111 +                       err = -ENODEV;
1112 +                       pr_err("gpiomatrix: Incomplete pdata\n");
1113 +                       goto err_invalid_platform_data;
1114 +               }
1115 +               key_count = mi->ninputs * mi->noutputs;
1116 +
1117 +               *data = kp = kzalloc(sizeof(*kp) + sizeof(kp->keys_pressed[0]) *
1118 +                                    BITS_TO_LONGS(key_count), GFP_KERNEL);
1119 +               if (kp == NULL) {
1120 +                       err = -ENOMEM;
1121 +                       pr_err("gpiomatrix: Failed to allocate private data\n");
1122 +                       goto err_kp_alloc_failed;
1123 +               }
1124 +               kp->input_dev = input_dev;
1125 +               kp->keypad_info = mi;
1126 +               set_bit(EV_KEY, input_dev->evbit);
1127 +               for (i = 0; i < key_count; i++) {
1128 +                       if (mi->keymap[i])
1129 +                               set_bit(mi->keymap[i] & KEY_MAX,
1130 +                                       input_dev->keybit);
1131 +               }
1132 +
1133 +               for (i = 0; i < mi->noutputs; i++) {
1134 +                       if (gpio_cansleep(mi->output_gpios[i])) {
1135 +                               pr_err("gpiomatrix: unsupported output gpio %d,"
1136 +                                       " can sleep\n", mi->output_gpios[i]);
1137 +                               err = -EINVAL;
1138 +                               goto err_request_output_gpio_failed;
1139 +                       }
1140 +                       err = gpio_request(mi->output_gpios[i], "gpio_kp_out");
1141 +                       if (err) {
1142 +                               pr_err("gpiomatrix: gpio_request failed for "
1143 +                                       "output %d\n", mi->output_gpios[i]);
1144 +                               goto err_request_output_gpio_failed;
1145 +                       }
1146 +                       if (mi->flags & GPIOKPF_DRIVE_INACTIVE)
1147 +                               err = gpio_direction_output(mi->output_gpios[i],
1148 +                                       !(mi->flags & GPIOKPF_ACTIVE_HIGH));
1149 +                       else
1150 +                               err = gpio_direction_input(mi->output_gpios[i]);
1151 +                       if (err) {
1152 +                               pr_err("gpiomatrix: gpio_configure failed for "
1153 +                                       "output %d\n", mi->output_gpios[i]);
1154 +                               goto err_output_gpio_configure_failed;
1155 +                       }
1156 +               }
1157 +               for (i = 0; i < mi->ninputs; i++) {
1158 +                       err = gpio_request(mi->input_gpios[i], "gpio_kp_in");
1159 +                       if (err) {
1160 +                               pr_err("gpiomatrix: gpio_request failed for "
1161 +                                       "input %d\n", mi->input_gpios[i]);
1162 +                               goto err_request_input_gpio_failed;
1163 +                       }
1164 +                       err = gpio_direction_input(mi->input_gpios[i]);
1165 +                       if (err) {
1166 +                               pr_err("gpiomatrix: gpio_direction_input failed"
1167 +                                       " for input %d\n", mi->input_gpios[i]);
1168 +                               goto err_gpio_direction_input_failed;
1169 +                       }
1170 +               }
1171 +               kp->current_output = mi->noutputs;
1172 +               kp->key_state_changed = 1;
1173 +
1174 +               hrtimer_init(&kp->timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
1175 +               kp->timer.function = gpio_keypad_timer_func;
1176 +               wake_lock_init(&kp->wake_lock, WAKE_LOCK_SUSPEND, "gpio_kp");
1177 +               err = gpio_keypad_request_irqs(kp);
1178 +               kp->use_irq = err == 0;
1179 +
1180 +               pr_info("GPIO Matrix Keypad Driver: Start keypad matrix for %s "
1181 +                       "in %s mode\n", input_dev->name,
1182 +                       kp->use_irq ? "interrupt" : "polling");
1183 +
1184 +               if (kp->use_irq)
1185 +                       wake_lock(&kp->wake_lock);
1186 +               hrtimer_start(&kp->timer, ktime_set(0, 0), HRTIMER_MODE_REL);
1187 +
1188 +               return 0;
1189 +       }
1190 +
1191 +       err = 0;
1192 +       kp = *data;
1193 +
1194 +       if (kp->use_irq)
1195 +               for (i = mi->noutputs - 1; i >= 0; i--)
1196 +                       free_irq(gpio_to_irq(mi->input_gpios[i]), kp);
1197 +
1198 +       hrtimer_cancel(&kp->timer);
1199 +       wake_lock_destroy(&kp->wake_lock);
1200 +       for (i = mi->noutputs - 1; i >= 0; i--) {
1201 +err_gpio_direction_input_failed:
1202 +               gpio_free(mi->input_gpios[i]);
1203 +err_request_input_gpio_failed:
1204 +               ;
1205 +       }
1206 +       for (i = mi->noutputs - 1; i >= 0; i--) {
1207 +err_output_gpio_configure_failed:
1208 +               gpio_free(mi->output_gpios[i]);
1209 +err_request_output_gpio_failed:
1210 +               ;
1211 +       }
1212 +       kfree(kp);
1213 +err_kp_alloc_failed:
1214 +err_invalid_platform_data:
1215 +       return err;
1216 +}
1217 --- /dev/null
1218 +++ b/drivers/input/misc/gpio_output.c
1219 @@ -0,0 +1,84 @@
1220 +/* drivers/input/misc/gpio_output.c
1221 + *
1222 + * Copyright (C) 2007 Google, Inc.
1223 + *
1224 + * This software is licensed under the terms of the GNU General Public
1225 + * License version 2, as published by the Free Software Foundation, and
1226 + * may be copied, distributed, and modified under those terms.
1227 + *
1228 + * This program is distributed in the hope that it will be useful,
1229 + * but WITHOUT ANY WARRANTY; without even the implied warranty of
1230 + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
1231 + * GNU General Public License for more details.
1232 + *
1233 + */
1234 +
1235 +#include <linux/kernel.h>
1236 +#include <linux/gpio.h>
1237 +#include <linux/gpio_event.h>
1238 +
1239 +int gpio_event_output_event(
1240 +       struct input_dev *input_dev, struct gpio_event_info *info, void **data,
1241 +       unsigned int type, unsigned int code, int value)
1242 +{
1243 +       int i;
1244 +       struct gpio_event_output_info *oi;
1245 +       oi = container_of(info, struct gpio_event_output_info, info);
1246 +       if (type != oi->type)
1247 +               return 0;
1248 +       if (!(oi->flags & GPIOEDF_ACTIVE_HIGH))
1249 +               value = !value;
1250 +       for (i = 0; i < oi->keymap_size; i++)
1251 +               if (code == oi->keymap[i].code)
1252 +                       gpio_set_value(oi->keymap[i].gpio, value);
1253 +       return 0;
1254 +}
1255 +
1256 +int gpio_event_output_func(
1257 +       struct input_dev *input_dev, struct gpio_event_info *info, void **data,
1258 +       int func)
1259 +{
1260 +       int ret;
1261 +       int i;
1262 +       struct gpio_event_output_info *oi;
1263 +       oi = container_of(info, struct gpio_event_output_info, info);
1264 +
1265 +       if (func == GPIO_EVENT_FUNC_SUSPEND || func == GPIO_EVENT_FUNC_RESUME)
1266 +               return 0;
1267 +
1268 +       if (func == GPIO_EVENT_FUNC_INIT) {
1269 +               int output_level = !(oi->flags & GPIOEDF_ACTIVE_HIGH);
1270 +               for (i = 0; i < oi->keymap_size; i++)
1271 +                       input_set_capability(input_dev, oi->type,
1272 +                                            oi->keymap[i].code);
1273 +
1274 +               for (i = 0; i < oi->keymap_size; i++) {
1275 +                       ret = gpio_request(oi->keymap[i].gpio,
1276 +                                          "gpio_event_output");
1277 +                       if (ret) {
1278 +                               pr_err("gpio_event_output_func: gpio_request "
1279 +                                       "failed for %d\n", oi->keymap[i].gpio);
1280 +                               goto err_gpio_request_failed;
1281 +                       }
1282 +                       ret = gpio_direction_output(oi->keymap[i].gpio,
1283 +                                                   output_level);
1284 +                       if (ret) {
1285 +                               pr_err("gpio_event_output_func: "
1286 +                                       "gpio_direction_output failed for %d\n",
1287 +                                       oi->keymap[i].gpio);
1288 +                               goto err_gpio_direction_output_failed;
1289 +                       }
1290 +               }
1291 +               return 0;
1292 +       }
1293 +
1294 +       ret = 0;
1295 +       for (i = oi->keymap_size - 1; i >= 0; i--) {
1296 +err_gpio_direction_output_failed:
1297 +               gpio_free(oi->keymap[i].gpio);
1298 +err_gpio_request_failed:
1299 +               ;
1300 +       }
1301 +       return ret;
1302 +}
1303 +
1304 --- /dev/null
1305 +++ b/include/linux/gpio_event.h
1306 @@ -0,0 +1,154 @@
1307 +/* include/linux/gpio_event.h
1308 + *
1309 + * Copyright (C) 2007 Google, Inc.
1310 + *
1311 + * This software is licensed under the terms of the GNU General Public
1312 + * License version 2, as published by the Free Software Foundation, and
1313 + * may be copied, distributed, and modified under those terms.
1314 + *
1315 + * This program is distributed in the hope that it will be useful,
1316 + * but WITHOUT ANY WARRANTY; without even the implied warranty of
1317 + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
1318 + * GNU General Public License for more details.
1319 + *
1320 + */
1321 +
1322 +#ifndef _LINUX_GPIO_EVENT_H
1323 +#define _LINUX_GPIO_EVENT_H
1324 +
1325 +#include <linux/input.h>
1326 +
1327 +enum {
1328 +       GPIO_EVENT_FUNC_UNINIT  = 0x0,
1329 +       GPIO_EVENT_FUNC_INIT    = 0x1,
1330 +       GPIO_EVENT_FUNC_SUSPEND = 0x2,
1331 +       GPIO_EVENT_FUNC_RESUME  = 0x3,
1332 +};
1333 +struct gpio_event_info {
1334 +       int (*func)(struct input_dev *input_dev,
1335 +                   struct gpio_event_info *info,
1336 +                   void **data, int func);
1337 +       int (*event)(struct input_dev *input_dev,
1338 +                    struct gpio_event_info *info,
1339 +                    void **data, unsigned int type,
1340 +                    unsigned int code, int value); /* out events */
1341 +};
1342 +
1343 +struct gpio_event_platform_data {
1344 +       const char *name;
1345 +       struct gpio_event_info **info;
1346 +       size_t info_count;
1347 +       int (*power)(const struct gpio_event_platform_data *pdata, bool on);
1348 +};
1349 +
1350 +#define GPIO_EVENT_DEV_NAME "gpio-event"
1351 +
1352 +/* Key matrix */
1353 +
1354 +enum gpio_event_matrix_flags {
1355 +       /* unset: drive active output low, set: drive active output high */
1356 +       GPIOKPF_ACTIVE_HIGH              = 1U << 0,
1357 +       GPIOKPF_DEBOUNCE                 = 1U << 1,
1358 +       GPIOKPF_REMOVE_SOME_PHANTOM_KEYS = 1U << 2,
1359 +       GPIOKPF_REMOVE_PHANTOM_KEYS      = GPIOKPF_REMOVE_SOME_PHANTOM_KEYS |
1360 +                                          GPIOKPF_DEBOUNCE,
1361 +       GPIOKPF_DRIVE_INACTIVE           = 1U << 3,
1362 +       GPIOKPF_LEVEL_TRIGGERED_IRQ      = 1U << 4,
1363 +       GPIOKPF_PRINT_UNMAPPED_KEYS      = 1U << 16,
1364 +       GPIOKPF_PRINT_MAPPED_KEYS        = 1U << 17,
1365 +       GPIOKPF_PRINT_PHANTOM_KEYS       = 1U << 18,
1366 +};
1367 +
1368 +extern int gpio_event_matrix_func(struct input_dev *input_dev,
1369 +                       struct gpio_event_info *info, void **data, int func);
1370 +struct gpio_event_matrix_info {
1371 +       /* initialize to gpio_event_matrix_func */
1372 +       struct gpio_event_info info;
1373 +       /* size must be ninputs * noutputs */
1374 +       const unsigned short *keymap;
1375 +       unsigned int *input_gpios;
1376 +       unsigned int *output_gpios;
1377 +       unsigned int ninputs;
1378 +       unsigned int noutputs;
1379 +       /* time to wait before reading inputs after driving each output */
1380 +       ktime_t settle_time;
1381 +       /* time to wait before scanning the keypad a second time */
1382 +       ktime_t debounce_delay;
1383 +       ktime_t poll_time;
1384 +       unsigned flags;
1385 +};
1386 +
1387 +/* Directly connected inputs and outputs */
1388 +
1389 +enum gpio_event_direct_flags {
1390 +       GPIOEDF_ACTIVE_HIGH         = 1U << 0,
1391 +/*     GPIOEDF_USE_DOWN_IRQ        = 1U << 1, */
1392 +/*     GPIOEDF_USE_IRQ             = (1U << 2) | GPIOIDF_USE_DOWN_IRQ, */
1393 +       GPIOEDF_PRINT_KEYS          = 1U << 8,
1394 +       GPIOEDF_PRINT_KEY_DEBOUNCE  = 1U << 9,
1395 +};
1396 +
1397 +struct gpio_event_direct_entry {
1398 +       uint32_t gpio:23;
1399 +       uint32_t code:9;
1400 +};
1401 +
1402 +/* inputs */
1403 +extern int gpio_event_input_func(struct input_dev *input_dev,
1404 +                       struct gpio_event_info *info, void **data, int func);
1405 +struct gpio_event_input_info {
1406 +       /* initialize to gpio_event_input_func */
1407 +       struct gpio_event_info info;
1408 +       ktime_t debounce_time;
1409 +       ktime_t poll_time;
1410 +       uint16_t flags;
1411 +       uint16_t type;
1412 +       const struct gpio_event_direct_entry *keymap;
1413 +       size_t keymap_size;
1414 +};
1415 +
1416 +/* outputs */
1417 +extern int gpio_event_output_func(struct input_dev *input_dev,
1418 +                       struct gpio_event_info *info, void **data, int func);
1419 +extern int gpio_event_output_event(struct input_dev *input_dev,
1420 +                       struct gpio_event_info *info, void **data,
1421 +                       unsigned int type, unsigned int code, int value);
1422 +struct gpio_event_output_info {
1423 +       /* initialize to gpio_event_output_func and gpio_event_output_event */
1424 +       struct gpio_event_info info;
1425 +       uint16_t flags;
1426 +       uint16_t type;
1427 +       const struct gpio_event_direct_entry *keymap;
1428 +       size_t keymap_size;
1429 +};
1430 +
1431 +
1432 +/* axes */
1433 +
1434 +enum gpio_event_axis_flags {
1435 +       GPIOEAF_PRINT_UNKNOWN_DIRECTION  = 1U << 16,
1436 +       GPIOEAF_PRINT_RAW                = 1U << 17,
1437 +       GPIOEAF_PRINT_EVENT              = 1U << 18,
1438 +};
1439 +
1440 +extern int gpio_event_axis_func(struct input_dev *input_dev,
1441 +                       struct gpio_event_info *info, void **data, int func);
1442 +struct gpio_event_axis_info {
1443 +       /* initialize to gpio_event_axis_func */
1444 +       struct gpio_event_info info;
1445 +       uint8_t  count;
1446 +       uint8_t  type; /* EV_REL or EV_ABS */
1447 +       uint16_t code;
1448 +       uint16_t decoded_size;
1449 +       uint16_t (*map)(struct gpio_event_axis_info *info, uint16_t in);
1450 +       uint32_t *gpio;
1451 +       uint32_t flags;
1452 +};
1453 +#define gpio_axis_2bit_gray_map gpio_axis_4bit_gray_map
1454 +#define gpio_axis_3bit_gray_map gpio_axis_4bit_gray_map
1455 +uint16_t gpio_axis_4bit_gray_map(
1456 +                       struct gpio_event_axis_info *info, uint16_t in);
1457 +uint16_t gpio_axis_5bit_singletrack_map(
1458 +                       struct gpio_event_axis_info *info, uint16_t in);
1459 +
1460 +#endif