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

/*
 * linux/drivers/input/keyboard/pxa27x_keypad.c
 *
 * Driver for the pxa27x matrix keyboard controller.
 *
 * Created:	Feb 22, 2007
 * Author:	Rodolfo Giometti <giometti@linux.it>
 *
 * Based on a previous implementations by Kevin O'Connor
 * <kevin_at_koconnor.net> and Alex Osborne <bobofdoom@gmail.com> and
 * on some suggestions by Nicolas Pitre <nico@fluxnic.net>.
 *
 * 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/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/interrupt.h>
#include <linux/input.h>
#include <linux/device.h>
#include <linux/platform_device.h>
#include <linux/clk.h>
#include <linux/err.h>
#include <linux/input/matrix_keypad.h>
#include <linux/slab.h>

#include <asm/mach/arch.h>
#include <asm/mach/map.h>

#include <mach/hardware.h>
#include <mach/pxa27x_keypad.h>
/*
 * Keypad Controller registers
 */
#define KPC             0x0000 /* Keypad Control register */
#define KPDK            0x0008 /* Keypad Direct Key register */
#define KPREC           0x0010 /* Keypad Rotary Encoder register */
#define KPMK            0x0018 /* Keypad Matrix Key register */
#define KPAS            0x0020 /* Keypad Automatic Scan register */

/* Keypad Automatic Scan Multiple Key Presser register 0-3 */
#define KPASMKP0        0x0028
#define KPASMKP1        0x0030
#define KPASMKP2        0x0038
#define KPASMKP3        0x0040
#define KPKDI           0x0048

/* bit definitions */
#define KPC_MKRN(n)	((((n) - 1) & 0x7) << 26) /* matrix key row number */
#define KPC_MKCN(n)	((((n) - 1) & 0x7) << 23) /* matrix key column number */
#define KPC_DKN(n)	((((n) - 1) & 0x7) << 6)  /* direct key number */

#define KPC_AS          (0x1 << 30)  /* Automatic Scan bit */
#define KPC_ASACT       (0x1 << 29)  /* Automatic Scan on Activity */
#define KPC_MI          (0x1 << 22)  /* Matrix interrupt bit */
#define KPC_IMKP        (0x1 << 21)  /* Ignore Multiple Key Press */

#define KPC_MS(n)	(0x1 << (13 + (n)))	/* Matrix scan line 'n' */
#define KPC_MS_ALL      (0xff << 13)

#define KPC_ME          (0x1 << 12)  /* Matrix Keypad Enable */
#define KPC_MIE         (0x1 << 11)  /* Matrix Interrupt Enable */
#define KPC_DK_DEB_SEL	(0x1 <<  9)  /* Direct Keypad Debounce Select */
#define KPC_DI          (0x1 <<  5)  /* Direct key interrupt bit */
#define KPC_RE_ZERO_DEB (0x1 <<  4)  /* Rotary Encoder Zero Debounce */
#define KPC_REE1        (0x1 <<  3)  /* Rotary Encoder1 Enable */
#define KPC_REE0        (0x1 <<  2)  /* Rotary Encoder0 Enable */
#define KPC_DE          (0x1 <<  1)  /* Direct Keypad Enable */
#define KPC_DIE         (0x1 <<  0)  /* Direct Keypad interrupt Enable */

#define KPDK_DKP        (0x1 << 31)
#define KPDK_DK(n)	((n) & 0xff)

#define KPREC_OF1       (0x1 << 31)
#define kPREC_UF1       (0x1 << 30)
#define KPREC_OF0       (0x1 << 15)
#define KPREC_UF0       (0x1 << 14)

#define KPREC_RECOUNT0(n)	((n) & 0xff)
#define KPREC_RECOUNT1(n)	(((n) >> 16) & 0xff)

#define KPMK_MKP        (0x1 << 31)
#define KPAS_SO         (0x1 << 31)
#define KPASMKPx_SO     (0x1 << 31)

#define KPAS_MUKP(n)	(((n) >> 26) & 0x1f)
#define KPAS_RP(n)	(((n) >> 4) & 0xf)
#define KPAS_CP(n)	((n) & 0xf)

#define KPASMKP_MKC_MASK	(0xff)

#define keypad_readl(off)	__raw_readl(keypad->mmio_base + (off))
#define keypad_writel(off, v)	__raw_writel((v), keypad->mmio_base + (off))

#define MAX_MATRIX_KEY_NUM	(MAX_MATRIX_KEY_ROWS * MAX_MATRIX_KEY_COLS)
#define MAX_KEYPAD_KEYS		(MAX_MATRIX_KEY_NUM + MAX_DIRECT_KEY_NUM)

struct pxa27x_keypad {
	struct pxa27x_keypad_platform_data *pdata;

	struct clk *clk;
	struct input_dev *input_dev;
	void __iomem *mmio_base;

	int irq;

	unsigned short keycodes[MAX_KEYPAD_KEYS];
	int rotary_rel_code[2];

	/* state row bits of each column scan */
	uint32_t matrix_key_state[MAX_MATRIX_KEY_COLS];
	uint32_t direct_key_state;

	unsigned int direct_key_mask;
};

static void pxa27x_keypad_build_keycode(struct pxa27x_keypad *keypad)
{
	struct pxa27x_keypad_platform_data *pdata = keypad->pdata;
	struct input_dev *input_dev = keypad->input_dev;
	unsigned short keycode;
	int i;

	for (i = 0; i < pdata->matrix_key_map_size; i++) {
		unsigned int key = pdata->matrix_key_map[i];
		unsigned int row = KEY_ROW(key);
		unsigned int col = KEY_COL(key);
		unsigned int scancode = MATRIX_SCAN_CODE(row, col,
							 MATRIX_ROW_SHIFT);

		keycode = KEY_VAL(key);
		keypad->keycodes[scancode] = keycode;
		__set_bit(keycode, input_dev->keybit);
	}

	for (i = 0; i < pdata->direct_key_num; i++) {
		keycode = pdata->direct_key_map[i];
		keypad->keycodes[MAX_MATRIX_KEY_NUM + i] = keycode;
		__set_bit(keycode, input_dev->keybit);
	}

	if (pdata->enable_rotary0) {
		if (pdata->rotary0_up_key && pdata->rotary0_down_key) {
			keycode = pdata->rotary0_up_key;
			keypad->keycodes[MAX_MATRIX_KEY_NUM + 0] = keycode;
			__set_bit(keycode, input_dev->keybit);

			keycode = pdata->rotary0_down_key;
			keypad->keycodes[MAX_MATRIX_KEY_NUM + 1] = keycode;
			__set_bit(keycode, input_dev->keybit);

			keypad->rotary_rel_code[0] = -1;
		} else {
			keypad->rotary_rel_code[0] = pdata->rotary0_rel_code;
			__set_bit(pdata->rotary0_rel_code, input_dev->relbit);
		}
	}

	if (pdata->enable_rotary1) {
		if (pdata->rotary1_up_key && pdata->rotary1_down_key) {
			keycode = pdata->rotary1_up_key;
			keypad->keycodes[MAX_MATRIX_KEY_NUM + 2] = keycode;
			__set_bit(keycode, input_dev->keybit);

			keycode = pdata->rotary1_down_key;
			keypad->keycodes[MAX_MATRIX_KEY_NUM + 3] = keycode;
			__set_bit(keycode, input_dev->keybit);

			keypad->rotary_rel_code[1] = -1;
		} else {
			keypad->rotary_rel_code[1] = pdata->rotary1_rel_code;
			__set_bit(pdata->rotary1_rel_code, input_dev->relbit);
		}
	}

	__clear_bit(KEY_RESERVED, input_dev->keybit);
}

static void pxa27x_keypad_scan_matrix(struct pxa27x_keypad *keypad)
{
	struct pxa27x_keypad_platform_data *pdata = keypad->pdata;
	struct input_dev *input_dev = keypad->input_dev;
	int row, col, num_keys_pressed = 0;
	uint32_t new_state[MAX_MATRIX_KEY_COLS];
	uint32_t kpas = keypad_readl(KPAS);

	num_keys_pressed = KPAS_MUKP(kpas);

	memset(new_state, 0, sizeof(new_state));

	if (num_keys_pressed == 0)
		goto scan;

	if (num_keys_pressed == 1) {
		col = KPAS_CP(kpas);
		row = KPAS_RP(kpas);

		/* if invalid row/col, treat as no key pressed */
		if (col >= pdata->matrix_key_cols ||
		    row >= pdata->matrix_key_rows)
			goto scan;

		new_state[col] = (1 << row);
		goto scan;
	}

	if (num_keys_pressed > 1) {
		uint32_t kpasmkp0 = keypad_readl(KPASMKP0);
		uint32_t kpasmkp1 = keypad_readl(KPASMKP1);
		uint32_t kpasmkp2 = keypad_readl(KPASMKP2);
		uint32_t kpasmkp3 = keypad_readl(KPASMKP3);

		new_state[0] = kpasmkp0 & KPASMKP_MKC_MASK;
		new_state[1] = (kpasmkp0 >> 16) & KPASMKP_MKC_MASK;
		new_state[2] = kpasmkp1 & KPASMKP_MKC_MASK;
		new_state[3] = (kpasmkp1 >> 16) & KPASMKP_MKC_MASK;
		new_state[4] = kpasmkp2 & KPASMKP_MKC_MASK;
		new_state[5] = (kpasmkp2 >> 16) & KPASMKP_MKC_MASK;
		new_state[6] = kpasmkp3 & KPASMKP_MKC_MASK;
		new_state[7] = (kpasmkp3 >> 16) & KPASMKP_MKC_MASK;
	}
scan:
	for (col = 0; col < pdata->matrix_key_cols; col++) {
		uint32_t bits_changed;
		int code;

		bits_changed = keypad->matrix_key_state[col] ^ new_state[col];
		if (bits_changed == 0)
			continue;

		for (row = 0; row < pdata->matrix_key_rows; row++) {
			if ((bits_changed & (1 << row)) == 0)
				continue;

			code = MATRIX_SCAN_CODE(row, col, MATRIX_ROW_SHIFT);
			input_event(input_dev, EV_MSC, MSC_SCAN, code);
			input_report_key(input_dev, keypad->keycodes[code],
					 new_state[col] & (1 << row));
		}
	}
	input_sync(input_dev);
	memcpy(keypad->matrix_key_state, new_state, sizeof(new_state));
}

#define DEFAULT_KPREC	(0x007f007f)

static inline int rotary_delta(uint32_t kprec)
{
	if (kprec & KPREC_OF0)
		return (kprec & 0xff) + 0x7f;
	else if (kprec & KPREC_UF0)
		return (kprec & 0xff) - 0x7f - 0xff;
	else
		return (kprec & 0xff) - 0x7f;
}

static void report_rotary_event(struct pxa27x_keypad *keypad, int r, int delta)
{
	struct input_dev *dev = keypad->input_dev;

	if (delta == 0)
		return;

	if (keypad->rotary_rel_code[r] == -1) {
		int code = MAX_MATRIX_KEY_NUM + 2 * r + (delta > 0 ? 0 : 1);
		unsigned char keycode = keypad->keycodes[code];

		/* simulate a press-n-release */
		input_event(dev, EV_MSC, MSC_SCAN, code);
		input_report_key(dev, keycode, 1);
		input_sync(dev);
		input_event(dev, EV_MSC, MSC_SCAN, code);
		input_report_key(dev, keycode, 0);
		input_sync(dev);
	} else {
		input_report_rel(dev, keypad->rotary_rel_code[r], delta);
		input_sync(dev);
	}
}

static void pxa27x_keypad_scan_rotary(struct pxa27x_keypad *keypad)
{
	struct pxa27x_keypad_platform_data *pdata = keypad->pdata;
	uint32_t kprec;

	/* read and reset to default count value */
	kprec = keypad_readl(KPREC);
	keypad_writel(KPREC, DEFAULT_KPREC);

	if (pdata->enable_rotary0)
		report_rotary_event(keypad, 0, rotary_delta(kprec));

	if (pdata->enable_rotary1)
		report_rotary_event(keypad, 1, rotary_delta(kprec >> 16));
}

static void pxa27x_keypad_scan_direct(struct pxa27x_keypad *keypad)
{
	struct pxa27x_keypad_platform_data *pdata = keypad->pdata;
	struct input_dev *input_dev = keypad->input_dev;
	unsigned int new_state;
	uint32_t kpdk, bits_changed;
	int i;

	kpdk = keypad_readl(KPDK);

	if (pdata->enable_rotary0 || pdata->enable_rotary1)
		pxa27x_keypad_scan_rotary(keypad);

	new_state = KPDK_DK(kpdk) & keypad->direct_key_mask;
	bits_changed = keypad->direct_key_state ^ new_state;

	if (bits_changed == 0)
		return;

	for (i = 0; i < pdata->direct_key_num; i++) {
		if (bits_changed & (1 << i)) {
			int code = MAX_MATRIX_KEY_NUM + i;

			input_event(input_dev, EV_MSC, MSC_SCAN, code);
			input_report_key(input_dev, keypad->keycodes[code],
					 new_state & (1 << i));
		}
	}
	input_sync(input_dev);
	keypad->direct_key_state = new_state;
}

static irqreturn_t pxa27x_keypad_irq_handler(int irq, void *dev_id)
{
	struct pxa27x_keypad *keypad = dev_id;
	unsigned long kpc = keypad_readl(KPC);

	if (kpc & KPC_DI)
		pxa27x_keypad_scan_direct(keypad);

	if (kpc & KPC_MI)
		pxa27x_keypad_scan_matrix(keypad);

	return IRQ_HANDLED;
}

static void pxa27x_keypad_config(struct pxa27x_keypad *keypad)
{
	struct pxa27x_keypad_platform_data *pdata = keypad->pdata;
	unsigned int mask = 0, direct_key_num = 0;
	unsigned long kpc = 0;

	/* enable matrix keys with automatic scan */
	if (pdata->matrix_key_rows && pdata->matrix_key_cols) {
		kpc |= KPC_ASACT | KPC_MIE | KPC_ME | KPC_MS_ALL;
		kpc |= KPC_MKRN(pdata->matrix_key_rows) |
		       KPC_MKCN(pdata->matrix_key_cols);
	}

	/* enable rotary key, debounce interval same as direct keys */
	if (pdata->enable_rotary0) {
		mask |= 0x03;
		direct_key_num = 2;
		kpc |= KPC_REE0;
	}

	if (pdata->enable_rotary1) {
		mask |= 0x0c;
		direct_key_num = 4;
		kpc |= KPC_REE1;
	}

	if (pdata->direct_key_num > direct_key_num)
		direct_key_num = pdata->direct_key_num;

	keypad->direct_key_mask = ((2 << direct_key_num) - 1) & ~mask;

	/* enable direct key */
	if (direct_key_num)
		kpc |= KPC_DE | KPC_DIE | KPC_DKN(direct_key_num);

	keypad_writel(KPC, kpc | KPC_RE_ZERO_DEB);
	keypad_writel(KPREC, DEFAULT_KPREC);
	keypad_writel(KPKDI, pdata->debounce_interval);
}

static int pxa27x_keypad_open(struct input_dev *dev)
{
	struct pxa27x_keypad *keypad = input_get_drvdata(dev);

	/* Enable unit clock */
	clk_enable(keypad->clk);
	pxa27x_keypad_config(keypad);

	return 0;
}

static void pxa27x_keypad_close(struct input_dev *dev)
{
	struct pxa27x_keypad *keypad = input_get_drvdata(dev);

	/* Disable clock unit */
	clk_disable(keypad->clk);
}

#ifdef CONFIG_PM
static int pxa27x_keypad_suspend(struct device *dev)
{
	struct platform_device *pdev = to_platform_device(dev);
	struct pxa27x_keypad *keypad = platform_get_drvdata(pdev);

	clk_disable(keypad->clk);

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

	return 0;
}

static int pxa27x_keypad_resume(struct device *dev)
{
	struct platform_device *pdev = to_platform_device(dev);
	struct pxa27x_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) {
		/* Enable unit clock */
		clk_enable(keypad->clk);
		pxa27x_keypad_config(keypad);
	}

	mutex_unlock(&input_dev->mutex);

	return 0;
}

static const struct dev_pm_ops pxa27x_keypad_pm_ops = {
	.suspend	= pxa27x_keypad_suspend,
	.resume		= pxa27x_keypad_resume,
};
#endif

static int __devinit pxa27x_keypad_probe(struct platform_device *pdev)
{
	struct pxa27x_keypad_platform_data *pdata = pdev->dev.platform_data;
	struct pxa27x_keypad *keypad;
	struct input_dev *input_dev;
	struct resource *res;
	int irq, error;

	if (pdata == NULL) {
		dev_err(&pdev->dev, "no platform data defined\n");
		return -EINVAL;
	}

	irq = platform_get_irq(pdev, 0);
	if (irq < 0) {
		dev_err(&pdev->dev, "failed to get keypad irq\n");
		return -ENXIO;
	}

	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	if (res == NULL) {
		dev_err(&pdev->dev, "failed to get I/O memory\n");
		return -ENXIO;
	}

	keypad = kzalloc(sizeof(struct pxa27x_keypad), GFP_KERNEL);
	input_dev = input_allocate_device();
	if (!keypad || !input_dev) {
		dev_err(&pdev->dev, "failed to allocate memory\n");
		error = -ENOMEM;
		goto failed_free;
	}

	keypad->pdata = pdata;
	keypad->input_dev = input_dev;
	keypad->irq = irq;

	res = request_mem_region(res->start, resource_size(res), pdev->name);
	if (res == NULL) {
		dev_err(&pdev->dev, "failed to request I/O memory\n");
		error = -EBUSY;
		goto failed_free;
	}

	keypad->mmio_base = ioremap(res->start, resource_size(res));
	if (keypad->mmio_base == NULL) {
		dev_err(&pdev->dev, "failed to remap I/O memory\n");
		error = -ENXIO;
		goto failed_free_mem;
	}

	keypad->clk = clk_get(&pdev->dev, NULL);
	if (IS_ERR(keypad->clk)) {
		dev_err(&pdev->dev, "failed to get keypad clock\n");
		error = PTR_ERR(keypad->clk);
		goto failed_free_io;
	}

	input_dev->name = pdev->name;
	input_dev->id.bustype = BUS_HOST;
	input_dev->open = pxa27x_keypad_open;
	input_dev->close = pxa27x_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) | BIT_MASK(EV_REP);
	input_set_capability(input_dev, EV_MSC, MSC_SCAN);

	pxa27x_keypad_build_keycode(keypad);

	if ((pdata->enable_rotary0 && keypad->rotary_rel_code[0] != -1) ||
	    (pdata->enable_rotary1 && keypad->rotary_rel_code[1] != -1)) {
		input_dev->evbit[0] |= BIT_MASK(EV_REL);
	}

	error = request_irq(irq, pxa27x_keypad_irq_handler, IRQF_DISABLED,
			    pdev->name, keypad);
	if (error) {
		dev_err(&pdev->dev, "failed to request IRQ\n");
		goto failed_put_clk;
	}

	/* Register the input device */
	error = input_register_device(input_dev);
	if (error) {
		dev_err(&pdev->dev, "failed to register input device\n");
		goto failed_free_irq;
	}

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

	return 0;

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

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

	free_irq(keypad->irq, pdev);
	clk_put(keypad->clk);

	input_unregister_device(keypad->input_dev);
	input_free_device(keypad->input_dev);

	iounmap(keypad->mmio_base);

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

	platform_set_drvdata(pdev, NULL);
	kfree(keypad);

	return 0;
}

/* work with hotplug and coldplug */
MODULE_ALIAS("platform:pxa27x-keypad");

static struct platform_driver pxa27x_keypad_driver = {
	.probe		= pxa27x_keypad_probe,
	.remove		= __devexit_p(pxa27x_keypad_remove),
	.driver		= {
		.name	= "pxa27x-keypad",
		.owner	= THIS_MODULE,
#ifdef CONFIG_PM
		.pm	= &pxa27x_keypad_pm_ops,
#endif
	},
};

static int __init pxa27x_keypad_init(void)
{
	return platform_driver_register(&pxa27x_keypad_driver);
}

static void __exit pxa27x_keypad_exit(void)
{
	platform_driver_unregister(&pxa27x_keypad_driver);
}

module_init(pxa27x_keypad_init);
module_exit(pxa27x_keypad_exit);

MODULE_DESCRIPTION("PXA27x Keypad Controller Driver");
MODULE_LICENSE("GPL");
Commit	Line	Data
5a90e5bc	1	/*
0e5f11aa	2	* linux/drivers/input/keyboard/pxa27x_keypad.c
5a90e5bc RG	3	*
	4	* Driver for the pxa27x matrix keyboard controller.
	5	*
	6	* Created: Feb 22, 2007
	7	* Author: Rodolfo Giometti <giometti@linux.it>
	8	*
	9	* Based on a previous implementations by Kevin O'Connor
	10	* <kevin_at_koconnor.net> and Alex Osborne <bobofdoom@gmail.com> and
2f82af08	11	* on some suggestions by Nicolas Pitre <nico@fluxnic.net>.
5a90e5bc RG	12	*
	13	* This program is free software; you can redistribute it and/or modify
	14	* it under the terms of the GNU General Public License version 2 as
	15	* published by the Free Software Foundation.
	16	*/
	17
	18
	19	#include <linux/kernel.h>
	20	#include <linux/module.h>
	21	#include <linux/init.h>
	22	#include <linux/interrupt.h>
	23	#include <linux/input.h>
	24	#include <linux/device.h>
	25	#include <linux/platform_device.h>
22d8a73a RK	26	#include <linux/clk.h>
22d8a73a RK	27	#include <linux/err.h>
52ec7752	28	#include <linux/input/matrix_keypad.h>
5a0e3ad6	29	#include <linux/slab.h>
5a90e5bc	30
5a90e5bc RG	31	#include <asm/mach/arch.h>
	32	#include <asm/mach/map.h>
	33
a09e64fb RK	34	#include <mach/hardware.h>
a09e64fb RK	35	#include <mach/pxa27x_keypad.h>
9c60debd EM	36	/*
	37	* Keypad Controller registers
	38	*/
	39	#define KPC 0x0000 /* Keypad Control register */
	40	#define KPDK 0x0008 /* Keypad Direct Key register */
	41	#define KPREC 0x0010 /* Keypad Rotary Encoder register */
	42	#define KPMK 0x0018 /* Keypad Matrix Key register */
	43	#define KPAS 0x0020 /* Keypad Automatic Scan register */
	44
	45	/* Keypad Automatic Scan Multiple Key Presser register 0-3 */
	46	#define KPASMKP0 0x0028
	47	#define KPASMKP1 0x0030
	48	#define KPASMKP2 0x0038
	49	#define KPASMKP3 0x0040
	50	#define KPKDI 0x0048
	51
	52	/* bit definitions */
688dad4f SO	53	#define KPC_MKRN(n) ((((n) - 1) & 0x7) << 26) /* matrix key row number */
	54	#define KPC_MKCN(n) ((((n) - 1) & 0x7) << 23) /* matrix key column number */
	55	#define KPC_DKN(n) ((((n) - 1) & 0x7) << 6) /* direct key number */
d7416f9e	56
9c60debd EM	57	#define KPC_AS (0x1 << 30) /* Automatic Scan bit */
	58	#define KPC_ASACT (0x1 << 29) /* Automatic Scan on Activity */
	59	#define KPC_MI (0x1 << 22) /* Matrix interrupt bit */
	60	#define KPC_IMKP (0x1 << 21) /* Ignore Multiple Key Press */
	61
	62	#define KPC_MS(n) (0x1 << (13 + (n))) /* Matrix scan line 'n' */
	63	#define KPC_MS_ALL (0xff << 13)
	64
	65	#define KPC_ME (0x1 << 12) /* Matrix Keypad Enable */
	66	#define KPC_MIE (0x1 << 11) /* Matrix Interrupt Enable */
	67	#define KPC_DK_DEB_SEL (0x1 << 9) /* Direct Keypad Debounce Select */
	68	#define KPC_DI (0x1 << 5) /* Direct key interrupt bit */
	69	#define KPC_RE_ZERO_DEB (0x1 << 4) /* Rotary Encoder Zero Debounce */
	70	#define KPC_REE1 (0x1 << 3) /* Rotary Encoder1 Enable */
	71	#define KPC_REE0 (0x1 << 2) /* Rotary Encoder0 Enable */
	72	#define KPC_DE (0x1 << 1) /* Direct Keypad Enable */
	73	#define KPC_DIE (0x1 << 0) /* Direct Keypad interrupt Enable */
	74
62059d9e EM	75	#define KPDK_DKP (0x1 << 31)
	76	#define KPDK_DK(n) ((n) & 0xff)
	77
9c60debd EM	78	#define KPREC_OF1 (0x1 << 31)
	79	#define kPREC_UF1 (0x1 << 30)
	80	#define KPREC_OF0 (0x1 << 15)
	81	#define KPREC_UF0 (0x1 << 14)
	82
	83	#define KPREC_RECOUNT0(n) ((n) & 0xff)
	84	#define KPREC_RECOUNT1(n) (((n) >> 16) & 0xff)
	85
	86	#define KPMK_MKP (0x1 << 31)
	87	#define KPAS_SO (0x1 << 31)
	88	#define KPASMKPx_SO (0x1 << 31)
	89
	90	#define KPAS_MUKP(n) (((n) >> 26) & 0x1f)
	91	#define KPAS_RP(n) (((n) >> 4) & 0xf)
	92	#define KPAS_CP(n) ((n) & 0xf)
5a90e5bc	93
1814db69 EM	94	#define KPASMKP_MKC_MASK (0xff)
1814db69 EM	95
9c60debd EM	96	#define keypad_readl(off) __raw_readl(keypad->mmio_base + (off))
	97	#define keypad_writel(off, v) __raw_writel((v), keypad->mmio_base + (off))
	98
bd96f378 DT	99	#define MAX_MATRIX_KEY_NUM (MAX_MATRIX_KEY_ROWS * MAX_MATRIX_KEY_COLS)
bd96f378 DT	100	#define MAX_KEYPAD_KEYS (MAX_MATRIX_KEY_NUM + MAX_DIRECT_KEY_NUM)
1814db69 EM	101
	102	struct pxa27x_keypad {
	103	struct pxa27x_keypad_platform_data *pdata;
	104
	105	struct clk *clk;
	106	struct input_dev *input_dev;
9c60debd	107	void __iomem *mmio_base;
1814db69	108
39ab9dde EM	109	int irq;
39ab9dde EM	110
bd96f378 DT	111	unsigned short keycodes[MAX_KEYPAD_KEYS];
bd96f378 DT	112	int rotary_rel_code[2];
1814db69 EM	113
	114	/* state row bits of each column scan */
	115	uint32_t matrix_key_state[MAX_MATRIX_KEY_COLS];
62059d9e EM	116	uint32_t direct_key_state;
	117
	118	unsigned int direct_key_mask;
1814db69 EM	119	};
	120
	121	static void pxa27x_keypad_build_keycode(struct pxa27x_keypad *keypad)
	122	{
	123	struct pxa27x_keypad_platform_data *pdata = keypad->pdata;
	124	struct input_dev *input_dev = keypad->input_dev;
bd96f378	125	unsigned short keycode;
1814db69 EM	126	int i;
1814db69 EM	127
52ec7752 DT	128	for (i = 0; i < pdata->matrix_key_map_size; i++) {
	129	unsigned int key = pdata->matrix_key_map[i];
	130	unsigned int row = KEY_ROW(key);
	131	unsigned int col = KEY_COL(key);
bd96f378 DT	132	unsigned int scancode = MATRIX_SCAN_CODE(row, col,
bd96f378 DT	133	MATRIX_ROW_SHIFT);
1814db69	134
bd96f378 DT	135	keycode = KEY_VAL(key);
	136	keypad->keycodes[scancode] = keycode;
	137	__set_bit(keycode, input_dev->keybit);
1814db69	138	}
471637a5	139
bd96f378 DT	140	for (i = 0; i < pdata->direct_key_num; i++) {
	141	keycode = pdata->direct_key_map[i];
	142	keypad->keycodes[MAX_MATRIX_KEY_NUM + i] = keycode;
	143	__set_bit(keycode, input_dev->keybit);
	144	}
62059d9e	145
471637a5 AO	146	if (pdata->enable_rotary0) {
471637a5 AO	147	if (pdata->rotary0_up_key && pdata->rotary0_down_key) {
bd96f378 DT	148	keycode = pdata->rotary0_up_key;
	149	keypad->keycodes[MAX_MATRIX_KEY_NUM + 0] = keycode;
	150	__set_bit(keycode, input_dev->keybit);
	151
	152	keycode = pdata->rotary0_down_key;
	153	keypad->keycodes[MAX_MATRIX_KEY_NUM + 1] = keycode;
	154	__set_bit(keycode, input_dev->keybit);
	155
	156	keypad->rotary_rel_code[0] = -1;
	157	} else {
	158	keypad->rotary_rel_code[0] = pdata->rotary0_rel_code;
52ec7752	159	__set_bit(pdata->rotary0_rel_code, input_dev->relbit);
bd96f378	160	}
471637a5 AO	161	}
	162
	163	if (pdata->enable_rotary1) {
	164	if (pdata->rotary1_up_key && pdata->rotary1_down_key) {
bd96f378 DT	165	keycode = pdata->rotary1_up_key;
	166	keypad->keycodes[MAX_MATRIX_KEY_NUM + 2] = keycode;
	167	__set_bit(keycode, input_dev->keybit);
	168
	169	keycode = pdata->rotary1_down_key;
	170	keypad->keycodes[MAX_MATRIX_KEY_NUM + 3] = keycode;
	171	__set_bit(keycode, input_dev->keybit);
	172
	173	keypad->rotary_rel_code[1] = -1;
	174	} else {
	175	keypad->rotary_rel_code[1] = pdata->rotary1_rel_code;
52ec7752	176	__set_bit(pdata->rotary1_rel_code, input_dev->relbit);
bd96f378	177	}
471637a5	178	}
1814db69	179
bd96f378	180	__clear_bit(KEY_RESERVED, input_dev->keybit);
1814db69 EM	181	}
	182
	183	static void pxa27x_keypad_scan_matrix(struct pxa27x_keypad *keypad)
	184	{
	185	struct pxa27x_keypad_platform_data *pdata = keypad->pdata;
bd96f378	186	struct input_dev *input_dev = keypad->input_dev;
1814db69 EM	187	int row, col, num_keys_pressed = 0;
1814db69 EM	188	uint32_t new_state[MAX_MATRIX_KEY_COLS];
9c60debd	189	uint32_t kpas = keypad_readl(KPAS);
1814db69 EM	190
	191	num_keys_pressed = KPAS_MUKP(kpas);
	192
	193	memset(new_state, 0, sizeof(new_state));
	194
	195	if (num_keys_pressed == 0)
	196	goto scan;
	197
	198	if (num_keys_pressed == 1) {
	199	col = KPAS_CP(kpas);
	200	row = KPAS_RP(kpas);
	201
	202	/* if invalid row/col, treat as no key pressed */
	203	if (col >= pdata->matrix_key_cols \|\|
	204	row >= pdata->matrix_key_rows)
	205	goto scan;
	206
	207	new_state[col] = (1 << row);
	208	goto scan;
	209	}
	210
	211	if (num_keys_pressed > 1) {
9c60debd EM	212	uint32_t kpasmkp0 = keypad_readl(KPASMKP0);
	213	uint32_t kpasmkp1 = keypad_readl(KPASMKP1);
	214	uint32_t kpasmkp2 = keypad_readl(KPASMKP2);
	215	uint32_t kpasmkp3 = keypad_readl(KPASMKP3);
1814db69 EM	216
	217	new_state[0] = kpasmkp0 & KPASMKP_MKC_MASK;
	218	new_state[1] = (kpasmkp0 >> 16) & KPASMKP_MKC_MASK;
	219	new_state[2] = kpasmkp1 & KPASMKP_MKC_MASK;
	220	new_state[3] = (kpasmkp1 >> 16) & KPASMKP_MKC_MASK;
	221	new_state[4] = kpasmkp2 & KPASMKP_MKC_MASK;
	222	new_state[5] = (kpasmkp2 >> 16) & KPASMKP_MKC_MASK;
	223	new_state[6] = kpasmkp3 & KPASMKP_MKC_MASK;
	224	new_state[7] = (kpasmkp3 >> 16) & KPASMKP_MKC_MASK;
	225	}
	226	scan:
	227	for (col = 0; col < pdata->matrix_key_cols; col++) {
	228	uint32_t bits_changed;
bd96f378	229	int code;
1814db69 EM	230
	231	bits_changed = keypad->matrix_key_state[col] ^ new_state[col];
	232	if (bits_changed == 0)
	233	continue;
	234
	235	for (row = 0; row < pdata->matrix_key_rows; row++) {
	236	if ((bits_changed & (1 << row)) == 0)
	237	continue;
	238
bd96f378 DT	239	code = MATRIX_SCAN_CODE(row, col, MATRIX_ROW_SHIFT);
	240	input_event(input_dev, EV_MSC, MSC_SCAN, code);
	241	input_report_key(input_dev, keypad->keycodes[code],
	242	new_state[col] & (1 << row));
1814db69 EM	243	}
1814db69 EM	244	}
bd96f378	245	input_sync(input_dev);
1814db69 EM	246	memcpy(keypad->matrix_key_state, new_state, sizeof(new_state));
1814db69 EM	247	}
22d8a73a	248
d7416f9e EM	249	#define DEFAULT_KPREC (0x007f007f)
d7416f9e EM	250
62059d9e EM	251	static inline int rotary_delta(uint32_t kprec)
	252	{
	253	if (kprec & KPREC_OF0)
	254	return (kprec & 0xff) + 0x7f;
	255	else if (kprec & KPREC_UF0)
	256	return (kprec & 0xff) - 0x7f - 0xff;
	257	else
	258	return (kprec & 0xff) - 0x7f;
	259	}
	260
	261	static void report_rotary_event(struct pxa27x_keypad *keypad, int r, int delta)
	262	{
	263	struct input_dev *dev = keypad->input_dev;
	264
	265	if (delta == 0)
	266	return;
	267
bd96f378 DT	268	if (keypad->rotary_rel_code[r] == -1) {
	269	int code = MAX_MATRIX_KEY_NUM + 2 * r + (delta > 0 ? 0 : 1);
	270	unsigned char keycode = keypad->keycodes[code];
62059d9e EM	271
62059d9e EM	272	/* simulate a press-n-release */
bd96f378	273	input_event(dev, EV_MSC, MSC_SCAN, code);
62059d9e EM	274	input_report_key(dev, keycode, 1);
62059d9e EM	275	input_sync(dev);
bd96f378	276	input_event(dev, EV_MSC, MSC_SCAN, code);
62059d9e EM	277	input_report_key(dev, keycode, 0);
	278	input_sync(dev);
	279	} else {
	280	input_report_rel(dev, keypad->rotary_rel_code[r], delta);
	281	input_sync(dev);
	282	}
	283	}
	284
	285	static void pxa27x_keypad_scan_rotary(struct pxa27x_keypad *keypad)
	286	{
	287	struct pxa27x_keypad_platform_data *pdata = keypad->pdata;
	288	uint32_t kprec;
	289
	290	/* read and reset to default count value */
9c60debd EM	291	kprec = keypad_readl(KPREC);
9c60debd EM	292	keypad_writel(KPREC, DEFAULT_KPREC);
62059d9e EM	293
	294	if (pdata->enable_rotary0)
	295	report_rotary_event(keypad, 0, rotary_delta(kprec));
	296
	297	if (pdata->enable_rotary1)
	298	report_rotary_event(keypad, 1, rotary_delta(kprec >> 16));
	299	}
	300
	301	static void pxa27x_keypad_scan_direct(struct pxa27x_keypad *keypad)
	302	{
	303	struct pxa27x_keypad_platform_data *pdata = keypad->pdata;
bd96f378	304	struct input_dev *input_dev = keypad->input_dev;
62059d9e EM	305	unsigned int new_state;
	306	uint32_t kpdk, bits_changed;
	307	int i;
	308
9c60debd	309	kpdk = keypad_readl(KPDK);
62059d9e EM	310
	311	if (pdata->enable_rotary0 \|\| pdata->enable_rotary1)
	312	pxa27x_keypad_scan_rotary(keypad);
	313
62059d9e EM	314	new_state = KPDK_DK(kpdk) & keypad->direct_key_mask;
	315	bits_changed = keypad->direct_key_state ^ new_state;
	316
	317	if (bits_changed == 0)
	318	return;
	319
	320	for (i = 0; i < pdata->direct_key_num; i++) {
bd96f378 DT	321	if (bits_changed & (1 << i)) {
	322	int code = MAX_MATRIX_KEY_NUM + i;
	323
	324	input_event(input_dev, EV_MSC, MSC_SCAN, code);
	325	input_report_key(input_dev, keypad->keycodes[code],
	326	new_state & (1 << i));
	327	}
62059d9e	328	}
bd96f378	329	input_sync(input_dev);
62059d9e EM	330	keypad->direct_key_state = new_state;
	331	}
	332
0e5f11aa	333	static irqreturn_t pxa27x_keypad_irq_handler(int irq, void *dev_id)
5a90e5bc	334	{
1814db69	335	struct pxa27x_keypad *keypad = dev_id;
9c60debd	336	unsigned long kpc = keypad_readl(KPC);
62059d9e EM	337
	338	if (kpc & KPC_DI)
	339	pxa27x_keypad_scan_direct(keypad);
5a90e5bc	340
1814db69 EM	341	if (kpc & KPC_MI)
1814db69 EM	342	pxa27x_keypad_scan_matrix(keypad);
5a90e5bc RG	343
	344	return IRQ_HANDLED;
	345	}
	346
d7416f9e	347	static void pxa27x_keypad_config(struct pxa27x_keypad *keypad)
5a90e5bc	348	{
d7416f9e	349	struct pxa27x_keypad_platform_data *pdata = keypad->pdata;
62059d9e	350	unsigned int mask = 0, direct_key_num = 0;
d7416f9e	351	unsigned long kpc = 0;
1814db69	352
d7416f9e EM	353	/* enable matrix keys with automatic scan */
	354	if (pdata->matrix_key_rows && pdata->matrix_key_cols) {
	355	kpc \|= KPC_ASACT \| KPC_MIE \| KPC_ME \| KPC_MS_ALL;
	356	kpc \|= KPC_MKRN(pdata->matrix_key_rows) \|
	357	KPC_MKCN(pdata->matrix_key_cols);
	358	}
5a90e5bc	359
62059d9e EM	360	/* enable rotary key, debounce interval same as direct keys */
	361	if (pdata->enable_rotary0) {
	362	mask \|= 0x03;
	363	direct_key_num = 2;
	364	kpc \|= KPC_REE0;
	365	}
	366
	367	if (pdata->enable_rotary1) {
	368	mask \|= 0x0c;
	369	direct_key_num = 4;
	370	kpc \|= KPC_REE1;
	371	}
	372
	373	if (pdata->direct_key_num > direct_key_num)
	374	direct_key_num = pdata->direct_key_num;
	375
	376	keypad->direct_key_mask = ((2 << direct_key_num) - 1) & ~mask;
	377
	378	/* enable direct key */
	379	if (direct_key_num)
	380	kpc \|= KPC_DE \| KPC_DIE \| KPC_DKN(direct_key_num);
5a90e5bc	381
9c60debd EM	382	keypad_writel(KPC, kpc \| KPC_RE_ZERO_DEB);
9c60debd EM	383	keypad_writel(KPREC, DEFAULT_KPREC);
76cb44e1	384	keypad_writel(KPKDI, pdata->debounce_interval);
d7416f9e EM	385	}
	386
	387	static int pxa27x_keypad_open(struct input_dev *dev)
	388	{
	389	struct pxa27x_keypad *keypad = input_get_drvdata(dev);
5a90e5bc RG	390
5a90e5bc RG	391	/* Enable unit clock */
1814db69	392	clk_enable(keypad->clk);
d7416f9e	393	pxa27x_keypad_config(keypad);
5a90e5bc RG	394
	395	return 0;
	396	}
	397
0e5f11aa	398	static void pxa27x_keypad_close(struct input_dev *dev)
5a90e5bc	399	{
1814db69 EM	400	struct pxa27x_keypad *keypad = input_get_drvdata(dev);
1814db69 EM	401
5a90e5bc	402	/* Disable clock unit */
1814db69	403	clk_disable(keypad->clk);
5a90e5bc RG	404	}
	405
	406	#ifdef CONFIG_PM
b0010911	407	static int pxa27x_keypad_suspend(struct device *dev)
5a90e5bc	408	{
b0010911	409	struct platform_device *pdev = to_platform_device(dev);
1814db69	410	struct pxa27x_keypad *keypad = platform_get_drvdata(pdev);
5a90e5bc	411
d7416f9e	412	clk_disable(keypad->clk);
39ab9dde EM	413
	414	if (device_may_wakeup(&pdev->dev))
	415	enable_irq_wake(keypad->irq);
	416
5a90e5bc RG	417	return 0;
	418	}
	419
b0010911	420	static int pxa27x_keypad_resume(struct device *dev)
5a90e5bc	421	{
b0010911	422	struct platform_device *pdev = to_platform_device(dev);
1814db69	423	struct pxa27x_keypad *keypad = platform_get_drvdata(pdev);
1814db69	424	struct input_dev *input_dev = keypad->input_dev;
5a90e5bc	425
39ab9dde EM	426	if (device_may_wakeup(&pdev->dev))
	427	disable_irq_wake(keypad->irq);
	428
5a90e5bc RG	429	mutex_lock(&input_dev->mutex);
	430
	431	if (input_dev->users) {
5a90e5bc	432	/* Enable unit clock */
1814db69	433	clk_enable(keypad->clk);
d7416f9e	434	pxa27x_keypad_config(keypad);
5a90e5bc RG	435	}
	436
	437	mutex_unlock(&input_dev->mutex);
	438
	439	return 0;
	440	}
b0010911 DT	441
	442	static const struct dev_pm_ops pxa27x_keypad_pm_ops = {
	443	.suspend = pxa27x_keypad_suspend,
	444	.resume = pxa27x_keypad_resume,
	445	};
5a90e5bc RG	446	#endif
5a90e5bc RG	447
0e5f11aa	448	static int __devinit pxa27x_keypad_probe(struct platform_device *pdev)
5a90e5bc	449	{
bd96f378	450	struct pxa27x_keypad_platform_data *pdata = pdev->dev.platform_data;
1814db69	451	struct pxa27x_keypad *keypad;
5a90e5bc	452	struct input_dev *input_dev;
9c60debd EM	453	struct resource *res;
9c60debd EM	454	int irq, error;
5a90e5bc	455
bd96f378	456	if (pdata == NULL) {
1814db69	457	dev_err(&pdev->dev, "no platform data defined\n");
bd96f378	458	return -EINVAL;
1814db69 EM	459	}
1814db69 EM	460
9c60debd EM	461	irq = platform_get_irq(pdev, 0);
	462	if (irq < 0) {
	463	dev_err(&pdev->dev, "failed to get keypad irq\n");
bd96f378	464	return -ENXIO;
9c60debd EM	465	}
	466
	467	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	468	if (res == NULL) {
	469	dev_err(&pdev->dev, "failed to get I/O memory\n");
bd96f378 DT	470	return -ENXIO;
	471	}
	472
	473	keypad = kzalloc(sizeof(struct pxa27x_keypad), GFP_KERNEL);
	474	input_dev = input_allocate_device();
	475	if (!keypad \|\| !input_dev) {
	476	dev_err(&pdev->dev, "failed to allocate memory\n");
	477	error = -ENOMEM;
9c60debd EM	478	goto failed_free;
	479	}
	480
bd96f378 DT	481	keypad->pdata = pdata;
	482	keypad->input_dev = input_dev;
	483	keypad->irq = irq;
	484
52ec7752	485	res = request_mem_region(res->start, resource_size(res), pdev->name);
9c60debd EM	486	if (res == NULL) {
	487	dev_err(&pdev->dev, "failed to request I/O memory\n");
	488	error = -EBUSY;
	489	goto failed_free;
	490	}
	491
52ec7752	492	keypad->mmio_base = ioremap(res->start, resource_size(res));
9c60debd EM	493	if (keypad->mmio_base == NULL) {
	494	dev_err(&pdev->dev, "failed to remap I/O memory\n");
	495	error = -ENXIO;
	496	goto failed_free_mem;
	497	}
	498
e0d8b13a	499	keypad->clk = clk_get(&pdev->dev, NULL);
1814db69 EM	500	if (IS_ERR(keypad->clk)) {
	501	dev_err(&pdev->dev, "failed to get keypad clock\n");
	502	error = PTR_ERR(keypad->clk);
9c60debd	503	goto failed_free_io;
22d8a73a RK	504	}
22d8a73a RK	505
9c60debd	506	input_dev->name = pdev->name;
5a90e5bc	507	input_dev->id.bustype = BUS_HOST;
0e5f11aa EM	508	input_dev->open = pxa27x_keypad_open;
0e5f11aa EM	509	input_dev->close = pxa27x_keypad_close;
469ba4df	510	input_dev->dev.parent = &pdev->dev;
5a90e5bc	511
bd96f378 DT	512	input_dev->keycode = keypad->keycodes;
	513	input_dev->keycodesize = sizeof(keypad->keycodes[0]);
	514	input_dev->keycodemax = ARRAY_SIZE(keypad->keycodes);
	515
1814db69 EM	516	input_set_drvdata(input_dev, keypad);
1814db69 EM	517
471637a5	518	input_dev->evbit[0] = BIT_MASK(EV_KEY) \| BIT_MASK(EV_REP);
bd96f378	519	input_set_capability(input_dev, EV_MSC, MSC_SCAN);
1814db69 EM	520
1814db69 EM	521	pxa27x_keypad_build_keycode(keypad);
bd96f378 DT	522
	523	if ((pdata->enable_rotary0 && keypad->rotary_rel_code[0] != -1) \|\|
	524	(pdata->enable_rotary1 && keypad->rotary_rel_code[1] != -1)) {
	525	input_dev->evbit[0] \|= BIT_MASK(EV_REL);
	526	}
5a90e5bc	527
9c60debd EM	528	error = request_irq(irq, pxa27x_keypad_irq_handler, IRQF_DISABLED,
9c60debd EM	529	pdev->name, keypad);
5a90e5bc	530	if (error) {
9c60debd	531	dev_err(&pdev->dev, "failed to request IRQ\n");
bd96f378	532	goto failed_put_clk;
5a90e5bc RG	533	}
5a90e5bc RG	534
5a90e5bc RG	535	/* Register the input device */
5a90e5bc RG	536	error = input_register_device(input_dev);
9c60debd EM	537	if (error) {
	538	dev_err(&pdev->dev, "failed to register input device\n");
	539	goto failed_free_irq;
	540	}
5a90e5bc	541
bd96f378	542	platform_set_drvdata(pdev, keypad);
39ab9dde EM	543	device_init_wakeup(&pdev->dev, 1);
39ab9dde EM	544
5a90e5bc RG	545	return 0;
5a90e5bc RG	546
9c60debd EM	547	failed_free_irq:
9c60debd EM	548	free_irq(irq, pdev);
1814db69 EM	549	failed_put_clk:
1814db69 EM	550	clk_put(keypad->clk);
9c60debd EM	551	failed_free_io:
	552	iounmap(keypad->mmio_base);
	553	failed_free_mem:
52ec7752	554	release_mem_region(res->start, resource_size(res));
1814db69	555	failed_free:
bd96f378	556	input_free_device(input_dev);
1814db69	557	kfree(keypad);
5a90e5bc RG	558	return error;
	559	}
	560
0e5f11aa	561	static int __devexit pxa27x_keypad_remove(struct platform_device *pdev)
5a90e5bc	562	{
1814db69	563	struct pxa27x_keypad *keypad = platform_get_drvdata(pdev);
9c60debd	564	struct resource *res;
5a90e5bc	565
39ab9dde	566	free_irq(keypad->irq, pdev);
1814db69 EM	567	clk_put(keypad->clk);
	568
	569	input_unregister_device(keypad->input_dev);
9c60debd EM	570	input_free_device(keypad->input_dev);
	571
	572	iounmap(keypad->mmio_base);
	573
	574	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
52ec7752	575	release_mem_region(res->start, resource_size(res));
1814db69 EM	576
	577	platform_set_drvdata(pdev, NULL);
	578	kfree(keypad);
bd96f378	579
5a90e5bc RG	580	return 0;
	581	}
	582
d7b5247b KS	583	/* work with hotplug and coldplug */
	584	MODULE_ALIAS("platform:pxa27x-keypad");
	585
0e5f11aa EM	586	static struct platform_driver pxa27x_keypad_driver = {
	587	.probe = pxa27x_keypad_probe,
	588	.remove = __devexit_p(pxa27x_keypad_remove),
5a90e5bc	589	.driver = {
9c60debd	590	.name = "pxa27x-keypad",
d7b5247b	591	.owner = THIS_MODULE,
b0010911 DT	592	#ifdef CONFIG_PM
	593	.pm = &pxa27x_keypad_pm_ops,
	594	#endif
5a90e5bc RG	595	},
	596	};
	597
0e5f11aa	598	static int __init pxa27x_keypad_init(void)
5a90e5bc	599	{
0e5f11aa	600	return platform_driver_register(&pxa27x_keypad_driver);
5a90e5bc RG	601	}
5a90e5bc RG	602
0e5f11aa	603	static void __exit pxa27x_keypad_exit(void)
5a90e5bc	604	{
0e5f11aa	605	platform_driver_unregister(&pxa27x_keypad_driver);
5a90e5bc RG	606	}
5a90e5bc RG	607
0e5f11aa EM	608	module_init(pxa27x_keypad_init);
0e5f11aa EM	609	module_exit(pxa27x_keypad_exit);
5a90e5bc	610
0e5f11aa	611	MODULE_DESCRIPTION("PXA27x Keypad Controller Driver");
5a90e5bc	612	MODULE_LICENSE("GPL");