openwrtv4/target/linux/s3c24xx/files-2.6.30/drivers/input/keyboard/gta02kbd.c

/*
 * Keyboard driver for Openmoko Freerunner GSM phone
 *
 * (C) 2006-2007 by Openmoko, Inc.
 * Author: Harald Welte <laforge@openmoko.org>
 * 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 <linux/delay.h>
#include <linux/platform_device.h>
#include <linux/init.h>
#include <linux/input.h>
#include <linux/interrupt.h>
#include <linux/jiffies.h>
#include <linux/module.h>
#include <linux/slab.h>
#include <linux/workqueue.h>

#include <mach/gpio.h>
#include <asm/mach-types.h>

#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(&gta02kbd_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(&gta02kbd->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(&gta02kbd_driver);
}

static void __exit gta02kbd_exit(void)
{
	platform_driver_unregister(&gta02kbd_driver);
	class_destroy(gta02kbd_switch_class);
}

module_init(gta02kbd_init);
module_exit(gta02kbd_exit);

MODULE_AUTHOR("Harald Welte <laforge@openmoko.org>");
MODULE_DESCRIPTION("Openmoko Freerunner buttons input driver");
MODULE_LICENSE("GPL");