[mirror_ubuntu-bionic-kernel.git] / drivers / input / keyboard / matrix_keypad.c

/*
 *  GPIO driven matrix keyboard driver
 *
 *  Copyright (c) 2008 Marek Vasut <marek.vasut@gmail.com>
 *
 *  Based on corgikbd.c
 *
 *  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/types.h>
#include <linux/delay.h>
#include <linux/platform_device.h>
#include <linux/init.h>
#include <linux/input.h>
#include <linux/irq.h>
#include <linux/interrupt.h>
#include <linux/jiffies.h>
#include <linux/module.h>
#include <linux/gpio.h>
#include <linux/input/matrix_keypad.h>
#include <linux/slab.h>

struct matrix_keypad {
	const struct matrix_keypad_platform_data *pdata;
	struct input_dev *input_dev;
	unsigned short *keycodes;
	unsigned int row_shift;

	DECLARE_BITMAP(disabled_gpios, MATRIX_MAX_ROWS);

	uint32_t last_key_state[MATRIX_MAX_COLS];
	struct delayed_work work;
	spinlock_t lock;
	bool scan_pending;
	bool stopped;
};

/*
 * NOTE: normally the GPIO has to be put into HiZ when de-activated to cause
 * minmal side effect when scanning other columns, here it is configured to
 * be input, and it should work on most platforms.
 */
static void __activate_col(const struct matrix_keypad_platform_data *pdata,
			   int col, bool on)
{
	bool level_on = !pdata->active_low;

	if (on) {
		gpio_direction_output(pdata->col_gpios[col], level_on);
	} else {
		gpio_set_value_cansleep(pdata->col_gpios[col], !level_on);
		gpio_direction_input(pdata->col_gpios[col]);
	}
}

static void activate_col(const struct matrix_keypad_platform_data *pdata,
			 int col, bool on)
{
	__activate_col(pdata, col, on);

	if (on && pdata->col_scan_delay_us)
		udelay(pdata->col_scan_delay_us);
}

static void activate_all_cols(const struct matrix_keypad_platform_data *pdata,
			      bool on)
{
	int col;

	for (col = 0; col < pdata->num_col_gpios; col++)
		__activate_col(pdata, col, on);
}

static bool row_asserted(const struct matrix_keypad_platform_data *pdata,
			 int row)
{
	return gpio_get_value_cansleep(pdata->row_gpios[row]) ?
			!pdata->active_low : pdata->active_low;
}

static void enable_row_irqs(struct matrix_keypad *keypad)
{
	const struct matrix_keypad_platform_data *pdata = keypad->pdata;
	int i;

	for (i = 0; i < pdata->num_row_gpios; i++)
		enable_irq(gpio_to_irq(pdata->row_gpios[i]));
}

static void disable_row_irqs(struct matrix_keypad *keypad)
{
	const struct matrix_keypad_platform_data *pdata = keypad->pdata;
	int i;

	for (i = 0; i < pdata->num_row_gpios; i++)
		disable_irq_nosync(gpio_to_irq(pdata->row_gpios[i]));
}

/*
 * This gets the keys from keyboard and reports it to input subsystem
 */
static void matrix_keypad_scan(struct work_struct *work)
{
	struct matrix_keypad *keypad =
		container_of(work, struct matrix_keypad, work.work);
	struct input_dev *input_dev = keypad->input_dev;
	const struct matrix_keypad_platform_data *pdata = keypad->pdata;
	uint32_t new_state[MATRIX_MAX_COLS];
	int row, col, code;

	/* de-activate all columns for scanning */
	activate_all_cols(pdata, false);

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

	/* assert each column and read the row status out */
	for (col = 0; col < pdata->num_col_gpios; col++) {

		activate_col(pdata, col, true);

		for (row = 0; row < pdata->num_row_gpios; row++)
			new_state[col] |=
				row_asserted(pdata, row) ? (1 << row) : 0;

		activate_col(pdata, col, false);
	}

	for (col = 0; col < pdata->num_col_gpios; col++) {
		uint32_t bits_changed;

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

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

			code = MATRIX_SCAN_CODE(row, col, keypad->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->last_key_state, new_state, sizeof(new_state));

	activate_all_cols(pdata, true);

	/* Enable IRQs again */
	spin_lock_irq(&keypad->lock);
	keypad->scan_pending = false;
	enable_row_irqs(keypad);
	spin_unlock_irq(&keypad->lock);
}

static irqreturn_t matrix_keypad_interrupt(int irq, void *id)
{
	struct matrix_keypad *keypad = id;
	unsigned long flags;

	spin_lock_irqsave(&keypad->lock, flags);

	/*
	 * See if another IRQ beaten us to it and scheduled the
	 * scan already. In that case we should not try to
	 * disable IRQs again.
	 */
	if (unlikely(keypad->scan_pending || keypad->stopped))
		goto out;

	disable_row_irqs(keypad);
	keypad->scan_pending = true;
	schedule_delayed_work(&keypad->work,
		msecs_to_jiffies(keypad->pdata->debounce_ms));

out:
	spin_unlock_irqrestore(&keypad->lock, flags);
	return IRQ_HANDLED;
}

static int matrix_keypad_start(struct input_dev *dev)
{
	struct matrix_keypad *keypad = input_get_drvdata(dev);

	keypad->stopped = false;
	mb();

	/*
	 * Schedule an immediate key scan to capture current key state;
	 * columns will be activated and IRQs be enabled after the scan.
	 */
	schedule_delayed_work(&keypad->work, 0);

	return 0;
}

static void matrix_keypad_stop(struct input_dev *dev)
{
	struct matrix_keypad *keypad = input_get_drvdata(dev);

	keypad->stopped = true;
	mb();
	flush_work(&keypad->work.work);
	/*
	 * matrix_keypad_scan() will leave IRQs enabled;
	 * we should disable them now.
	 */
	disable_row_irqs(keypad);
}

#ifdef CONFIG_PM
static int matrix_keypad_suspend(struct device *dev)
{
	struct platform_device *pdev = to_platform_device(dev);
	struct matrix_keypad *keypad = platform_get_drvdata(pdev);
	const struct matrix_keypad_platform_data *pdata = keypad->pdata;
	int i;

	matrix_keypad_stop(keypad->input_dev);

	if (device_may_wakeup(&pdev->dev)) {
		for (i = 0; i < pdata->num_row_gpios; i++) {
			if (!test_bit(i, keypad->disabled_gpios)) {
				unsigned int gpio = pdata->row_gpios[i];

				if (enable_irq_wake(gpio_to_irq(gpio)) == 0)
					__set_bit(i, keypad->disabled_gpios);
			}
		}
	}

	return 0;
}

static int matrix_keypad_resume(struct device *dev)
{
	struct platform_device *pdev = to_platform_device(dev);
	struct matrix_keypad *keypad = platform_get_drvdata(pdev);
	const struct matrix_keypad_platform_data *pdata = keypad->pdata;
	int i;

	if (device_may_wakeup(&pdev->dev)) {
		for (i = 0; i < pdata->num_row_gpios; i++) {
			if (test_and_clear_bit(i, keypad->disabled_gpios)) {
				unsigned int gpio = pdata->row_gpios[i];

				disable_irq_wake(gpio_to_irq(gpio));
			}
		}
	}

	matrix_keypad_start(keypad->input_dev);

	return 0;
}

static const SIMPLE_DEV_PM_OPS(matrix_keypad_pm_ops,
				matrix_keypad_suspend, matrix_keypad_resume);
#endif

static int __devinit init_matrix_gpio(struct platform_device *pdev,
					struct matrix_keypad *keypad)
{
	const struct matrix_keypad_platform_data *pdata = keypad->pdata;
	int i, err = -EINVAL;

	/* initialized strobe lines as outputs, activated */
	for (i = 0; i < pdata->num_col_gpios; i++) {
		err = gpio_request(pdata->col_gpios[i], "matrix_kbd_col");
		if (err) {
			dev_err(&pdev->dev,
				"failed to request GPIO%d for COL%d\n",
				pdata->col_gpios[i], i);
			goto err_free_cols;
		}

		gpio_direction_output(pdata->col_gpios[i], !pdata->active_low);
	}

	for (i = 0; i < pdata->num_row_gpios; i++) {
		err = gpio_request(pdata->row_gpios[i], "matrix_kbd_row");
		if (err) {
			dev_err(&pdev->dev,
				"failed to request GPIO%d for ROW%d\n",
				pdata->row_gpios[i], i);
			goto err_free_rows;
		}

		gpio_direction_input(pdata->row_gpios[i]);
	}

	for (i = 0; i < pdata->num_row_gpios; i++) {
		err = request_irq(gpio_to_irq(pdata->row_gpios[i]),
				matrix_keypad_interrupt,
				IRQF_DISABLED |
				IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING,
				"matrix-keypad", keypad);
		if (err) {
			dev_err(&pdev->dev,
				"Unable to acquire interrupt for GPIO line %i\n",
				pdata->row_gpios[i]);
			goto err_free_irqs;
		}
	}

	/* initialized as disabled - enabled by input->open */
	disable_row_irqs(keypad);
	return 0;

err_free_irqs:
	while (--i >= 0)
		free_irq(gpio_to_irq(pdata->row_gpios[i]), keypad);
	i = pdata->num_row_gpios;
err_free_rows:
	while (--i >= 0)
		gpio_free(pdata->row_gpios[i]);
	i = pdata->num_col_gpios;
err_free_cols:
	while (--i >= 0)
		gpio_free(pdata->col_gpios[i]);

	return err;
}

static int __devinit matrix_keypad_probe(struct platform_device *pdev)
{
	const struct matrix_keypad_platform_data *pdata;
	const struct matrix_keymap_data *keymap_data;
	struct matrix_keypad *keypad;
	struct input_dev *input_dev;
	unsigned short *keycodes;
	unsigned int row_shift;
	int err;

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

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

	row_shift = get_count_order(pdata->num_col_gpios);

	keypad = kzalloc(sizeof(struct matrix_keypad), GFP_KERNEL);
	keycodes = kzalloc((pdata->num_row_gpios << row_shift) *
				sizeof(*keycodes),
			   GFP_KERNEL);
	input_dev = input_allocate_device();
	if (!keypad || !keycodes || !input_dev) {
		err = -ENOMEM;
		goto err_free_mem;
	}

	keypad->input_dev = input_dev;
	keypad->pdata = pdata;
	keypad->keycodes = keycodes;
	keypad->row_shift = row_shift;
	keypad->stopped = true;
	INIT_DELAYED_WORK(&keypad->work, matrix_keypad_scan);
	spin_lock_init(&keypad->lock);

	input_dev->name		= pdev->name;
	input_dev->id.bustype	= BUS_HOST;
	input_dev->dev.parent	= &pdev->dev;
	input_dev->evbit[0]	= BIT_MASK(EV_KEY) | BIT_MASK(EV_REP);
	input_dev->open		= matrix_keypad_start;
	input_dev->close	= matrix_keypad_stop;

	input_dev->keycode	= keycodes;
	input_dev->keycodesize	= sizeof(*keycodes);
	input_dev->keycodemax	= pdata->num_row_gpios << row_shift;

	matrix_keypad_build_keymap(keymap_data, row_shift,
				   input_dev->keycode, input_dev->keybit);

	input_set_capability(input_dev, EV_MSC, MSC_SCAN);
	input_set_drvdata(input_dev, keypad);

	err = init_matrix_gpio(pdev, keypad);
	if (err)
		goto err_free_mem;

	err = input_register_device(keypad->input_dev);
	if (err)
		goto err_free_mem;

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

	return 0;

err_free_mem:
	input_free_device(input_dev);
	kfree(keycodes);
	kfree(keypad);
	return err;
}

static int __devexit matrix_keypad_remove(struct platform_device *pdev)
{
	struct matrix_keypad *keypad = platform_get_drvdata(pdev);
	const struct matrix_keypad_platform_data *pdata = keypad->pdata;
	int i;

	device_init_wakeup(&pdev->dev, 0);

	for (i = 0; i < pdata->num_row_gpios; i++) {
		free_irq(gpio_to_irq(pdata->row_gpios[i]), keypad);
		gpio_free(pdata->row_gpios[i]);
	}

	for (i = 0; i < pdata->num_col_gpios; i++)
		gpio_free(pdata->col_gpios[i]);

	input_unregister_device(keypad->input_dev);
	platform_set_drvdata(pdev, NULL);
	kfree(keypad->keycodes);
	kfree(keypad);

	return 0;
}

static struct platform_driver matrix_keypad_driver = {
	.probe		= matrix_keypad_probe,
	.remove		= __devexit_p(matrix_keypad_remove),
	.driver		= {
		.name	= "matrix-keypad",
		.owner	= THIS_MODULE,
#ifdef CONFIG_PM
		.pm	= &matrix_keypad_pm_ops,
#endif
	},
};

static int __init matrix_keypad_init(void)
{
	return platform_driver_register(&matrix_keypad_driver);
}

static void __exit matrix_keypad_exit(void)
{
	platform_driver_unregister(&matrix_keypad_driver);
}

module_init(matrix_keypad_init);
module_exit(matrix_keypad_exit);

MODULE_AUTHOR("Marek Vasut <marek.vasut@gmail.com>");
MODULE_DESCRIPTION("GPIO Driven Matrix Keypad Driver");
MODULE_LICENSE("GPL v2");
MODULE_ALIAS("platform:matrix-keypad");
Commit	Line	Data
bab7614d EM	1	/*
	2	* GPIO driven matrix keyboard driver
	3	*
	4	* Copyright (c) 2008 Marek Vasut <marek.vasut@gmail.com>
	5	*
	6	* Based on corgikbd.c
	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	*/
	13
	14	#include <linux/types.h>
	15	#include <linux/delay.h>
	16	#include <linux/platform_device.h>
	17	#include <linux/init.h>
	18	#include <linux/input.h>
	19	#include <linux/irq.h>
	20	#include <linux/interrupt.h>
	21	#include <linux/jiffies.h>
	22	#include <linux/module.h>
	23	#include <linux/gpio.h>
	24	#include <linux/input/matrix_keypad.h>
5a0e3ad6	25	#include <linux/slab.h>
bab7614d EM	26
	27	struct matrix_keypad {
	28	const struct matrix_keypad_platform_data *pdata;
	29	struct input_dev *input_dev;
	30	unsigned short *keycodes;
d82f1c35	31	unsigned int row_shift;
bab7614d	32
dd219234 DT	33	DECLARE_BITMAP(disabled_gpios, MATRIX_MAX_ROWS);
dd219234 DT	34
bab7614d EM	35	uint32_t last_key_state[MATRIX_MAX_COLS];
bab7614d EM	36	struct delayed_work work;
dd219234	37	spinlock_t lock;
bab7614d EM	38	bool scan_pending;
bab7614d EM	39	bool stopped;
bab7614d EM	40	};
	41
	42	/*
	43	* NOTE: normally the GPIO has to be put into HiZ when de-activated to cause
	44	* minmal side effect when scanning other columns, here it is configured to
	45	* be input, and it should work on most platforms.
	46	*/
	47	static void __activate_col(const struct matrix_keypad_platform_data *pdata,
	48	int col, bool on)
	49	{
	50	bool level_on = !pdata->active_low;
	51
	52	if (on) {
	53	gpio_direction_output(pdata->col_gpios[col], level_on);
	54	} else {
	55	gpio_set_value_cansleep(pdata->col_gpios[col], !level_on);
	56	gpio_direction_input(pdata->col_gpios[col]);
	57	}
	58	}
	59
	60	static void activate_col(const struct matrix_keypad_platform_data *pdata,
	61	int col, bool on)
	62	{
	63	__activate_col(pdata, col, on);
	64
	65	if (on && pdata->col_scan_delay_us)
	66	udelay(pdata->col_scan_delay_us);
	67	}
	68
	69	static void activate_all_cols(const struct matrix_keypad_platform_data *pdata,
	70	bool on)
	71	{
	72	int col;
	73
	74	for (col = 0; col < pdata->num_col_gpios; col++)
	75	__activate_col(pdata, col, on);
	76	}
	77
	78	static bool row_asserted(const struct matrix_keypad_platform_data *pdata,
	79	int row)
	80	{
	81	return gpio_get_value_cansleep(pdata->row_gpios[row]) ?
	82	!pdata->active_low : pdata->active_low;
	83	}
	84
	85	static void enable_row_irqs(struct matrix_keypad *keypad)
	86	{
	87	const struct matrix_keypad_platform_data *pdata = keypad->pdata;
	88	int i;
	89
	90	for (i = 0; i < pdata->num_row_gpios; i++)
	91	enable_irq(gpio_to_irq(pdata->row_gpios[i]));
	92	}
	93
	94	static void disable_row_irqs(struct matrix_keypad *keypad)
	95	{
	96	const struct matrix_keypad_platform_data *pdata = keypad->pdata;
	97	int i;
	98
	99	for (i = 0; i < pdata->num_row_gpios; i++)
	100	disable_irq_nosync(gpio_to_irq(pdata->row_gpios[i]));
	101	}
	102
	103	/*
104	* This gets the keys from keyboard and reports it to input subsystem
105	*/
106	static void matrix_keypad_scan(struct work_struct *work)
107	{
108	struct matrix_keypad *keypad =
109	container_of(work, struct matrix_keypad, work.work);
110	struct input_dev *input_dev = keypad->input_dev;
111	const struct matrix_keypad_platform_data *pdata = keypad->pdata;
112	uint32_t new_state[MATRIX_MAX_COLS];
113	int row, col, code;
114
115	/* de-activate all columns for scanning */
116	activate_all_cols(pdata, false);
117
118	memset(new_state, 0, sizeof(new_state));
119
120	/* assert each column and read the row status out */
121	for (col = 0; col < pdata->num_col_gpios; col++) {
122
123	activate_col(pdata, col, true);
124
125	for (row = 0; row < pdata->num_row_gpios; row++)
126	new_state[col] \|=
127	row_asserted(pdata, row) ? (1 << row) : 0;
128
129	activate_col(pdata, col, false);
130	}
131
132	for (col = 0; col < pdata->num_col_gpios; col++) {
133	uint32_t bits_changed;
134
135	bits_changed = keypad->last_key_state[col] ^ new_state[col];
136	if (bits_changed == 0)
137	continue;
138
139	for (row = 0; row < pdata->num_row_gpios; row++) {
140	if ((bits_changed & (1 << row)) == 0)
141	continue;
142
d82f1c35	143	code = MATRIX_SCAN_CODE(row, col, keypad->row_shift);
bab7614d EM	144	input_event(input_dev, EV_MSC, MSC_SCAN, code);
	145	input_report_key(input_dev,
	146	keypad->keycodes[code],
	147	new_state[col] & (1 << row));
	148	}
	149	}
	150	input_sync(input_dev);
	151
	152	memcpy(keypad->last_key_state, new_state, sizeof(new_state));
	153
	154	activate_all_cols(pdata, true);
	155
	156	/* Enable IRQs again */
	157	spin_lock_irq(&keypad->lock);
	158	keypad->scan_pending = false;
	159	enable_row_irqs(keypad);
	160	spin_unlock_irq(&keypad->lock);
	161	}
	162
	163	static irqreturn_t matrix_keypad_interrupt(int irq, void *id)
	164	{
	165	struct matrix_keypad *keypad = id;
	166	unsigned long flags;
	167
	168	spin_lock_irqsave(&keypad->lock, flags);
	169
	170	/*
	171	* See if another IRQ beaten us to it and scheduled the
	172	* scan already. In that case we should not try to
	173	* disable IRQs again.
	174	*/
	175	if (unlikely(keypad->scan_pending \|\| keypad->stopped))
	176	goto out;
	177
	178	disable_row_irqs(keypad);
	179	keypad->scan_pending = true;
	180	schedule_delayed_work(&keypad->work,
	181	msecs_to_jiffies(keypad->pdata->debounce_ms));
	182
	183	out:
	184	spin_unlock_irqrestore(&keypad->lock, flags);
	185	return IRQ_HANDLED;
	186	}
	187
	188	static int matrix_keypad_start(struct input_dev *dev)
	189	{
	190	struct matrix_keypad *keypad = input_get_drvdata(dev);
	191
	192	keypad->stopped = false;
	193	mb();
	194
	195	/*
	196	* Schedule an immediate key scan to capture current key state;
	197	* columns will be activated and IRQs be enabled after the scan.
	198	*/
	199	schedule_delayed_work(&keypad->work, 0);
	200
	201	return 0;
	202	}
	203
	204	static void matrix_keypad_stop(struct input_dev *dev)
	205	{
	206	struct matrix_keypad *keypad = input_get_drvdata(dev);
	207
208	keypad->stopped = true;
209	mb();
210	flush_work(&keypad->work.work);
211	/*
212	* matrix_keypad_scan() will leave IRQs enabled;
213	* we should disable them now.
214	*/
215	disable_row_irqs(keypad);
216	}
217
218	#ifdef CONFIG_PM
f72a28ab	219	static int matrix_keypad_suspend(struct device *dev)
bab7614d	220	{
f72a28ab	221	struct platform_device *pdev = to_platform_device(dev);
bab7614d EM	222	struct matrix_keypad *keypad = platform_get_drvdata(pdev);
	223	const struct matrix_keypad_platform_data *pdata = keypad->pdata;
	224	int i;
	225
	226	matrix_keypad_stop(keypad->input_dev);
	227
dd219234 DT	228	if (device_may_wakeup(&pdev->dev)) {
	229	for (i = 0; i < pdata->num_row_gpios; i++) {
	230	if (!test_bit(i, keypad->disabled_gpios)) {
	231	unsigned int gpio = pdata->row_gpios[i];
	232
	233	if (enable_irq_wake(gpio_to_irq(gpio)) == 0)
	234	__set_bit(i, keypad->disabled_gpios);
	235	}
	236	}
	237	}
bab7614d EM	238
	239	return 0;
	240	}
	241
f72a28ab	242	static int matrix_keypad_resume(struct device *dev)
bab7614d	243	{
f72a28ab	244	struct platform_device *pdev = to_platform_device(dev);
bab7614d EM	245	struct matrix_keypad *keypad = platform_get_drvdata(pdev);
	246	const struct matrix_keypad_platform_data *pdata = keypad->pdata;
	247	int i;
	248
dd219234 DT	249	if (device_may_wakeup(&pdev->dev)) {
	250	for (i = 0; i < pdata->num_row_gpios; i++) {
	251	if (test_and_clear_bit(i, keypad->disabled_gpios)) {
	252	unsigned int gpio = pdata->row_gpios[i];
	253
	254	disable_irq_wake(gpio_to_irq(gpio));
	255	}
	256	}
	257	}
bab7614d EM	258
	259	matrix_keypad_start(keypad->input_dev);
	260
	261	return 0;
	262	}
f72a28ab DT	263
	264	static const SIMPLE_DEV_PM_OPS(matrix_keypad_pm_ops,
	265	matrix_keypad_suspend, matrix_keypad_resume);
bab7614d EM	266	#endif
	267
	268	static int __devinit init_matrix_gpio(struct platform_device *pdev,
	269	struct matrix_keypad *keypad)
	270	{
	271	const struct matrix_keypad_platform_data *pdata = keypad->pdata;
	272	int i, err = -EINVAL;
	273
	274	/* initialized strobe lines as outputs, activated */
	275	for (i = 0; i < pdata->num_col_gpios; i++) {
	276	err = gpio_request(pdata->col_gpios[i], "matrix_kbd_col");
	277	if (err) {
	278	dev_err(&pdev->dev,
	279	"failed to request GPIO%d for COL%d\n",
	280	pdata->col_gpios[i], i);
	281	goto err_free_cols;
	282	}
	283
	284	gpio_direction_output(pdata->col_gpios[i], !pdata->active_low);
	285	}
	286
	287	for (i = 0; i < pdata->num_row_gpios; i++) {
	288	err = gpio_request(pdata->row_gpios[i], "matrix_kbd_row");
	289	if (err) {
	290	dev_err(&pdev->dev,
	291	"failed to request GPIO%d for ROW%d\n",
	292	pdata->row_gpios[i], i);
	293	goto err_free_rows;
	294	}
	295
	296	gpio_direction_input(pdata->row_gpios[i]);
	297	}
	298
	299	for (i = 0; i < pdata->num_row_gpios; i++) {
	300	err = request_irq(gpio_to_irq(pdata->row_gpios[i]),
	301	matrix_keypad_interrupt,
	302	IRQF_DISABLED \|
	303	IRQF_TRIGGER_RISING \| IRQF_TRIGGER_FALLING,
	304	"matrix-keypad", keypad);
	305	if (err) {
	306	dev_err(&pdev->dev,
	307	"Unable to acquire interrupt for GPIO line %i\n",
	308	pdata->row_gpios[i]);
	309	goto err_free_irqs;
	310	}
	311	}
	312
	313	/* initialized as disabled - enabled by input->open */
	314	disable_row_irqs(keypad);
	315	return 0;
	316
	317	err_free_irqs:
	318	while (--i >= 0)
	319	free_irq(gpio_to_irq(pdata->row_gpios[i]), keypad);
	320	i = pdata->num_row_gpios;
	321	err_free_rows:
	322	while (--i >= 0)
	323	gpio_free(pdata->row_gpios[i]);
	324	i = pdata->num_col_gpios;
	325	err_free_cols:
	326	while (--i >= 0)
	327	gpio_free(pdata->col_gpios[i]);
	328
	329	return err;
330	}
331
332	static int __devinit matrix_keypad_probe(struct platform_device *pdev)
333	{
334	const struct matrix_keypad_platform_data *pdata;
335	const struct matrix_keymap_data *keymap_data;
336	struct matrix_keypad *keypad;
337	struct input_dev *input_dev;
338	unsigned short *keycodes;
d82f1c35	339	unsigned int row_shift;
bab7614d EM	340	int err;
	341
	342	pdata = pdev->dev.platform_data;
	343	if (!pdata) {
	344	dev_err(&pdev->dev, "no platform data defined\n");
	345	return -EINVAL;
	346	}
	347
	348	keymap_data = pdata->keymap_data;
	349	if (!keymap_data) {
	350	dev_err(&pdev->dev, "no keymap data defined\n");
	351	return -EINVAL;
	352	}
	353
d82f1c35	354	row_shift = get_count_order(pdata->num_col_gpios);
bab7614d EM	355
bab7614d EM	356	keypad = kzalloc(sizeof(struct matrix_keypad), GFP_KERNEL);
d82f1c35 EM	357	keycodes = kzalloc((pdata->num_row_gpios << row_shift) *
d82f1c35 EM	358	sizeof(*keycodes),
bab7614d EM	359	GFP_KERNEL);
	360	input_dev = input_allocate_device();
	361	if (!keypad \|\| !keycodes \|\| !input_dev) {
	362	err = -ENOMEM;
	363	goto err_free_mem;
	364	}
	365
	366	keypad->input_dev = input_dev;
	367	keypad->pdata = pdata;
	368	keypad->keycodes = keycodes;
d82f1c35	369	keypad->row_shift = row_shift;
bab7614d EM	370	keypad->stopped = true;
	371	INIT_DELAYED_WORK(&keypad->work, matrix_keypad_scan);
	372	spin_lock_init(&keypad->lock);
	373
	374	input_dev->name = pdev->name;
	375	input_dev->id.bustype = BUS_HOST;
	376	input_dev->dev.parent = &pdev->dev;
	377	input_dev->evbit[0] = BIT_MASK(EV_KEY) \| BIT_MASK(EV_REP);
	378	input_dev->open = matrix_keypad_start;
	379	input_dev->close = matrix_keypad_stop;
	380
	381	input_dev->keycode = keycodes;
	382	input_dev->keycodesize = sizeof(*keycodes);
77a53fd2	383	input_dev->keycodemax = pdata->num_row_gpios << row_shift;
bab7614d	384
77a53fd2 DT	385	matrix_keypad_build_keymap(keymap_data, row_shift,
77a53fd2 DT	386	input_dev->keycode, input_dev->keybit);
bab7614d EM	387
	388	input_set_capability(input_dev, EV_MSC, MSC_SCAN);
	389	input_set_drvdata(input_dev, keypad);
	390
	391	err = init_matrix_gpio(pdev, keypad);
	392	if (err)
	393	goto err_free_mem;
	394
	395	err = input_register_device(keypad->input_dev);
	396	if (err)
	397	goto err_free_mem;
	398
	399	device_init_wakeup(&pdev->dev, pdata->wakeup);
	400	platform_set_drvdata(pdev, keypad);
	401
	402	return 0;
	403
	404	err_free_mem:
	405	input_free_device(input_dev);
	406	kfree(keycodes);
	407	kfree(keypad);
	408	return err;
	409	}
	410
	411	static int __devexit matrix_keypad_remove(struct platform_device *pdev)
	412	{
	413	struct matrix_keypad *keypad = platform_get_drvdata(pdev);
	414	const struct matrix_keypad_platform_data *pdata = keypad->pdata;
	415	int i;
	416
	417	device_init_wakeup(&pdev->dev, 0);
	418
	419	for (i = 0; i < pdata->num_row_gpios; i++) {
	420	free_irq(gpio_to_irq(pdata->row_gpios[i]), keypad);
	421	gpio_free(pdata->row_gpios[i]);
	422	}
	423
	424	for (i = 0; i < pdata->num_col_gpios; i++)
	425	gpio_free(pdata->col_gpios[i]);
	426
	427	input_unregister_device(keypad->input_dev);
	428	platform_set_drvdata(pdev, NULL);
	429	kfree(keypad->keycodes);
	430	kfree(keypad);
	431
	432	return 0;
	433	}
	434
	435	static struct platform_driver matrix_keypad_driver = {
	436	.probe = matrix_keypad_probe,
	437	.remove = __devexit_p(matrix_keypad_remove),
bab7614d EM	438	.driver = {
	439	.name = "matrix-keypad",
	440	.owner = THIS_MODULE,
f72a28ab DT	441	#ifdef CONFIG_PM
	442	.pm = &matrix_keypad_pm_ops,
	443	#endif
bab7614d EM	444	},
	445	};
	446
	447	static int __init matrix_keypad_init(void)
	448	{
	449	return platform_driver_register(&matrix_keypad_driver);
	450	}
	451
	452	static void __exit matrix_keypad_exit(void)
	453	{
	454	platform_driver_unregister(&matrix_keypad_driver);
	455	}
	456
	457	module_init(matrix_keypad_init);
	458	module_exit(matrix_keypad_exit);
	459
	460	MODULE_AUTHOR("Marek Vasut <marek.vasut@gmail.com>");
	461	MODULE_DESCRIPTION("GPIO Driven Matrix Keypad Driver");
	462	MODULE_LICENSE("GPL v2");
	463	MODULE_ALIAS("platform:matrix-keypad");