From fb189822fcab111e55d1c7e83c482dc2c144500a Mon Sep 17 00:00:00 2001 From: lars Date: Mon, 18 May 2009 17:55:41 +0000 Subject: [s3c24xx] bump to 2.6.30-rc6 git-svn-id: svn://svn.openwrt.org/openwrt/trunk@15918 3c298f89-4303-0410-b956-a3cf2f4a3e73 --- .../files-2.6.30/drivers/input/keyboard/gta02kbd.c | 442 +++++++++++++++++++++ 1 file changed, 442 insertions(+) create mode 100644 target/linux/s3c24xx/files-2.6.30/drivers/input/keyboard/gta02kbd.c (limited to 'target/linux/s3c24xx/files-2.6.30/drivers/input/keyboard/gta02kbd.c') diff --git a/target/linux/s3c24xx/files-2.6.30/drivers/input/keyboard/gta02kbd.c b/target/linux/s3c24xx/files-2.6.30/drivers/input/keyboard/gta02kbd.c new file mode 100644 index 0000000000..0814d100ee --- /dev/null +++ b/target/linux/s3c24xx/files-2.6.30/drivers/input/keyboard/gta02kbd.c @@ -0,0 +1,442 @@ +/* + * Keyboard driver for Openmoko Freerunner GSM phone + * + * (C) 2006-2007 by Openmoko, Inc. + * Author: Harald Welte + * All rights reserved. + * + * inspired by corkgbd.c by Richard Purdie + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 as + * published by the Free Software Foundation. + * + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include + +#ifdef CONFIG_PM +extern int global_inside_suspend; +#else +#define global_inside_suspend 0 +#endif + +struct gta02kbd { + struct platform_device *pdev; + struct input_dev *input; + struct device *cdev; + struct work_struct work; + int aux_state; + int work_in_progress; + int hp_irq_count_in_work; + int hp_irq_count; + int jack_irq; +}; + +static struct class *gta02kbd_switch_class; + +enum keys { + GTA02_KEY_AUX, + GTA02_KEY_HOLD, + GTA02_KEY_JACK, +}; + +struct gta02kbd_key { + const char * name; + irqreturn_t (*isr)(int irq, void *dev_id); + int irq; + int input_key; +}; + +static irqreturn_t gta02kbd_aux_irq(int irq, void *dev_id); +static irqreturn_t gta02kbd_headphone_irq(int irq, void *dev_id); +static irqreturn_t gta02kbd_default_key_irq(int irq, void *dev_id); + + +static struct gta02kbd_key keys[] = { + [GTA02_KEY_AUX] = { + .name = "GTA02 AUX button", + .isr = gta02kbd_aux_irq, + .input_key = KEY_PHONE, + }, + [GTA02_KEY_HOLD] = { + .name = "GTA02 HOLD button", + .isr = gta02kbd_default_key_irq, + .input_key = KEY_PAUSE, + }, + [GTA02_KEY_JACK] = { + .name = "GTA02 Headphone jack", + .isr = gta02kbd_headphone_irq, + }, +}; + +/* This timer section filters AUX button IRQ bouncing */ + +static void aux_key_timer_f(unsigned long data); + +static struct timer_list aux_key_timer = + TIMER_INITIALIZER(aux_key_timer_f, 0, 0); + +#define AUX_TIMER_TIMEOUT (HZ >> 7) +#define AUX_TIMER_ALLOWED_NOOP 2 +#define AUX_TIMER_CONSECUTIVE_EVENTS 5 + +struct gta02kbd *timer_kbd; + +static void aux_key_timer_f(unsigned long data) +{ + static int noop_counter; + static int last_key = -1; + static int last_count; + int key_pressed; + + key_pressed = + gpio_get_value(timer_kbd->pdev->resource[GTA02_KEY_AUX].start); + + if (likely(key_pressed == last_key)) + last_count++; + else { + last_count = 1; + last_key = key_pressed; + } + + if (unlikely(last_count >= AUX_TIMER_CONSECUTIVE_EVENTS)) { + if (timer_kbd->aux_state != last_key) { + input_report_key(timer_kbd->input, KEY_PHONE, last_key); + input_sync(timer_kbd->input); + + timer_kbd->aux_state = last_key; + noop_counter = 0; + } + last_count = 0; + if (unlikely(++noop_counter > AUX_TIMER_ALLOWED_NOOP)) { + noop_counter = 0; + return; + } + } + + mod_timer(&aux_key_timer, jiffies + AUX_TIMER_TIMEOUT); +} + +static irqreturn_t gta02kbd_aux_irq(int irq, void *dev) +{ + mod_timer(&aux_key_timer, jiffies + AUX_TIMER_TIMEOUT); + + return IRQ_HANDLED; +} + +static irqreturn_t gta02kbd_default_key_irq(int irq, void *dev_id) +{ + struct gta02kbd *kbd = dev_id; + int n; + + for (n = 0; n < ARRAY_SIZE(keys); n++) { + + if (irq != keys[n].irq) + continue; + + input_report_key(kbd->input, keys[n].input_key, + gpio_get_value(kbd->pdev->resource[n].start)); + input_sync(kbd->input); + } + + return IRQ_HANDLED; +} + + +static const char *event_array_jack[2][4] = { + [0] = { + "SWITCH_NAME=headset", + "SWITCH_STATE=0", + "EVENT=remove", + NULL + }, + [1] = { + "SWITCH_NAME=headset", + "SWITCH_STATE=1", + "EVENT=insert", + NULL + }, +}; + +static void gta02kbd_jack_event(struct device *dev, int num) +{ + kobject_uevent_env(&dev->kobj, KOBJ_CHANGE, (char **)event_array_jack[!!num]); +} + + +static void gta02kbd_debounce_jack(struct work_struct *work) +{ + struct gta02kbd *kbd = container_of(work, struct gta02kbd, work); + unsigned long flags; + int loop = 0; + int level; + + do { + /* + * we wait out any multiple interrupt + * stuttering in 100ms lumps + */ + do { + kbd->hp_irq_count_in_work = kbd->hp_irq_count; + msleep(100); + } while (kbd->hp_irq_count != kbd->hp_irq_count_in_work); + /* + * no new interrupts on jack for 100ms... + * ok we will report it + */ + level = gpio_get_value(kbd->pdev->resource[GTA02_KEY_JACK].start); + input_report_switch(kbd->input, SW_HEADPHONE_INSERT, level); + input_sync(kbd->input); + gta02kbd_jack_event(kbd->cdev, level); + /* + * we go around the outer loop again if we detect that more + * interrupts came while we are servicing here. But we have + * to sequence it carefully with interrupts off + */ + local_save_flags(flags); + /* no interrupts during this work means we can exit the work */ + loop = !!(kbd->hp_irq_count != kbd->hp_irq_count_in_work); + if (!loop) + kbd->work_in_progress = 0; + local_irq_restore(flags); + /* + * interrupt that comes here will either queue a new work action + * since work_in_progress is cleared now, or be dealt with + * when we loop. + */ + } while (loop); +} + + +static irqreturn_t gta02kbd_headphone_irq(int irq, void *dev_id) +{ + struct gta02kbd *gta02kbd_data = dev_id; + + /* + * this interrupt is prone to bouncing and userspace doesn't like + * to have to deal with that kind of thing. So we do not accept + * that a jack interrupt is equal to a jack event. Instead we fire + * some work on the first interrupt, and it hangs about in 100ms units + * until no more interrupts come. Then it accepts the state it finds + * for jack insert and reports it once + */ + + gta02kbd_data->hp_irq_count++; + /* + * the first interrupt we see for a while, we fire the work item + * and record the interrupt count when we did that. If more interrupts + * come in the meanwhile, we can tell by the difference in that + * stored count and hp_irq_count which increments every interrupt + */ + if (!gta02kbd_data->work_in_progress) { + gta02kbd_data->jack_irq = irq; + gta02kbd_data->hp_irq_count_in_work = + gta02kbd_data->hp_irq_count; + if (!schedule_work(>a02kbd_data->work)) + printk(KERN_ERR + "Unable to schedule headphone debounce\n"); + else + gta02kbd_data->work_in_progress = 1; + } + + return IRQ_HANDLED; +} + +#ifdef CONFIG_PM +static int gta02kbd_suspend(struct platform_device *dev, pm_message_t state) +{ + disable_irq(keys[GTA02_KEY_AUX].irq); + del_timer_sync(&aux_key_timer); + return 0; +} + +static int gta02kbd_resume(struct platform_device *dev) +{ + enable_irq(keys[GTA02_KEY_AUX].irq); + return 0; +} +#else +#define gta02kbd_suspend NULL +#define gta02kbd_resume NULL +#endif + +static ssize_t gta02kbd_switch_name_show(struct device *dev, + struct device_attribute *attr, char *buf) +{ + return sprintf(buf, "%s\n", "gta02 Headset Jack"); +} + +static ssize_t gta02kbd_switch_state_show(struct device *dev, + struct device_attribute *attr, char *buf) +{ + struct gta02kbd *kbd = dev_get_drvdata(dev); + return sprintf(buf, "%d\n", + gpio_get_value(kbd->pdev->resource[GTA02_KEY_JACK].start)); +} + +static DEVICE_ATTR(name, S_IRUGO , gta02kbd_switch_name_show, NULL); +static DEVICE_ATTR(state, S_IRUGO , gta02kbd_switch_state_show, NULL); + +static int gta02kbd_probe(struct platform_device *pdev) +{ + struct gta02kbd *gta02kbd; + struct input_dev *input_dev; + int rc; + int irq; + int n; + + gta02kbd = kzalloc(sizeof(struct gta02kbd), GFP_KERNEL); + input_dev = input_allocate_device(); + if (!gta02kbd || !input_dev) { + kfree(gta02kbd); + input_free_device(input_dev); + return -ENOMEM; + } + + gta02kbd->pdev = pdev; + timer_kbd = gta02kbd; + + if (pdev->resource[0].flags != 0) + return -EINVAL; + + platform_set_drvdata(pdev, gta02kbd); + + gta02kbd->input = input_dev; + + INIT_WORK(>a02kbd->work, gta02kbd_debounce_jack); + + input_dev->name = "GTA02 Buttons"; + input_dev->phys = "gta02kbd/input0"; + input_dev->id.bustype = BUS_HOST; + input_dev->id.vendor = 0x0001; + input_dev->id.product = 0x0001; + input_dev->id.version = 0x0100; + input_dev->dev.parent = &pdev->dev; + + input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_SW); + set_bit(SW_HEADPHONE_INSERT, input_dev->swbit); + set_bit(KEY_PHONE, input_dev->keybit); + set_bit(KEY_PAUSE, input_dev->keybit); + + rc = input_register_device(gta02kbd->input); + if (rc) + goto out_register; + + gta02kbd->cdev = device_create(gta02kbd_switch_class, + &pdev->dev, 0, gta02kbd, "headset"); + if (unlikely(IS_ERR(gta02kbd->cdev))) { + rc = PTR_ERR(gta02kbd->cdev); + goto out_device_create; + } + + rc = device_create_file(gta02kbd->cdev, &dev_attr_name); + if(rc) + goto out_device_create_file; + + rc = device_create_file(gta02kbd->cdev, &dev_attr_state); + if(rc) + goto out_device_create_file; + + /* register GPIO IRQs */ + for(n = 0; n < min(pdev->num_resources, ARRAY_SIZE(keys)); n++) { + + if (!pdev->resource[0].start) + continue; + + irq = gpio_to_irq(pdev->resource[n].start); + if (irq < 0) + continue; + + if (request_irq(irq, keys[n].isr, IRQF_DISABLED | + IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING, + keys[n].name, gta02kbd)) { + dev_err(&pdev->dev, "Can't get IRQ %u\n", irq); + + /* unwind any irq registrations and fail */ + + while (n > 0) { + n--; + free_irq(gpio_to_irq(pdev->resource[n].start), + gta02kbd); + } + goto out_device_create_file; + } + + keys[n].irq = irq; + } + + enable_irq_wake(keys[GTA02_KEY_JACK].irq); + + return 0; + +out_device_create_file: + device_unregister(gta02kbd->cdev); +out_device_create: + input_unregister_device(gta02kbd->input); +out_register: + input_free_device(gta02kbd->input); + platform_set_drvdata(pdev, NULL); + kfree(gta02kbd); + + return -ENODEV; +} + +static int gta02kbd_remove(struct platform_device *pdev) +{ + struct gta02kbd *gta02kbd = platform_get_drvdata(pdev); + + free_irq(gpio_to_irq(pdev->resource[2].start), gta02kbd); + free_irq(gpio_to_irq(pdev->resource[1].start), gta02kbd); + free_irq(gpio_to_irq(pdev->resource[0].start), gta02kbd); + + device_unregister(gta02kbd->cdev); + input_unregister_device(gta02kbd->input); + input_free_device(gta02kbd->input); + platform_set_drvdata(pdev, NULL); + kfree(gta02kbd); + + return 0; +} + +static struct platform_driver gta02kbd_driver = { + .probe = gta02kbd_probe, + .remove = gta02kbd_remove, + .suspend = gta02kbd_suspend, + .resume = gta02kbd_resume, + .driver = { + .name = "gta02-button", + }, +}; + +static int __devinit gta02kbd_init(void) +{ + gta02kbd_switch_class = class_create(THIS_MODULE, "switch"); + if (IS_ERR(gta02kbd_switch_class)) + return PTR_ERR(gta02kbd_switch_class); + return platform_driver_register(>a02kbd_driver); +} + +static void __exit gta02kbd_exit(void) +{ + platform_driver_unregister(>a02kbd_driver); + class_destroy(gta02kbd_switch_class); +} + +module_init(gta02kbd_init); +module_exit(gta02kbd_exit); + +MODULE_AUTHOR("Harald Welte "); +MODULE_DESCRIPTION("Openmoko Freerunner buttons input driver"); +MODULE_LICENSE("GPL"); -- cgit v1.2.3