[mirror_ubuntu-jammy-kernel.git] / drivers / input / keyboard / gpio_keys.c

/*
 * Driver for keys on GPIO lines capable of generating interrupts.
 *
 * Copyright 2005 Phil Blundell
 *
 * 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/module.h>
#include <linux/version.h>

#include <linux/init.h>
#include <linux/fs.h>
#include <linux/interrupt.h>
#include <linux/irq.h>
#include <linux/sched.h>
#include <linux/pm.h>
#include <linux/sysctl.h>
#include <linux/proc_fs.h>
#include <linux/delay.h>
#include <linux/platform_device.h>
#include <linux/input.h>
#include <linux/irq.h>

#include <asm/gpio.h>
#include <asm/arch/hardware.h>

#include <asm/hardware/gpio_keys.h>

static irqreturn_t gpio_keys_isr(int irq, void *dev_id)
{
	int i;
	struct platform_device *pdev = dev_id;
	struct gpio_keys_platform_data *pdata = pdev->dev.platform_data;
	struct input_dev *input = platform_get_drvdata(pdev);

	for (i = 0; i < pdata->nbuttons; i++) {
		int gpio = pdata->buttons[i].gpio;
		if (irq == gpio_to_irq(gpio)) {
			int state = (gpio_get_value(gpio) ? 1 : 0) ^ (pdata->buttons[i].active_low);

			input_report_key(input, pdata->buttons[i].keycode, state);
			input_sync(input);
		}
	}

	return IRQ_HANDLED;
}

static int __devinit gpio_keys_probe(struct platform_device *pdev)
{
	struct gpio_keys_platform_data *pdata = pdev->dev.platform_data;
	struct input_dev *input;
	int i, error;

	input = input_allocate_device();
	if (!input)
		return -ENOMEM;

	platform_set_drvdata(pdev, input);

	input->evbit[0] = BIT(EV_KEY);

	input->name = pdev->name;
	input->phys = "gpio-keys/input0";
	input->cdev.dev = &pdev->dev;

	input->id.bustype = BUS_HOST;
	input->id.vendor = 0x0001;
	input->id.product = 0x0001;
	input->id.version = 0x0100;

	for (i = 0; i < pdata->nbuttons; i++) {
		int code = pdata->buttons[i].keycode;
		int irq = gpio_to_irq(pdata->buttons[i].gpio);

		set_irq_type(irq, IRQ_TYPE_EDGE_BOTH);
		error = request_irq(irq, gpio_keys_isr, IRQF_SAMPLE_RANDOM,
				     pdata->buttons[i].desc ? pdata->buttons[i].desc : "gpio_keys",
				     pdev);
		if (error) {
			printk(KERN_ERR "gpio-keys: unable to claim irq %d; error %d\n",
				irq, error);
			goto fail;
		}
		set_bit(code, input->keybit);
	}

	error = input_register_device(input);
	if (error) {
		printk(KERN_ERR "Unable to register gpio-keys input device\n");
		goto fail;
	}

	return 0;

 fail:
	for (i = i - 1; i >= 0; i--)
		free_irq(gpio_to_irq(pdata->buttons[i].gpio), pdev);

	input_free_device(input);

	return error;
}

static int __devexit gpio_keys_remove(struct platform_device *pdev)
{
	struct gpio_keys_platform_data *pdata = pdev->dev.platform_data;
	struct input_dev *input = platform_get_drvdata(pdev);
	int i;

	for (i = 0; i < pdata->nbuttons; i++) {
		int irq = gpio_to_irq(pdata->buttons[i].gpio);
		free_irq(irq, pdev);
	}

	input_unregister_device(input);

	return 0;
}

struct platform_driver gpio_keys_device_driver = {
	.probe		= gpio_keys_probe,
	.remove		= __devexit_p(gpio_keys_remove),
	.driver		= {
		.name	= "gpio-keys",
	}
};

static int __init gpio_keys_init(void)
{
	return platform_driver_register(&gpio_keys_device_driver);
}

static void __exit gpio_keys_exit(void)
{
	platform_driver_unregister(&gpio_keys_device_driver);
}

module_init(gpio_keys_init);
module_exit(gpio_keys_exit);

MODULE_LICENSE("GPL");
MODULE_AUTHOR("Phil Blundell <pb@handhelds.org>");
MODULE_DESCRIPTION("Keyboard driver for CPU GPIOs");
Commit	Line	Data
78a56aab PB	1	/*
	2	* Driver for keys on GPIO lines capable of generating interrupts.
	3	*
	4	* Copyright 2005 Phil Blundell
	5	*
	6	* This program is free software; you can redistribute it and/or modify
	7	* it under the terms of the GNU General Public License version 2 as
	8	* published by the Free Software Foundation.
	9	*/
	10
	11	#include <linux/module.h>
	12	#include <linux/version.h>
	13
	14	#include <linux/init.h>
	15	#include <linux/fs.h>
	16	#include <linux/interrupt.h>
	17	#include <linux/irq.h>
	18	#include <linux/sched.h>
	19	#include <linux/pm.h>
	20	#include <linux/sysctl.h>
	21	#include <linux/proc_fs.h>
	22	#include <linux/delay.h>
	23	#include <linux/platform_device.h>
	24	#include <linux/input.h>
	25	#include <linux/irq.h>
	26
0d98f6bb	27	#include <asm/gpio.h>
78a56aab PB	28	#include <asm/arch/hardware.h>
	29
	30	#include <asm/hardware/gpio_keys.h>
	31
	32	static irqreturn_t gpio_keys_isr(int irq, void *dev_id)
	33	{
	34	int i;
	35	struct platform_device *pdev = dev_id;
	36	struct gpio_keys_platform_data *pdata = pdev->dev.platform_data;
	37	struct input_dev *input = platform_get_drvdata(pdev);
	38
	39	for (i = 0; i < pdata->nbuttons; i++) {
	40	int gpio = pdata->buttons[i].gpio;
0d98f6bb PZ	41	if (irq == gpio_to_irq(gpio)) {
0d98f6bb PZ	42	int state = (gpio_get_value(gpio) ? 1 : 0) ^ (pdata->buttons[i].active_low);
78a56aab PB	43
	44	input_report_key(input, pdata->buttons[i].keycode, state);
	45	input_sync(input);
	46	}
	47	}
	48
	49	return IRQ_HANDLED;
	50	}
	51
	52	static int __devinit gpio_keys_probe(struct platform_device *pdev)
	53	{
	54	struct gpio_keys_platform_data *pdata = pdev->dev.platform_data;
	55	struct input_dev *input;
	56	int i, error;
	57
	58	input = input_allocate_device();
	59	if (!input)
	60	return -ENOMEM;
	61
	62	platform_set_drvdata(pdev, input);
	63
	64	input->evbit[0] = BIT(EV_KEY);
	65
	66	input->name = pdev->name;
	67	input->phys = "gpio-keys/input0";
	68	input->cdev.dev = &pdev->dev;
78a56aab PB	69
	70	input->id.bustype = BUS_HOST;
	71	input->id.vendor = 0x0001;
	72	input->id.product = 0x0001;
	73	input->id.version = 0x0100;
	74
	75	for (i = 0; i < pdata->nbuttons; i++) {
	76	int code = pdata->buttons[i].keycode;
0d98f6bb	77	int irq = gpio_to_irq(pdata->buttons[i].gpio);
78a56aab PB	78
78a56aab PB	79	set_irq_type(irq, IRQ_TYPE_EDGE_BOTH);
2db6346f	80	error = request_irq(irq, gpio_keys_isr, IRQF_SAMPLE_RANDOM,
78a56aab PB	81	pdata->buttons[i].desc ? pdata->buttons[i].desc : "gpio_keys",
	82	pdev);
	83	if (error) {
0d98f6bb PZ	84	printk(KERN_ERR "gpio-keys: unable to claim irq %d; error %d\n",
0d98f6bb PZ	85	irq, error);
78a56aab PB	86	goto fail;
	87	}
	88	set_bit(code, input->keybit);
	89	}
	90
	91	error = input_register_device(input);
	92	if (error) {
	93	printk(KERN_ERR "Unable to register gpio-keys input device\n");
	94	goto fail;
	95	}
	96
	97	return 0;
	98
	99	fail:
	100	for (i = i - 1; i >= 0; i--)
0d98f6bb	101	free_irq(gpio_to_irq(pdata->buttons[i].gpio), pdev);
78a56aab PB	102
	103	input_free_device(input);
	104
	105	return error;
	106	}
	107
	108	static int __devexit gpio_keys_remove(struct platform_device *pdev)
	109	{
	110	struct gpio_keys_platform_data *pdata = pdev->dev.platform_data;
	111	struct input_dev *input = platform_get_drvdata(pdev);
	112	int i;
	113
	114	for (i = 0; i < pdata->nbuttons; i++) {
0d98f6bb	115	int irq = gpio_to_irq(pdata->buttons[i].gpio);
78a56aab PB	116	free_irq(irq, pdev);
	117	}
	118
	119	input_unregister_device(input);
	120
	121	return 0;
	122	}
	123
	124	struct platform_driver gpio_keys_device_driver = {
	125	.probe = gpio_keys_probe,
	126	.remove = __devexit_p(gpio_keys_remove),
	127	.driver = {
	128	.name = "gpio-keys",
	129	}
	130	};
	131
	132	static int __init gpio_keys_init(void)
	133	{
	134	return platform_driver_register(&gpio_keys_device_driver);
	135	}
	136
	137	static void __exit gpio_keys_exit(void)
	138	{
	139	platform_driver_unregister(&gpio_keys_device_driver);
	140	}
	141
	142	module_init(gpio_keys_init);
	143	module_exit(gpio_keys_exit);
	144
	145	MODULE_LICENSE("GPL");
	146	MODULE_AUTHOR("Phil Blundell <pb@handhelds.org>");
	147	MODULE_DESCRIPTION("Keyboard driver for CPU GPIOs");