From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1752505AbZHHQmv (ORCPT ); Sat, 8 Aug 2009 12:42:51 -0400 Received: (majordomo@vger.kernel.org) by vger.kernel.org id S1752088AbZHHQmu (ORCPT ); Sat, 8 Aug 2009 12:42:50 -0400 Received: from qw-out-2122.google.com ([74.125.92.25]:11240 "EHLO qw-out-2122.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1752437AbZHHQmr convert rfc822-to-8bit (ORCPT ); Sat, 8 Aug 2009 12:42:47 -0400 DomainKey-Signature: a=rsa-sha1; c=nofws; d=gmail.com; s=gamma; h=mime-version:in-reply-to:references:date:message-id:subject:from:to :cc:content-type:content-transfer-encoding; b=bCAk3o3AxYnIM6FE2X/2YWsRU5yFc1Gle/m92pMokvaxUHnLSpLp523OekIhIrcyQs u6KIdTw8aygtM+KudWI1XbS2xHGbj31htbWhBHY4JjMOPkitH9mR7Bf/M6CSfQmASc41 sywXpA2ZMmtAguZ6mEWVVfG4p7SKbDtq4svV8= MIME-Version: 1.0 In-Reply-To: <20090808130315.GA12930@elf.ucw.cz> References: <20090808130315.GA12930@elf.ucw.cz> Date: Sat, 8 Aug 2009 22:12:46 +0530 Message-ID: <5d5443650908080942l50d91d31qb23c494affdf6850@mail.gmail.com> Subject: Re: HTC Dream for staging: add support for input on GPIO pins From: Trilok Soni To: Pavel Machek Cc: Greg KH , kernel list , swetland@google.com, linux-input@vger.kernel.org Content-Type: text/plain; charset=ISO-8859-1 Content-Transfer-Encoding: 8BIT Sender: linux-kernel-owner@vger.kernel.org List-ID: X-Mailing-List: linux-kernel@vger.kernel.org Hi Pavel, On Sat, Aug 8, 2009 at 6:33 PM, Pavel Machek wrote: > From: Arve Hj?nnev?g > > Support for input devices connected to GPIO pins. This adds support > for HTC Dream's keyboard and its trackball. Generic support already > exists for keyboard on GPIO, but this one is more advanced because it > can detect shadow key presses (and actually works with Dream :-). > > (It also contains Kconfig/Makefile changes, including some that were > missing from previous commit. Sorry.) I don't see any importance of gpio_matrix.c when we already have generic gpio matrix driver mainlined. I would suggest to remove those bits from this patch. I have added linux-input ML. > > Signed-off-by: Pavel Machek > > diff --git a/drivers/staging/dream/Kconfig b/drivers/staging/dream/Kconfig > new file mode 100644 > index 0000000..52bd187 > --- /dev/null > +++ b/drivers/staging/dream/Kconfig > @@ -0,0 +1,12 @@ > +source "drivers/staging/dream/smd/Kconfig" > + > +source "drivers/staging/dream/camera/Kconfig" > + > + > +config INPUT_GPIO > +       tristate "GPIO driver support" > +       help > +         Say Y here if you want to support gpio based keys, wheels etc... > + > + > + > diff --git a/drivers/staging/dream/Makefile b/drivers/staging/dream/Makefile > new file mode 100644 > index 0000000..083bb67 > --- /dev/null > +++ b/drivers/staging/dream/Makefile > @@ -0,0 +1,4 @@ > +obj-$(CONFIG_MSM_ADSP)         += qdsp5/ smd/ > +obj-$(CONFIG_MSM_CAMERA)       += camera/ > +obj-$(CONFIG_INPUT_GPIO)       += gpio_axis.o gpio_event.o gpio_input.o gpio_matrix.o gpio_output.o > + > \ No newline at end of file > diff --git a/drivers/staging/dream/gpio_axis.c b/drivers/staging/dream/gpio_axis.c > new file mode 100644 > index 0000000..c801172 > --- /dev/null > +++ b/drivers/staging/dream/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 > +#include > +#include > +#include > + > +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; > +} > diff --git a/drivers/staging/dream/gpio_event.c b/drivers/staging/dream/gpio_event.c > new file mode 100644 > index 0000000..8b64c1e > --- /dev/null > +++ b/drivers/staging/dream/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 > +#include > +#include > +#include > +#include > +#include > + > +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"); > + > diff --git a/drivers/staging/dream/gpio_input.c b/drivers/staging/dream/gpio_input.c > new file mode 100644 > index 0000000..7e307f2 > --- /dev/null > +++ b/drivers/staging/dream/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 > +#include > +#include > +#include > +#include > +#include > +#include > + > +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; > +} > diff --git a/drivers/staging/dream/gpio_matrix.c b/drivers/staging/dream/gpio_matrix.c > new file mode 100644 > index 0000000..c1f4765 > --- /dev/null > +++ b/drivers/staging/dream/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 > +#include > +#include > +#include > +#include > +#include > + > +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; > +} > diff --git a/drivers/staging/dream/gpio_output.c b/drivers/staging/dream/gpio_output.c > new file mode 100644 > index 0000000..6f8453c > --- /dev/null > +++ b/drivers/staging/dream/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 > +#include > +#include > + > +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; > +} > + > > -- > (english) http://www.livejournal.com/~pavelmachek > (cesky, pictures) http://atrey.karlin.mff.cuni.cz/~pavel/picture/horses/blog.html > -- > To unsubscribe from this list: send the line "unsubscribe linux-kernel" in > the body of a message to majordomo@vger.kernel.org > More majordomo info at  http://vger.kernel.org/majordomo-info.html > Please read the FAQ at  http://www.tux.org/lkml/ > -- ---Trilok Soni http://triloksoni.wordpress.com http://www.linkedin.com/in/triloksoni