[linux-2.6-block.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/module.h>
#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 <linux/platform_data/keypad-ep93xx.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_SLEEP
static int ep93xx_keypad_suspend(struct device *dev)
{
	struct platform_device *pdev = to_platform_device(dev);
	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 device *dev)
{
	struct platform_device *pdev = to_platform_device(dev);
	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;
}
#endif

static SIMPLE_DEV_PM_OPS(ep93xx_keypad_pm_ops,
			 ep93xx_keypad_suspend, ep93xx_keypad_resume);

static int 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;

	err = matrix_keypad_build_keymap(keymap_data, NULL,
					 EP93XX_MATRIX_ROWS, EP93XX_MATRIX_COLS,
					 keypad->keycodes, input_dev);
	if (err)
		goto failed_free_dev;

	if (keypad->pdata->flags & EP93XX_KEYPAD_AUTOREPEAT)
		__set_bit(EV_REP, input_dev->evbit);
	input_set_drvdata(input_dev, keypad);

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

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

	platform_set_drvdata(pdev, keypad);
	device_init_wakeup(&pdev->dev, 1);

	return 0;

failed_free_irq:
	free_irq(keypad->irq, keypad);
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 ep93xx_keypad_remove(struct platform_device *pdev)
{
	struct ep93xx_keypad *keypad = platform_get_drvdata(pdev);
	struct resource *res;

	free_irq(keypad->irq, keypad);

	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,
		.pm	= &ep93xx_keypad_pm_ops,
	},
	.probe		= ep93xx_keypad_probe,
	.remove		= ep93xx_keypad_remove,
};
module_platform_driver(ep93xx_keypad_driver);

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
b9cc510b	23	#include <linux/module.h>
e06003af HS	24	#include <linux/platform_device.h>
e06003af HS	25	#include <linux/interrupt.h>
e06003af	26	#include <linux/clk.h>
60214f05 HS	27	#include <linux/io.h>
60214f05 HS	28	#include <linux/input/matrix_keypad.h>
5a0e3ad6	29	#include <linux/slab.h>
e06003af HS	30
e06003af HS	31	#include <mach/hardware.h>
a3b29245	32	#include <linux/platform_data/keypad-ep93xx.h>
e06003af HS	33
	34	/*
	35	* Keypad Interface Register offsets
	36	*/
	37	#define KEY_INIT 0x00 /* Key Scan Initialization register */
	38	#define KEY_DIAG 0x04 /* Key Scan Diagnostic register */
	39	#define KEY_REG 0x08 /* Key Value Capture register */
	40
	41	/* Key Scan Initialization Register bit defines */
	42	#define KEY_INIT_DBNC_MASK (0x00ff0000)
	43	#define KEY_INIT_DBNC_SHIFT (16)
	44	#define KEY_INIT_DIS3KY (1<<15)
	45	#define KEY_INIT_DIAG (1<<14)
	46	#define KEY_INIT_BACK (1<<13)
	47	#define KEY_INIT_T2 (1<<12)
	48	#define KEY_INIT_PRSCL_MASK (0x000003ff)
	49	#define KEY_INIT_PRSCL_SHIFT (0)
	50
	51	/* Key Scan Diagnostic Register bit defines */
	52	#define KEY_DIAG_MASK (0x0000003f)
	53	#define KEY_DIAG_SHIFT (0)
	54
	55	/* Key Value Capture Register bit defines */
	56	#define KEY_REG_K (1<<15)
	57	#define KEY_REG_INT (1<<14)
	58	#define KEY_REG_2KEYS (1<<13)
	59	#define KEY_REG_1KEY (1<<12)
	60	#define KEY_REG_KEY2_MASK (0x00000fc0)
	61	#define KEY_REG_KEY2_SHIFT (6)
	62	#define KEY_REG_KEY1_MASK (0x0000003f)
	63	#define KEY_REG_KEY1_SHIFT (0)
	64
60214f05	65	#define EP93XX_MATRIX_SIZE (EP93XX_MATRIX_ROWS * EP93XX_MATRIX_COLS)
e06003af HS	66
	67	struct ep93xx_keypad {
	68	struct ep93xx_keypad_platform_data *pdata;
e06003af	69	struct input_dev *input_dev;
60214f05 HS	70	struct clk *clk;
60214f05 HS	71
e06003af HS	72	void __iomem *mmio_base;
e06003af HS	73
a5abd95c	74	unsigned short keycodes[EP93XX_MATRIX_SIZE];
e06003af HS	75
	76	int key1;
	77	int key2;
	78
60214f05 HS	79	int irq;
	80
	81	bool enabled;
e06003af HS	82	};
e06003af HS	83
e06003af HS	84	static irqreturn_t ep93xx_keypad_irq_handler(int irq, void *dev_id)
	85	{
	86	struct ep93xx_keypad *keypad = dev_id;
	87	struct input_dev *input_dev = keypad->input_dev;
60214f05	88	unsigned int status;
e06003af HS	89	int keycode, key1, key2;
e06003af HS	90
60214f05 HS	91	status = __raw_readl(keypad->mmio_base + KEY_REG);
60214f05 HS	92
e06003af	93	keycode = (status & KEY_REG_KEY1_MASK) >> KEY_REG_KEY1_SHIFT;
a5abd95c	94	key1 = keypad->keycodes[keycode];
e06003af HS	95
e06003af HS	96	keycode = (status & KEY_REG_KEY2_MASK) >> KEY_REG_KEY2_SHIFT;
a5abd95c	97	key2 = keypad->keycodes[keycode];
e06003af HS	98
	99	if (status & KEY_REG_2KEYS) {
	100	if (keypad->key1 && key1 != keypad->key1 && key2 != keypad->key1)
	101	input_report_key(input_dev, keypad->key1, 0);
	102
	103	if (keypad->key2 && key1 != keypad->key2 && key2 != keypad->key2)
	104	input_report_key(input_dev, keypad->key2, 0);
	105
	106	input_report_key(input_dev, key1, 1);
	107	input_report_key(input_dev, key2, 1);
	108
	109	keypad->key1 = key1;
	110	keypad->key2 = key2;
	111
	112	} else if (status & KEY_REG_1KEY) {
	113	if (keypad->key1 && key1 != keypad->key1)
	114	input_report_key(input_dev, keypad->key1, 0);
	115
	116	if (keypad->key2 && key1 != keypad->key2)
	117	input_report_key(input_dev, keypad->key2, 0);
	118
	119	input_report_key(input_dev, key1, 1);
	120
	121	keypad->key1 = key1;
	122	keypad->key2 = 0;
	123
	124	} else {
	125	input_report_key(input_dev, keypad->key1, 0);
	126	input_report_key(input_dev, keypad->key2, 0);
	127
	128	keypad->key1 = keypad->key2 = 0;
	129	}
	130	input_sync(input_dev);
	131
	132	return IRQ_HANDLED;
	133	}
	134
	135	static void ep93xx_keypad_config(struct ep93xx_keypad *keypad)
	136	{
	137	struct ep93xx_keypad_platform_data *pdata = keypad->pdata;
	138	unsigned int val = 0;
	139
60214f05 HS	140	if (pdata->flags & EP93XX_KEYPAD_KDIV)
	141	clk_set_rate(keypad->clk, EP93XX_KEYTCHCLK_DIV4);
	142	else
	143	clk_set_rate(keypad->clk, EP93XX_KEYTCHCLK_DIV16);
e06003af HS	144
	145	if (pdata->flags & EP93XX_KEYPAD_DISABLE_3_KEY)
	146	val \|= KEY_INIT_DIS3KY;
	147	if (pdata->flags & EP93XX_KEYPAD_DIAG_MODE)
	148	val \|= KEY_INIT_DIAG;
	149	if (pdata->flags & EP93XX_KEYPAD_BACK_DRIVE)
	150	val \|= KEY_INIT_BACK;
	151	if (pdata->flags & EP93XX_KEYPAD_TEST_MODE)
	152	val \|= KEY_INIT_T2;
	153
	154	val \|= ((pdata->debounce << KEY_INIT_DBNC_SHIFT) & KEY_INIT_DBNC_MASK);
	155
	156	val \|= ((pdata->prescale << KEY_INIT_PRSCL_SHIFT) & KEY_INIT_PRSCL_MASK);
	157
60214f05	158	__raw_writel(val, keypad->mmio_base + KEY_INIT);
e06003af HS	159	}
	160
	161	static int ep93xx_keypad_open(struct input_dev *pdev)
	162	{
	163	struct ep93xx_keypad *keypad = input_get_drvdata(pdev);
	164
	165	if (!keypad->enabled) {
	166	ep93xx_keypad_config(keypad);
	167	clk_enable(keypad->clk);
60214f05	168	keypad->enabled = true;
e06003af HS	169	}
	170
	171	return 0;
	172	}
	173
	174	static void ep93xx_keypad_close(struct input_dev *pdev)
	175	{
	176	struct ep93xx_keypad *keypad = input_get_drvdata(pdev);
	177
	178	if (keypad->enabled) {
	179	clk_disable(keypad->clk);
60214f05	180	keypad->enabled = false;
e06003af HS	181	}
	182	}
	183
	184
b5e9528b DT	185	#ifdef CONFIG_PM_SLEEP
b5e9528b DT	186	static int ep93xx_keypad_suspend(struct device *dev)
e06003af	187	{
b5e9528b	188	struct platform_device *pdev = to_platform_device(dev);
e06003af HS	189	struct ep93xx_keypad *keypad = platform_get_drvdata(pdev);
	190	struct input_dev *input_dev = keypad->input_dev;
	191
	192	mutex_lock(&input_dev->mutex);
	193
	194	if (keypad->enabled) {
	195	clk_disable(keypad->clk);
60214f05	196	keypad->enabled = false;
e06003af HS	197	}
	198
	199	mutex_unlock(&input_dev->mutex);
	200
	201	if (device_may_wakeup(&pdev->dev))
	202	enable_irq_wake(keypad->irq);
	203
	204	return 0;
	205	}
	206
b5e9528b	207	static int ep93xx_keypad_resume(struct device *dev)
e06003af	208	{
b5e9528b	209	struct platform_device *pdev = to_platform_device(dev);
e06003af HS	210	struct ep93xx_keypad *keypad = platform_get_drvdata(pdev);
	211	struct input_dev *input_dev = keypad->input_dev;
	212
	213	if (device_may_wakeup(&pdev->dev))
	214	disable_irq_wake(keypad->irq);
	215
	216	mutex_lock(&input_dev->mutex);
	217
	218	if (input_dev->users) {
	219	if (!keypad->enabled) {
	220	ep93xx_keypad_config(keypad);
	221	clk_enable(keypad->clk);
60214f05	222	keypad->enabled = true;
e06003af HS	223	}
	224	}
	225
	226	mutex_unlock(&input_dev->mutex);
	227
	228	return 0;
	229	}
b5e9528b DT	230	#endif
	231
	232	static SIMPLE_DEV_PM_OPS(ep93xx_keypad_pm_ops,
	233	ep93xx_keypad_suspend, ep93xx_keypad_resume);
e06003af	234
5298cc4c	235	static int ep93xx_keypad_probe(struct platform_device *pdev)
e06003af HS	236	{
e06003af HS	237	struct ep93xx_keypad *keypad;
a5abd95c	238	const struct matrix_keymap_data *keymap_data;
e06003af HS	239	struct input_dev *input_dev;
e06003af HS	240	struct resource *res;
60214f05	241	int err;
e06003af HS	242
e06003af HS	243	keypad = kzalloc(sizeof(struct ep93xx_keypad), GFP_KERNEL);
60214f05	244	if (!keypad)
e06003af	245	return -ENOMEM;
e06003af	246
60214f05 HS	247	keypad->pdata = pdev->dev.platform_data;
	248	if (!keypad->pdata) {
	249	err = -EINVAL;
	250	goto failed_free;
	251	}
e06003af	252
a5abd95c HS	253	keymap_data = keypad->pdata->keymap_data;
	254	if (!keymap_data) {
	255	err = -EINVAL;
	256	goto failed_free;
	257	}
	258
60214f05 HS	259	keypad->irq = platform_get_irq(pdev, 0);
60214f05 HS	260	if (!keypad->irq) {
e06003af HS	261	err = -ENXIO;
	262	goto failed_free;
	263	}
	264
	265	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	266	if (!res) {
e06003af HS	267	err = -ENXIO;
	268	goto failed_free;
	269	}
	270
	271	res = request_mem_region(res->start, resource_size(res), pdev->name);
	272	if (!res) {
e06003af HS	273	err = -EBUSY;
	274	goto failed_free;
	275	}
	276
	277	keypad->mmio_base = ioremap(res->start, resource_size(res));
	278	if (keypad->mmio_base == NULL) {
e06003af HS	279	err = -ENXIO;
	280	goto failed_free_mem;
	281	}
	282
60214f05 HS	283	err = ep93xx_keypad_acquire_gpio(pdev);
	284	if (err)
	285	goto failed_free_io;
e06003af	286
60214f05	287	keypad->clk = clk_get(&pdev->dev, NULL);
e06003af	288	if (IS_ERR(keypad->clk)) {
e06003af	289	err = PTR_ERR(keypad->clk);
60214f05	290	goto failed_free_gpio;
e06003af HS	291	}
e06003af HS	292
e06003af HS	293	input_dev = input_allocate_device();
e06003af HS	294	if (!input_dev) {
e06003af HS	295	err = -ENOMEM;
	296	goto failed_put_clk;
	297	}
	298
	299	keypad->input_dev = input_dev;
	300
	301	input_dev->name = pdev->name;
	302	input_dev->id.bustype = BUS_HOST;
	303	input_dev->open = ep93xx_keypad_open;
	304	input_dev->close = ep93xx_keypad_close;
	305	input_dev->dev.parent = &pdev->dev;
e06003af	306
1932811f DT	307	err = matrix_keypad_build_keymap(keymap_data, NULL,
	308	EP93XX_MATRIX_ROWS, EP93XX_MATRIX_COLS,
	309	keypad->keycodes, input_dev);
	310	if (err)
	311	goto failed_free_dev;
e06003af	312
e06003af	313	if (keypad->pdata->flags & EP93XX_KEYPAD_AUTOREPEAT)
1932811f DT	314	__set_bit(EV_REP, input_dev->evbit);
1932811f DT	315	input_set_drvdata(input_dev, keypad);
e06003af	316
60214f05	317	err = request_irq(keypad->irq, ep93xx_keypad_irq_handler,
ec4665c4	318	0, pdev->name, keypad);
60214f05	319	if (err)
e06003af	320	goto failed_free_dev;
e06003af	321
e06003af	322	err = input_register_device(input_dev);
60214f05	323	if (err)
e06003af	324	goto failed_free_irq;
e06003af	325
1932811f	326	platform_set_drvdata(pdev, keypad);
e06003af HS	327	device_init_wakeup(&pdev->dev, 1);
	328
	329	return 0;
	330
	331	failed_free_irq:
d7ecfff1	332	free_irq(keypad->irq, keypad);
e06003af HS	333	failed_free_dev:
	334	input_free_device(input_dev);
	335	failed_put_clk:
	336	clk_put(keypad->clk);
60214f05 HS	337	failed_free_gpio:
60214f05 HS	338	ep93xx_keypad_release_gpio(pdev);
e06003af	339	failed_free_io:
e06003af HS	340	iounmap(keypad->mmio_base);
	341	failed_free_mem:
	342	release_mem_region(res->start, resource_size(res));
	343	failed_free:
	344	kfree(keypad);
	345	return err;
	346	}
	347
e2619cf7	348	static int ep93xx_keypad_remove(struct platform_device *pdev)
e06003af HS	349	{
	350	struct ep93xx_keypad *keypad = platform_get_drvdata(pdev);
	351	struct resource *res;
e06003af	352
d7ecfff1	353	free_irq(keypad->irq, keypad);
e06003af	354
e06003af HS	355	if (keypad->enabled)
	356	clk_disable(keypad->clk);
	357	clk_put(keypad->clk);
	358
	359	input_unregister_device(keypad->input_dev);
	360
60214f05	361	ep93xx_keypad_release_gpio(pdev);
e06003af HS	362
	363	iounmap(keypad->mmio_base);
	364
	365	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	366	release_mem_region(res->start, resource_size(res));
	367
	368	kfree(keypad);
	369
	370	return 0;
	371	}
	372
	373	static struct platform_driver ep93xx_keypad_driver = {
	374	.driver = {
	375	.name = "ep93xx-keypad",
	376	.owner = THIS_MODULE,
b5e9528b	377	.pm = &ep93xx_keypad_pm_ops,
e06003af HS	378	},
e06003af HS	379	.probe = ep93xx_keypad_probe,
1cb0aa88	380	.remove = ep93xx_keypad_remove,
e06003af	381	};
5146c84f	382	module_platform_driver(ep93xx_keypad_driver);
e06003af HS	383
	384	MODULE_LICENSE("GPL");
	385	MODULE_AUTHOR("H Hartley Sweeten <hsweeten@visionengravers.com>");
	386	MODULE_DESCRIPTION("EP93xx Matrix Keypad Controller");
	387	MODULE_ALIAS("platform:ep93xx-keypad");