[net-next-2.6.git] / drivers / input / keyboard / ep93xx_keypad.c

/*
 * Driver for the Cirrus EP93xx matrix keypad controller.
 *
 * Copyright (c) 2008 H Hartley Sweeten <hsweeten@visionengravers.com>
 *
 * Based on the pxa27x matrix keypad controller by Rodolfo Giometti.
 *
 * 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.
 *
 * NOTE:
 *
 * The 3-key reset is triggered by pressing the 3 keys in
 * Row 0, Columns 2, 4, and 7 at the same time.  This action can
 * be disabled by setting the EP93XX_KEYPAD_DISABLE_3_KEY flag.
 *
 * Normal operation for the matrix does not autorepeat the key press.
 * This action can be enabled by setting the EP93XX_KEYPAD_AUTOREPEAT
 * flag.
 */

#include <linux/platform_device.h>
#include <linux/interrupt.h>
#include <linux/clk.h>
#include <linux/io.h>
#include <linux/input/matrix_keypad.h>
#include <linux/slab.h>

#include <mach/hardware.h>
#include <mach/ep93xx_keypad.h>

/*
 * Keypad Interface Register offsets
 */
#define KEY_INIT		0x00	/* Key Scan Initialization register */
#define KEY_DIAG		0x04	/* Key Scan Diagnostic register */
#define KEY_REG			0x08	/* Key Value Capture register */

/* Key Scan Initialization Register bit defines */
#define KEY_INIT_DBNC_MASK	(0x00ff0000)
#define KEY_INIT_DBNC_SHIFT	(16)
#define KEY_INIT_DIS3KY		(1<<15)
#define KEY_INIT_DIAG		(1<<14)
#define KEY_INIT_BACK		(1<<13)
#define KEY_INIT_T2		(1<<12)
#define KEY_INIT_PRSCL_MASK	(0x000003ff)
#define KEY_INIT_PRSCL_SHIFT	(0)

/* Key Scan Diagnostic Register bit defines */
#define KEY_DIAG_MASK		(0x0000003f)
#define KEY_DIAG_SHIFT		(0)

/* Key Value Capture Register bit defines */
#define KEY_REG_K		(1<<15)
#define KEY_REG_INT		(1<<14)
#define KEY_REG_2KEYS		(1<<13)
#define KEY_REG_1KEY		(1<<12)
#define KEY_REG_KEY2_MASK	(0x00000fc0)
#define KEY_REG_KEY2_SHIFT	(6)
#define KEY_REG_KEY1_MASK	(0x0000003f)
#define KEY_REG_KEY1_SHIFT	(0)

#define EP93XX_MATRIX_SIZE	(EP93XX_MATRIX_ROWS * EP93XX_MATRIX_COLS)

struct ep93xx_keypad {
	struct ep93xx_keypad_platform_data *pdata;
	struct input_dev *input_dev;
	struct clk *clk;

	void __iomem *mmio_base;

	unsigned short keycodes[EP93XX_MATRIX_SIZE];

	int key1;
	int key2;

	int irq;

	bool enabled;
};

static irqreturn_t ep93xx_keypad_irq_handler(int irq, void *dev_id)
{
	struct ep93xx_keypad *keypad = dev_id;
	struct input_dev *input_dev = keypad->input_dev;
	unsigned int status;
	int keycode, key1, key2;

	status = __raw_readl(keypad->mmio_base + KEY_REG);

	keycode = (status & KEY_REG_KEY1_MASK) >> KEY_REG_KEY1_SHIFT;
	key1 = keypad->keycodes[keycode];

	keycode = (status & KEY_REG_KEY2_MASK) >> KEY_REG_KEY2_SHIFT;
	key2 = keypad->keycodes[keycode];

	if (status & KEY_REG_2KEYS) {
		if (keypad->key1 && key1 != keypad->key1 && key2 != keypad->key1)
			input_report_key(input_dev, keypad->key1, 0);

		if (keypad->key2 && key1 != keypad->key2 && key2 != keypad->key2)
			input_report_key(input_dev, keypad->key2, 0);

		input_report_key(input_dev, key1, 1);
		input_report_key(input_dev, key2, 1);

		keypad->key1 = key1;
		keypad->key2 = key2;

	} else if (status & KEY_REG_1KEY) {
		if (keypad->key1 && key1 != keypad->key1)
			input_report_key(input_dev, keypad->key1, 0);

		if (keypad->key2 && key1 != keypad->key2)
			input_report_key(input_dev, keypad->key2, 0);

		input_report_key(input_dev, key1, 1);

		keypad->key1 = key1;
		keypad->key2 = 0;

	} else {
		input_report_key(input_dev, keypad->key1, 0);
		input_report_key(input_dev, keypad->key2, 0);

		keypad->key1 = keypad->key2 = 0;
	}
	input_sync(input_dev);

	return IRQ_HANDLED;
}

static void ep93xx_keypad_config(struct ep93xx_keypad *keypad)
{
	struct ep93xx_keypad_platform_data *pdata = keypad->pdata;
	unsigned int val = 0;

	if (pdata->flags & EP93XX_KEYPAD_KDIV)
		clk_set_rate(keypad->clk, EP93XX_KEYTCHCLK_DIV4);
	else
		clk_set_rate(keypad->clk, EP93XX_KEYTCHCLK_DIV16);

	if (pdata->flags & EP93XX_KEYPAD_DISABLE_3_KEY)
		val |= KEY_INIT_DIS3KY;
	if (pdata->flags & EP93XX_KEYPAD_DIAG_MODE)
		val |= KEY_INIT_DIAG;
	if (pdata->flags & EP93XX_KEYPAD_BACK_DRIVE)
		val |= KEY_INIT_BACK;
	if (pdata->flags & EP93XX_KEYPAD_TEST_MODE)
		val |= KEY_INIT_T2;

	val |= ((pdata->debounce << KEY_INIT_DBNC_SHIFT) & KEY_INIT_DBNC_MASK);

	val |= ((pdata->prescale << KEY_INIT_PRSCL_SHIFT) & KEY_INIT_PRSCL_MASK);

	__raw_writel(val, keypad->mmio_base + KEY_INIT);
}

static int ep93xx_keypad_open(struct input_dev *pdev)
{
	struct ep93xx_keypad *keypad = input_get_drvdata(pdev);

	if (!keypad->enabled) {
		ep93xx_keypad_config(keypad);
		clk_enable(keypad->clk);
		keypad->enabled = true;
	}

	return 0;
}

static void ep93xx_keypad_close(struct input_dev *pdev)
{
	struct ep93xx_keypad *keypad = input_get_drvdata(pdev);

	if (keypad->enabled) {
		clk_disable(keypad->clk);
		keypad->enabled = false;
	}
}


#ifdef CONFIG_PM
/*
 * NOTE: I don't know if this is correct, or will work on the ep93xx.
 *
 * None of the existing ep93xx drivers have power management support.
 * But, this is basically what the pxa27x_keypad driver does.
 */
static int ep93xx_keypad_suspend(struct platform_device *pdev,
				 pm_message_t state)
{
	struct ep93xx_keypad *keypad = platform_get_drvdata(pdev);
	struct input_dev *input_dev = keypad->input_dev;

	mutex_lock(&input_dev->mutex);

	if (keypad->enabled) {
		clk_disable(keypad->clk);
		keypad->enabled = false;
	}

	mutex_unlock(&input_dev->mutex);

	if (device_may_wakeup(&pdev->dev))
		enable_irq_wake(keypad->irq);

	return 0;
}

static int ep93xx_keypad_resume(struct platform_device *pdev)
{
	struct ep93xx_keypad *keypad = platform_get_drvdata(pdev);
	struct input_dev *input_dev = keypad->input_dev;

	if (device_may_wakeup(&pdev->dev))
		disable_irq_wake(keypad->irq);

	mutex_lock(&input_dev->mutex);

	if (input_dev->users) {
		if (!keypad->enabled) {
			ep93xx_keypad_config(keypad);
			clk_enable(keypad->clk);
			keypad->enabled = true;
		}
	}

	mutex_unlock(&input_dev->mutex);

	return 0;
}
#else	/* !CONFIG_PM */
#define ep93xx_keypad_suspend	NULL
#define ep93xx_keypad_resume	NULL
#endif	/* !CONFIG_PM */

static int __devinit ep93xx_keypad_probe(struct platform_device *pdev)
{
	struct ep93xx_keypad *keypad;
	const struct matrix_keymap_data *keymap_data;
	struct input_dev *input_dev;
	struct resource *res;
	int err;

	keypad = kzalloc(sizeof(struct ep93xx_keypad), GFP_KERNEL);
	if (!keypad)
		return -ENOMEM;

	keypad->pdata = pdev->dev.platform_data;
	if (!keypad->pdata) {
		err = -EINVAL;
		goto failed_free;
	}

	keymap_data = keypad->pdata->keymap_data;
	if (!keymap_data) {
		err = -EINVAL;
		goto failed_free;
	}

	keypad->irq = platform_get_irq(pdev, 0);
	if (!keypad->irq) {
		err = -ENXIO;
		goto failed_free;
	}

	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	if (!res) {
		err = -ENXIO;
		goto failed_free;
	}

	res = request_mem_region(res->start, resource_size(res), pdev->name);
	if (!res) {
		err = -EBUSY;
		goto failed_free;
	}

	keypad->mmio_base = ioremap(res->start, resource_size(res));
	if (keypad->mmio_base == NULL) {
		err = -ENXIO;
		goto failed_free_mem;
	}

	err = ep93xx_keypad_acquire_gpio(pdev);
	if (err)
		goto failed_free_io;

	keypad->clk = clk_get(&pdev->dev, NULL);
	if (IS_ERR(keypad->clk)) {
		err = PTR_ERR(keypad->clk);
		goto failed_free_gpio;
	}

	input_dev = input_allocate_device();
	if (!input_dev) {
		err = -ENOMEM;
		goto failed_put_clk;
	}

	keypad->input_dev = input_dev;

	input_dev->name = pdev->name;
	input_dev->id.bustype = BUS_HOST;
	input_dev->open = ep93xx_keypad_open;
	input_dev->close = ep93xx_keypad_close;
	input_dev->dev.parent = &pdev->dev;
	input_dev->keycode = keypad->keycodes;
	input_dev->keycodesize = sizeof(keypad->keycodes[0]);
	input_dev->keycodemax = ARRAY_SIZE(keypad->keycodes);

	input_set_drvdata(input_dev, keypad);

	input_dev->evbit[0] = BIT_MASK(EV_KEY);
	if (keypad->pdata->flags & EP93XX_KEYPAD_AUTOREPEAT)
		input_dev->evbit[0] |= BIT_MASK(EV_REP);

	matrix_keypad_build_keymap(keymap_data, 3,
				   input_dev->keycode, input_dev->keybit);
	platform_set_drvdata(pdev, keypad);

	err = request_irq(keypad->irq, ep93xx_keypad_irq_handler,
			  IRQF_DISABLED, pdev->name, keypad);
	if (err)
		goto failed_free_dev;

	err = input_register_device(input_dev);
	if (err)
		goto failed_free_irq;

	device_init_wakeup(&pdev->dev, 1);

	return 0;

failed_free_irq:
	free_irq(keypad->irq, pdev);
	platform_set_drvdata(pdev, NULL);
failed_free_dev:
	input_free_device(input_dev);
failed_put_clk:
	clk_put(keypad->clk);
failed_free_gpio:
	ep93xx_keypad_release_gpio(pdev);
failed_free_io:
	iounmap(keypad->mmio_base);
failed_free_mem:
	release_mem_region(res->start, resource_size(res));
failed_free:
	kfree(keypad);
	return err;
}

static int __devexit ep93xx_keypad_remove(struct platform_device *pdev)
{
	struct ep93xx_keypad *keypad = platform_get_drvdata(pdev);
	struct resource *res;

	free_irq(keypad->irq, pdev);

	platform_set_drvdata(pdev, NULL);

	if (keypad->enabled)
		clk_disable(keypad->clk);
	clk_put(keypad->clk);

	input_unregister_device(keypad->input_dev);

	ep93xx_keypad_release_gpio(pdev);

	iounmap(keypad->mmio_base);

	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	release_mem_region(res->start, resource_size(res));

	kfree(keypad);

	return 0;
}

static struct platform_driver ep93xx_keypad_driver = {
	.driver		= {
		.name	= "ep93xx-keypad",
		.owner	= THIS_MODULE,
	},
	.probe		= ep93xx_keypad_probe,
	.remove		= __devexit_p(ep93xx_keypad_remove),
	.suspend	= ep93xx_keypad_suspend,
	.resume		= ep93xx_keypad_resume,
};

static int __init ep93xx_keypad_init(void)
{
	return platform_driver_register(&ep93xx_keypad_driver);
}

static void __exit ep93xx_keypad_exit(void)
{
	platform_driver_unregister(&ep93xx_keypad_driver);
}

module_init(ep93xx_keypad_init);
module_exit(ep93xx_keypad_exit);

MODULE_LICENSE("GPL");
MODULE_AUTHOR("H Hartley Sweeten <hsweeten@visionengravers.com>");
MODULE_DESCRIPTION("EP93xx Matrix Keypad Controller");
MODULE_ALIAS("platform:ep93xx-keypad");
Commit	Line	Data
e06003af HS	1	/*
	2	* Driver for the Cirrus EP93xx matrix keypad controller.
	3	*
	4	* Copyright (c) 2008 H Hartley Sweeten <hsweeten@visionengravers.com>
	5	*
	6	* Based on the pxa27x matrix keypad controller by Rodolfo Giometti.
	7	*
	8	* This program is free software; you can redistribute it and/or modify
	9	* it under the terms of the GNU General Public License version 2 as
	10	* published by the Free Software Foundation.
	11	*
	12	* NOTE:
	13	*
	14	* The 3-key reset is triggered by pressing the 3 keys in
	15	* Row 0, Columns 2, 4, and 7 at the same time. This action can
	16	* be disabled by setting the EP93XX_KEYPAD_DISABLE_3_KEY flag.
	17	*
	18	* Normal operation for the matrix does not autorepeat the key press.
	19	* This action can be enabled by setting the EP93XX_KEYPAD_AUTOREPEAT
	20	* flag.
	21	*/
	22
	23	#include <linux/platform_device.h>
	24	#include <linux/interrupt.h>
e06003af	25	#include <linux/clk.h>
60214f05 HS	26	#include <linux/io.h>
60214f05 HS	27	#include <linux/input/matrix_keypad.h>
5a0e3ad6	28	#include <linux/slab.h>
e06003af HS	29
e06003af HS	30	#include <mach/hardware.h>
e06003af HS	31	#include <mach/ep93xx_keypad.h>
	32
	33	/*
	34	* Keypad Interface Register offsets
	35	*/
	36	#define KEY_INIT 0x00 /* Key Scan Initialization register */
	37	#define KEY_DIAG 0x04 /* Key Scan Diagnostic register */
	38	#define KEY_REG 0x08 /* Key Value Capture register */
	39
	40	/* Key Scan Initialization Register bit defines */
	41	#define KEY_INIT_DBNC_MASK (0x00ff0000)
	42	#define KEY_INIT_DBNC_SHIFT (16)
	43	#define KEY_INIT_DIS3KY (1<<15)
	44	#define KEY_INIT_DIAG (1<<14)
	45	#define KEY_INIT_BACK (1<<13)
	46	#define KEY_INIT_T2 (1<<12)
	47	#define KEY_INIT_PRSCL_MASK (0x000003ff)
	48	#define KEY_INIT_PRSCL_SHIFT (0)
	49
	50	/* Key Scan Diagnostic Register bit defines */
	51	#define KEY_DIAG_MASK (0x0000003f)
	52	#define KEY_DIAG_SHIFT (0)
	53
	54	/* Key Value Capture Register bit defines */
	55	#define KEY_REG_K (1<<15)
	56	#define KEY_REG_INT (1<<14)
	57	#define KEY_REG_2KEYS (1<<13)
	58	#define KEY_REG_1KEY (1<<12)
	59	#define KEY_REG_KEY2_MASK (0x00000fc0)
	60	#define KEY_REG_KEY2_SHIFT (6)
	61	#define KEY_REG_KEY1_MASK (0x0000003f)
	62	#define KEY_REG_KEY1_SHIFT (0)
	63
60214f05	64	#define EP93XX_MATRIX_SIZE (EP93XX_MATRIX_ROWS * EP93XX_MATRIX_COLS)
e06003af HS	65
	66	struct ep93xx_keypad {
	67	struct ep93xx_keypad_platform_data *pdata;
e06003af	68	struct input_dev *input_dev;
60214f05 HS	69	struct clk *clk;
60214f05 HS	70
e06003af HS	71	void __iomem *mmio_base;
e06003af HS	72
a5abd95c	73	unsigned short keycodes[EP93XX_MATRIX_SIZE];
e06003af HS	74
	75	int key1;
	76	int key2;
	77
60214f05 HS	78	int irq;
	79
	80	bool enabled;
e06003af HS	81	};
e06003af HS	82
e06003af HS	83	static irqreturn_t ep93xx_keypad_irq_handler(int irq, void *dev_id)
	84	{
	85	struct ep93xx_keypad *keypad = dev_id;
	86	struct input_dev *input_dev = keypad->input_dev;
60214f05	87	unsigned int status;
e06003af HS	88	int keycode, key1, key2;
e06003af HS	89
60214f05 HS	90	status = __raw_readl(keypad->mmio_base + KEY_REG);
60214f05 HS	91
e06003af	92	keycode = (status & KEY_REG_KEY1_MASK) >> KEY_REG_KEY1_SHIFT;
a5abd95c	93	key1 = keypad->keycodes[keycode];
e06003af HS	94
e06003af HS	95	keycode = (status & KEY_REG_KEY2_MASK) >> KEY_REG_KEY2_SHIFT;
a5abd95c	96	key2 = keypad->keycodes[keycode];
e06003af HS	97
	98	if (status & KEY_REG_2KEYS) {
	99	if (keypad->key1 && key1 != keypad->key1 && key2 != keypad->key1)
	100	input_report_key(input_dev, keypad->key1, 0);
	101
	102	if (keypad->key2 && key1 != keypad->key2 && key2 != keypad->key2)
	103	input_report_key(input_dev, keypad->key2, 0);
	104
	105	input_report_key(input_dev, key1, 1);
	106	input_report_key(input_dev, key2, 1);
	107
	108	keypad->key1 = key1;
	109	keypad->key2 = key2;
	110
	111	} else if (status & KEY_REG_1KEY) {
	112	if (keypad->key1 && key1 != keypad->key1)
	113	input_report_key(input_dev, keypad->key1, 0);
	114
	115	if (keypad->key2 && key1 != keypad->key2)
	116	input_report_key(input_dev, keypad->key2, 0);
	117
	118	input_report_key(input_dev, key1, 1);
	119
	120	keypad->key1 = key1;
	121	keypad->key2 = 0;
	122
	123	} else {
	124	input_report_key(input_dev, keypad->key1, 0);
	125	input_report_key(input_dev, keypad->key2, 0);
	126
	127	keypad->key1 = keypad->key2 = 0;
	128	}
	129	input_sync(input_dev);
	130
	131	return IRQ_HANDLED;
	132	}
	133
	134	static void ep93xx_keypad_config(struct ep93xx_keypad *keypad)
	135	{
	136	struct ep93xx_keypad_platform_data *pdata = keypad->pdata;
	137	unsigned int val = 0;
	138
60214f05 HS	139	if (pdata->flags & EP93XX_KEYPAD_KDIV)
	140	clk_set_rate(keypad->clk, EP93XX_KEYTCHCLK_DIV4);
	141	else
	142	clk_set_rate(keypad->clk, EP93XX_KEYTCHCLK_DIV16);
e06003af HS	143
	144	if (pdata->flags & EP93XX_KEYPAD_DISABLE_3_KEY)
	145	val \|= KEY_INIT_DIS3KY;
	146	if (pdata->flags & EP93XX_KEYPAD_DIAG_MODE)
	147	val \|= KEY_INIT_DIAG;
	148	if (pdata->flags & EP93XX_KEYPAD_BACK_DRIVE)
	149	val \|= KEY_INIT_BACK;
	150	if (pdata->flags & EP93XX_KEYPAD_TEST_MODE)
	151	val \|= KEY_INIT_T2;
	152
	153	val \|= ((pdata->debounce << KEY_INIT_DBNC_SHIFT) & KEY_INIT_DBNC_MASK);
	154
	155	val \|= ((pdata->prescale << KEY_INIT_PRSCL_SHIFT) & KEY_INIT_PRSCL_MASK);
	156
60214f05	157	__raw_writel(val, keypad->mmio_base + KEY_INIT);
e06003af HS	158	}
	159
	160	static int ep93xx_keypad_open(struct input_dev *pdev)
	161	{
	162	struct ep93xx_keypad *keypad = input_get_drvdata(pdev);
	163
	164	if (!keypad->enabled) {
	165	ep93xx_keypad_config(keypad);
	166	clk_enable(keypad->clk);
60214f05	167	keypad->enabled = true;
e06003af HS	168	}
	169
	170	return 0;
	171	}
	172
	173	static void ep93xx_keypad_close(struct input_dev *pdev)
	174	{
	175	struct ep93xx_keypad *keypad = input_get_drvdata(pdev);
	176
	177	if (keypad->enabled) {
	178	clk_disable(keypad->clk);
60214f05	179	keypad->enabled = false;
e06003af HS	180	}
	181	}
	182
	183
	184	#ifdef CONFIG_PM
	185	/*
	186	* NOTE: I don't know if this is correct, or will work on the ep93xx.
	187	*
	188	* None of the existing ep93xx drivers have power management support.
	189	* But, this is basically what the pxa27x_keypad driver does.
	190	*/
	191	static int ep93xx_keypad_suspend(struct platform_device *pdev,
	192	pm_message_t state)
	193	{
	194	struct ep93xx_keypad *keypad = platform_get_drvdata(pdev);
	195	struct input_dev *input_dev = keypad->input_dev;
	196
	197	mutex_lock(&input_dev->mutex);
	198
	199	if (keypad->enabled) {
	200	clk_disable(keypad->clk);
60214f05	201	keypad->enabled = false;
e06003af HS	202	}
	203
	204	mutex_unlock(&input_dev->mutex);
	205
	206	if (device_may_wakeup(&pdev->dev))
	207	enable_irq_wake(keypad->irq);
	208
	209	return 0;
	210	}
	211
	212	static int ep93xx_keypad_resume(struct platform_device *pdev)
	213	{
	214	struct ep93xx_keypad *keypad = platform_get_drvdata(pdev);
	215	struct input_dev *input_dev = keypad->input_dev;
	216
	217	if (device_may_wakeup(&pdev->dev))
	218	disable_irq_wake(keypad->irq);
	219
	220	mutex_lock(&input_dev->mutex);
	221
	222	if (input_dev->users) {
	223	if (!keypad->enabled) {
	224	ep93xx_keypad_config(keypad);
	225	clk_enable(keypad->clk);
60214f05	226	keypad->enabled = true;
e06003af HS	227	}
	228	}
	229
	230	mutex_unlock(&input_dev->mutex);
	231
	232	return 0;
	233	}
	234	#else /* !CONFIG_PM */
	235	#define ep93xx_keypad_suspend NULL
	236	#define ep93xx_keypad_resume NULL
	237	#endif /* !CONFIG_PM */
	238
	239	static int __devinit ep93xx_keypad_probe(struct platform_device *pdev)
	240	{
	241	struct ep93xx_keypad *keypad;
a5abd95c	242	const struct matrix_keymap_data *keymap_data;
e06003af HS	243	struct input_dev *input_dev;
e06003af HS	244	struct resource *res;
60214f05	245	int err;
e06003af HS	246
e06003af HS	247	keypad = kzalloc(sizeof(struct ep93xx_keypad), GFP_KERNEL);
60214f05	248	if (!keypad)
e06003af	249	return -ENOMEM;
e06003af	250
60214f05 HS	251	keypad->pdata = pdev->dev.platform_data;
	252	if (!keypad->pdata) {
	253	err = -EINVAL;
	254	goto failed_free;
	255	}
e06003af	256
a5abd95c HS	257	keymap_data = keypad->pdata->keymap_data;
	258	if (!keymap_data) {
	259	err = -EINVAL;
	260	goto failed_free;
	261	}
	262
60214f05 HS	263	keypad->irq = platform_get_irq(pdev, 0);
60214f05 HS	264	if (!keypad->irq) {
e06003af HS	265	err = -ENXIO;
	266	goto failed_free;
	267	}
	268
	269	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	270	if (!res) {
e06003af HS	271	err = -ENXIO;
	272	goto failed_free;
	273	}
	274
	275	res = request_mem_region(res->start, resource_size(res), pdev->name);
	276	if (!res) {
e06003af HS	277	err = -EBUSY;
	278	goto failed_free;
	279	}
	280
	281	keypad->mmio_base = ioremap(res->start, resource_size(res));
	282	if (keypad->mmio_base == NULL) {
e06003af HS	283	err = -ENXIO;
	284	goto failed_free_mem;
	285	}
	286
60214f05 HS	287	err = ep93xx_keypad_acquire_gpio(pdev);
	288	if (err)
	289	goto failed_free_io;
e06003af	290
60214f05	291	keypad->clk = clk_get(&pdev->dev, NULL);
e06003af	292	if (IS_ERR(keypad->clk)) {
e06003af	293	err = PTR_ERR(keypad->clk);
60214f05	294	goto failed_free_gpio;
e06003af HS	295	}
e06003af HS	296
e06003af HS	297	input_dev = input_allocate_device();
e06003af HS	298	if (!input_dev) {
e06003af HS	299	err = -ENOMEM;
	300	goto failed_put_clk;
	301	}
	302
	303	keypad->input_dev = input_dev;
	304
	305	input_dev->name = pdev->name;
	306	input_dev->id.bustype = BUS_HOST;
	307	input_dev->open = ep93xx_keypad_open;
	308	input_dev->close = ep93xx_keypad_close;
	309	input_dev->dev.parent = &pdev->dev;
a5abd95c HS	310	input_dev->keycode = keypad->keycodes;
	311	input_dev->keycodesize = sizeof(keypad->keycodes[0]);
	312	input_dev->keycodemax = ARRAY_SIZE(keypad->keycodes);
e06003af HS	313
	314	input_set_drvdata(input_dev, keypad);
	315
	316	input_dev->evbit[0] = BIT_MASK(EV_KEY);
	317	if (keypad->pdata->flags & EP93XX_KEYPAD_AUTOREPEAT)
	318	input_dev->evbit[0] \|= BIT_MASK(EV_REP);
	319
a5abd95c HS	320	matrix_keypad_build_keymap(keymap_data, 3,
a5abd95c HS	321	input_dev->keycode, input_dev->keybit);
e06003af HS	322	platform_set_drvdata(pdev, keypad);
e06003af HS	323
60214f05 HS	324	err = request_irq(keypad->irq, ep93xx_keypad_irq_handler,
	325	IRQF_DISABLED, pdev->name, keypad);
	326	if (err)
e06003af	327	goto failed_free_dev;
e06003af	328
e06003af	329	err = input_register_device(input_dev);
60214f05	330	if (err)
e06003af	331	goto failed_free_irq;
e06003af HS	332
	333	device_init_wakeup(&pdev->dev, 1);
	334
	335	return 0;
	336
	337	failed_free_irq:
60214f05	338	free_irq(keypad->irq, pdev);
e06003af HS	339	platform_set_drvdata(pdev, NULL);
	340	failed_free_dev:
	341	input_free_device(input_dev);
	342	failed_put_clk:
	343	clk_put(keypad->clk);
60214f05 HS	344	failed_free_gpio:
60214f05 HS	345	ep93xx_keypad_release_gpio(pdev);
e06003af	346	failed_free_io:
e06003af HS	347	iounmap(keypad->mmio_base);
	348	failed_free_mem:
	349	release_mem_region(res->start, resource_size(res));
	350	failed_free:
	351	kfree(keypad);
	352	return err;
	353	}
	354
	355	static int __devexit ep93xx_keypad_remove(struct platform_device *pdev)
	356	{
	357	struct ep93xx_keypad *keypad = platform_get_drvdata(pdev);
	358	struct resource *res;
e06003af HS	359
	360	free_irq(keypad->irq, pdev);
	361
	362	platform_set_drvdata(pdev, NULL);
	363
	364	if (keypad->enabled)
	365	clk_disable(keypad->clk);
	366	clk_put(keypad->clk);
	367
	368	input_unregister_device(keypad->input_dev);
	369
60214f05	370	ep93xx_keypad_release_gpio(pdev);
e06003af HS	371
	372	iounmap(keypad->mmio_base);
	373
	374	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	375	release_mem_region(res->start, resource_size(res));
	376
	377	kfree(keypad);
	378
	379	return 0;
	380	}
	381
	382	static struct platform_driver ep93xx_keypad_driver = {
	383	.driver = {
	384	.name = "ep93xx-keypad",
	385	.owner = THIS_MODULE,
	386	},
	387	.probe = ep93xx_keypad_probe,
	388	.remove = __devexit_p(ep93xx_keypad_remove),
	389	.suspend = ep93xx_keypad_suspend,
	390	.resume = ep93xx_keypad_resume,
	391	};
	392
	393	static int __init ep93xx_keypad_init(void)
	394	{
	395	return platform_driver_register(&ep93xx_keypad_driver);
	396	}
	397
	398	static void __exit ep93xx_keypad_exit(void)
	399	{
	400	platform_driver_unregister(&ep93xx_keypad_driver);
	401	}
	402
	403	module_init(ep93xx_keypad_init);
	404	module_exit(ep93xx_keypad_exit);
	405
	406	MODULE_LICENSE("GPL");
	407	MODULE_AUTHOR("H Hartley Sweeten <hsweeten@visionengravers.com>");
	408	MODULE_DESCRIPTION("EP93xx Matrix Keypad Controller");
	409	MODULE_ALIAS("platform:ep93xx-keypad");