[deliverable/linux.git] / drivers / input / touchscreen / wm831x-ts.c

/*
 * Touchscreen driver for WM831x PMICs
 *
 * Copyright 2011 Wolfson Microelectronics plc.
 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
 *
 * This program is free software; you can redistribute  it and/or modify it
 * under  the terms of  the GNU General  Public License as published by the
 * Free Software Foundation;  either version 2 of the  License, or (at your
 * option) any later version.
 */

#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/string.h>
#include <linux/pm.h>
#include <linux/input.h>
#include <linux/interrupt.h>
#include <linux/io.h>
#include <linux/mfd/wm831x/core.h>
#include <linux/mfd/wm831x/irq.h>
#include <linux/mfd/wm831x/pdata.h>
#include <linux/platform_device.h>
#include <linux/slab.h>
#include <linux/types.h>

/*
 * R16424 (0x4028) - Touch Control 1
 */
#define WM831X_TCH_ENA                          0x8000  /* TCH_ENA */
#define WM831X_TCH_CVT_ENA                      0x4000  /* TCH_CVT_ENA */
#define WM831X_TCH_SLPENA                       0x1000  /* TCH_SLPENA */
#define WM831X_TCH_Z_ENA                        0x0400  /* TCH_Z_ENA */
#define WM831X_TCH_Y_ENA                        0x0200  /* TCH_Y_ENA */
#define WM831X_TCH_X_ENA                        0x0100  /* TCH_X_ENA */
#define WM831X_TCH_DELAY_MASK                   0x00E0  /* TCH_DELAY - [7:5] */
#define WM831X_TCH_DELAY_SHIFT                       5  /* TCH_DELAY - [7:5] */
#define WM831X_TCH_DELAY_WIDTH                       3  /* TCH_DELAY - [7:5] */
#define WM831X_TCH_RATE_MASK                    0x001F  /* TCH_RATE - [4:0] */
#define WM831X_TCH_RATE_SHIFT                        0  /* TCH_RATE - [4:0] */
#define WM831X_TCH_RATE_WIDTH                        5  /* TCH_RATE - [4:0] */

/*
 * R16425 (0x4029) - Touch Control 2
 */
#define WM831X_TCH_PD_WK                        0x2000  /* TCH_PD_WK */
#define WM831X_TCH_5WIRE                        0x1000  /* TCH_5WIRE */
#define WM831X_TCH_PDONLY                       0x0800  /* TCH_PDONLY */
#define WM831X_TCH_ISEL                         0x0100  /* TCH_ISEL */
#define WM831X_TCH_RPU_MASK                     0x000F  /* TCH_RPU - [3:0] */
#define WM831X_TCH_RPU_SHIFT                         0  /* TCH_RPU - [3:0] */
#define WM831X_TCH_RPU_WIDTH                         4  /* TCH_RPU - [3:0] */

/*
 * R16426-8 (0x402A-C) - Touch Data X/Y/X
 */
#define WM831X_TCH_PD                           0x8000  /* TCH_PD1 */
#define WM831X_TCH_DATA_MASK                    0x0FFF  /* TCH_DATA - [11:0] */
#define WM831X_TCH_DATA_SHIFT                        0  /* TCH_DATA - [11:0] */
#define WM831X_TCH_DATA_WIDTH                       12  /* TCH_DATA - [11:0] */

struct wm831x_ts {
	struct input_dev *input_dev;
	struct wm831x *wm831x;
	unsigned int data_irq;
	unsigned int pd_irq;
	bool pressure;
	bool pen_down;
};

static irqreturn_t wm831x_ts_data_irq(int irq, void *irq_data)
{
	struct wm831x_ts *wm831x_ts = irq_data;
	struct wm831x *wm831x = wm831x_ts->wm831x;
	static int data_types[] = { ABS_X, ABS_Y, ABS_PRESSURE };
	u16 data[3];
	int count;
	int i, ret;

	if (wm831x_ts->pressure)
		count = 3;
	else
		count = 2;

	wm831x_set_bits(wm831x, WM831X_INTERRUPT_STATUS_1,
			WM831X_TCHDATA_EINT, WM831X_TCHDATA_EINT);

	ret = wm831x_bulk_read(wm831x, WM831X_TOUCH_DATA_X, count,
			       data);
	if (ret != 0) {
		dev_err(wm831x->dev, "Failed to read touch data: %d\n",
			ret);
		return IRQ_NONE;
	}

	/*
	 * We get a pen down reading on every reading, report pen up if any
	 * individual reading does so.
	 */
	wm831x_ts->pen_down = true;
	for (i = 0; i < count; i++) {
		if (!(data[i] & WM831X_TCH_PD)) {
			wm831x_ts->pen_down = false;
			continue;
		}
		input_report_abs(wm831x_ts->input_dev, data_types[i],
				 data[i] & WM831X_TCH_DATA_MASK);
	}

	if (!wm831x_ts->pen_down) {
		disable_irq_nosync(wm831x_ts->data_irq);

		/* Don't need data any more */
		wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_1,
				WM831X_TCH_X_ENA | WM831X_TCH_Y_ENA |
				WM831X_TCH_Z_ENA, 0);

		/* Flush any final samples that arrived while reading */
		wm831x_set_bits(wm831x, WM831X_INTERRUPT_STATUS_1,
				WM831X_TCHDATA_EINT, WM831X_TCHDATA_EINT);

		wm831x_bulk_read(wm831x, WM831X_TOUCH_DATA_X, count, data);

		if (wm831x_ts->pressure)
			input_report_abs(wm831x_ts->input_dev,
					 ABS_PRESSURE, 0);

		input_report_key(wm831x_ts->input_dev, BTN_TOUCH, 0);
	}

	input_sync(wm831x_ts->input_dev);

	return IRQ_HANDLED;
}

static irqreturn_t wm831x_ts_pen_down_irq(int irq, void *irq_data)
{
	struct wm831x_ts *wm831x_ts = irq_data;
	struct wm831x *wm831x = wm831x_ts->wm831x;
	int ena = 0;

	/* Start collecting data */
	if (wm831x_ts->pressure)
		ena |= WM831X_TCH_Z_ENA;

	wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_1,
			WM831X_TCH_X_ENA | WM831X_TCH_Y_ENA | WM831X_TCH_Z_ENA,
			WM831X_TCH_X_ENA | WM831X_TCH_Y_ENA | ena);

	input_report_key(wm831x_ts->input_dev, BTN_TOUCH, 1);
	input_sync(wm831x_ts->input_dev);

	wm831x_set_bits(wm831x, WM831X_INTERRUPT_STATUS_1,
			WM831X_TCHPD_EINT, WM831X_TCHPD_EINT);

	wm831x_ts->pen_down = true;
	enable_irq(wm831x_ts->data_irq);

	return IRQ_HANDLED;
}

static int wm831x_ts_input_open(struct input_dev *idev)
{
	struct wm831x_ts *wm831x_ts = input_get_drvdata(idev);
	struct wm831x *wm831x = wm831x_ts->wm831x;

	wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_1,
			WM831X_TCH_ENA, WM831X_TCH_ENA);

	wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_1,
			WM831X_TCH_CVT_ENA, WM831X_TCH_CVT_ENA);

	return 0;
}

static void wm831x_ts_input_close(struct input_dev *idev)
{
	struct wm831x_ts *wm831x_ts = input_get_drvdata(idev);
	struct wm831x *wm831x = wm831x_ts->wm831x;

	wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_1,
			WM831X_TCH_ENA | WM831X_TCH_CVT_ENA |
			WM831X_TCH_X_ENA | WM831X_TCH_Y_ENA |
			WM831X_TCH_Z_ENA, 0);

	if (wm831x_ts->pen_down)
		disable_irq(wm831x_ts->data_irq);
}

static __devinit int wm831x_ts_probe(struct platform_device *pdev)
{
	struct wm831x_ts *wm831x_ts;
	struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
	struct wm831x_pdata *core_pdata = dev_get_platdata(pdev->dev.parent);
	struct wm831x_touch_pdata *pdata = NULL;
	struct input_dev *input_dev;
	int error;

	if (core_pdata)
		pdata = core_pdata->touch;

	wm831x_ts = kzalloc(sizeof(struct wm831x_ts), GFP_KERNEL);
	input_dev = input_allocate_device();
	if (!wm831x_ts || !input_dev) {
		error = -ENOMEM;
		goto err_alloc;
	}

	wm831x_ts->wm831x = wm831x;
	wm831x_ts->input_dev = input_dev;

	/*
	 * If we have a direct IRQ use it, otherwise use the interrupt
	 * from the WM831x IRQ controller.
	 */
	if (pdata && pdata->data_irq)
		wm831x_ts->data_irq = pdata->data_irq;
	else
		wm831x_ts->data_irq = platform_get_irq_byname(pdev, "TCHDATA");

	if (pdata && pdata->pd_irq)
		wm831x_ts->pd_irq = pdata->pd_irq;
	else
		wm831x_ts->pd_irq = platform_get_irq_byname(pdev, "TCHPD");

	wm831x_ts->pressure = pdata && pdata->pressure;

	/* Five wire touchscreens can't report pressure */
	if (pdata && pdata->fivewire) {
		wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_2,
				WM831X_TCH_5WIRE, WM831X_TCH_5WIRE);

		/* Pressure measurements are not possible for five wire mode */
		WARN_ON(pdata->pressure && pdata->fivewire);
		wm831x_ts->pressure = false;
	} else {
		wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_2,
				WM831X_TCH_5WIRE, 0);
	}

	if (pdata) {
		switch (pdata->isel) {
		default:
			dev_err(&pdev->dev, "Unsupported ISEL setting: %d\n",
				pdata->isel);
			/* Fall through */
		case 200:
		case 0:
			wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_2,
					WM831X_TCH_ISEL, 0);
			break;
		case 400:
			wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_2,
					WM831X_TCH_ISEL, WM831X_TCH_ISEL);
			break;
		}
	}

	wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_2,
			WM831X_TCH_PDONLY, 0);

	/* Default to 96 samples/sec */
	wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_1,
			WM831X_TCH_RATE_MASK, 6);

	error = request_threaded_irq(wm831x_ts->data_irq,
				     NULL, wm831x_ts_data_irq,
				     IRQF_ONESHOT,
				     "Touchscreen data", wm831x_ts);
	if (error) {
		dev_err(&pdev->dev, "Failed to request data IRQ %d: %d\n",
			wm831x_ts->data_irq, error);
		goto err_alloc;
	}
	disable_irq(wm831x_ts->data_irq);

	error = request_threaded_irq(wm831x_ts->pd_irq,
				     NULL, wm831x_ts_pen_down_irq,
				     IRQF_ONESHOT,
				     "Touchscreen pen down", wm831x_ts);
	if (error) {
		dev_err(&pdev->dev, "Failed to request pen down IRQ %d: %d\n",
			wm831x_ts->pd_irq, error);
		goto err_data_irq;
	}

	/* set up touch configuration */
	input_dev->name = "WM831x touchscreen";
	input_dev->phys = "wm831x";
	input_dev->open = wm831x_ts_input_open;
	input_dev->close = wm831x_ts_input_close;

	__set_bit(EV_ABS, input_dev->evbit);
	__set_bit(EV_KEY, input_dev->evbit);
	__set_bit(BTN_TOUCH, input_dev->keybit);

	input_set_abs_params(input_dev, ABS_X, 0, 4095, 5, 0);
	input_set_abs_params(input_dev, ABS_Y, 0, 4095, 5, 0);
	if (wm831x_ts->pressure)
		input_set_abs_params(input_dev, ABS_PRESSURE, 0, 4095, 5, 0);

	input_set_drvdata(input_dev, wm831x_ts);
	input_dev->dev.parent = &pdev->dev;

	error = input_register_device(input_dev);
	if (error)
		goto err_pd_irq;

	platform_set_drvdata(pdev, wm831x_ts);
	return 0;

err_pd_irq:
	free_irq(wm831x_ts->pd_irq, wm831x_ts);
err_data_irq:
	free_irq(wm831x_ts->data_irq, wm831x_ts);
err_alloc:
	input_free_device(input_dev);
	kfree(wm831x_ts);

	return error;
}

static __devexit int wm831x_ts_remove(struct platform_device *pdev)
{
	struct wm831x_ts *wm831x_ts = platform_get_drvdata(pdev);

	free_irq(wm831x_ts->pd_irq, wm831x_ts);
	free_irq(wm831x_ts->data_irq, wm831x_ts);
	input_unregister_device(wm831x_ts->input_dev);
	kfree(wm831x_ts);

	platform_set_drvdata(pdev, NULL);
	return 0;
}

static struct platform_driver wm831x_ts_driver = {
	.driver = {
		.name = "wm831x-touch",
		.owner = THIS_MODULE,
	},
	.probe = wm831x_ts_probe,
	.remove = __devexit_p(wm831x_ts_remove),
};

static int __init wm831x_ts_init(void)
{
	return platform_driver_register(&wm831x_ts_driver);
}
module_init(wm831x_ts_init);

static void __exit wm831x_ts_exit(void)
{
	platform_driver_unregister(&wm831x_ts_driver);
}
module_exit(wm831x_ts_exit);

/* Module information */
MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
MODULE_DESCRIPTION("WM831x PMIC touchscreen driver");
MODULE_LICENSE("GPL");
MODULE_ALIAS("platform:wm831x-touch");
Commit	Line	Data
00cfa730 MB	1	/*
	2	* Touchscreen driver for WM831x PMICs
	3	*
	4	* Copyright 2011 Wolfson Microelectronics plc.
	5	* Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
	6	*
	7	* This program is free software; you can redistribute it and/or modify it
	8	* under the terms of the GNU General Public License as published by the
	9	* Free Software Foundation; either version 2 of the License, or (at your
	10	* option) any later version.
	11	*/
	12
	13	#include <linux/module.h>
	14	#include <linux/moduleparam.h>
	15	#include <linux/kernel.h>
	16	#include <linux/init.h>
	17	#include <linux/string.h>
	18	#include <linux/pm.h>
	19	#include <linux/input.h>
	20	#include <linux/interrupt.h>
	21	#include <linux/io.h>
	22	#include <linux/mfd/wm831x/core.h>
	23	#include <linux/mfd/wm831x/irq.h>
	24	#include <linux/mfd/wm831x/pdata.h>
	25	#include <linux/platform_device.h>
	26	#include <linux/slab.h>
	27	#include <linux/types.h>
	28
	29	/*
	30	* R16424 (0x4028) - Touch Control 1
	31	*/
	32	#define WM831X_TCH_ENA 0x8000 /* TCH_ENA */
	33	#define WM831X_TCH_CVT_ENA 0x4000 /* TCH_CVT_ENA */
	34	#define WM831X_TCH_SLPENA 0x1000 /* TCH_SLPENA */
	35	#define WM831X_TCH_Z_ENA 0x0400 /* TCH_Z_ENA */
	36	#define WM831X_TCH_Y_ENA 0x0200 /* TCH_Y_ENA */
	37	#define WM831X_TCH_X_ENA 0x0100 /* TCH_X_ENA */
	38	#define WM831X_TCH_DELAY_MASK 0x00E0 /* TCH_DELAY - [7:5] */
	39	#define WM831X_TCH_DELAY_SHIFT 5 /* TCH_DELAY - [7:5] */
	40	#define WM831X_TCH_DELAY_WIDTH 3 /* TCH_DELAY - [7:5] */
	41	#define WM831X_TCH_RATE_MASK 0x001F /* TCH_RATE - [4:0] */
	42	#define WM831X_TCH_RATE_SHIFT 0 /* TCH_RATE - [4:0] */
	43	#define WM831X_TCH_RATE_WIDTH 5 /* TCH_RATE - [4:0] */
	44
	45	/*
	46	* R16425 (0x4029) - Touch Control 2
	47	*/
	48	#define WM831X_TCH_PD_WK 0x2000 /* TCH_PD_WK */
	49	#define WM831X_TCH_5WIRE 0x1000 /* TCH_5WIRE */
	50	#define WM831X_TCH_PDONLY 0x0800 /* TCH_PDONLY */
	51	#define WM831X_TCH_ISEL 0x0100 /* TCH_ISEL */
	52	#define WM831X_TCH_RPU_MASK 0x000F /* TCH_RPU - [3:0] */
	53	#define WM831X_TCH_RPU_SHIFT 0 /* TCH_RPU - [3:0] */
	54	#define WM831X_TCH_RPU_WIDTH 4 /* TCH_RPU - [3:0] */
	55
	56	/*
	57	* R16426-8 (0x402A-C) - Touch Data X/Y/X
	58	*/
	59	#define WM831X_TCH_PD 0x8000 /* TCH_PD1 */
	60	#define WM831X_TCH_DATA_MASK 0x0FFF /* TCH_DATA - [11:0] */
	61	#define WM831X_TCH_DATA_SHIFT 0 /* TCH_DATA - [11:0] */
	62	#define WM831X_TCH_DATA_WIDTH 12 /* TCH_DATA - [11:0] */
	63
	64	struct wm831x_ts {
65	struct input_dev *input_dev;
66	struct wm831x *wm831x;
67	unsigned int data_irq;
68	unsigned int pd_irq;
69	bool pressure;
70	bool pen_down;
71	};
72
73	static irqreturn_t wm831x_ts_data_irq(int irq, void *irq_data)
74	{
75	struct wm831x_ts *wm831x_ts = irq_data;
76	struct wm831x *wm831x = wm831x_ts->wm831x;
77	static int data_types[] = { ABS_X, ABS_Y, ABS_PRESSURE };
78	u16 data[3];
723d9284	79	int count;
00cfa730 MB	80	int i, ret;
00cfa730 MB	81
723d9284 MB	82	if (wm831x_ts->pressure)
	83	count = 3;
	84	else
	85	count = 2;
	86
00cfa730 MB	87	wm831x_set_bits(wm831x, WM831X_INTERRUPT_STATUS_1,
	88	WM831X_TCHDATA_EINT, WM831X_TCHDATA_EINT);
	89
	90	ret = wm831x_bulk_read(wm831x, WM831X_TOUCH_DATA_X, count,
	91	data);
	92	if (ret != 0) {
	93	dev_err(wm831x->dev, "Failed to read touch data: %d\n",
	94	ret);
	95	return IRQ_NONE;
	96	}
	97
	98	/*
	99	* We get a pen down reading on every reading, report pen up if any
	100	* individual reading does so.
	101	*/
	102	wm831x_ts->pen_down = true;
	103	for (i = 0; i < count; i++) {
	104	if (!(data[i] & WM831X_TCH_PD)) {
	105	wm831x_ts->pen_down = false;
	106	continue;
	107	}
	108	input_report_abs(wm831x_ts->input_dev, data_types[i],
	109	data[i] & WM831X_TCH_DATA_MASK);
	110	}
	111
	112	if (!wm831x_ts->pen_down) {
	113	disable_irq_nosync(wm831x_ts->data_irq);
	114
	115	/* Don't need data any more */
	116	wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_1,
	117	WM831X_TCH_X_ENA \| WM831X_TCH_Y_ENA \|
	118	WM831X_TCH_Z_ENA, 0);
	119
	120	/* Flush any final samples that arrived while reading */
	121	wm831x_set_bits(wm831x, WM831X_INTERRUPT_STATUS_1,
	122	WM831X_TCHDATA_EINT, WM831X_TCHDATA_EINT);
	123
	124	wm831x_bulk_read(wm831x, WM831X_TOUCH_DATA_X, count, data);
	125
	126	if (wm831x_ts->pressure)
	127	input_report_abs(wm831x_ts->input_dev,
	128	ABS_PRESSURE, 0);
	129
	130	input_report_key(wm831x_ts->input_dev, BTN_TOUCH, 0);
	131	}
	132
	133	input_sync(wm831x_ts->input_dev);
	134
	135	return IRQ_HANDLED;
	136	}
	137
	138	static irqreturn_t wm831x_ts_pen_down_irq(int irq, void *irq_data)
	139	{
	140	struct wm831x_ts *wm831x_ts = irq_data;
	141	struct wm831x *wm831x = wm831x_ts->wm831x;
723d9284	142	int ena = 0;
00cfa730 MB	143
00cfa730 MB	144	/* Start collecting data */
723d9284 MB	145	if (wm831x_ts->pressure)
723d9284 MB	146	ena \|= WM831X_TCH_Z_ENA;
00cfa730 MB	147
	148	wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_1,
	149	WM831X_TCH_X_ENA \| WM831X_TCH_Y_ENA \| WM831X_TCH_Z_ENA,
	150	WM831X_TCH_X_ENA \| WM831X_TCH_Y_ENA \| ena);
	151
	152	input_report_key(wm831x_ts->input_dev, BTN_TOUCH, 1);
	153	input_sync(wm831x_ts->input_dev);
	154
	155	wm831x_set_bits(wm831x, WM831X_INTERRUPT_STATUS_1,
	156	WM831X_TCHPD_EINT, WM831X_TCHPD_EINT);
	157
	158	wm831x_ts->pen_down = true;
	159	enable_irq(wm831x_ts->data_irq);
	160
	161	return IRQ_HANDLED;
	162	}
	163
	164	static int wm831x_ts_input_open(struct input_dev *idev)
	165	{
	166	struct wm831x_ts *wm831x_ts = input_get_drvdata(idev);
	167	struct wm831x *wm831x = wm831x_ts->wm831x;
	168
	169	wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_1,
	170	WM831X_TCH_ENA, WM831X_TCH_ENA);
	171
	172	wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_1,
	173	WM831X_TCH_CVT_ENA, WM831X_TCH_CVT_ENA);
	174
	175	return 0;
	176	}
	177
	178	static void wm831x_ts_input_close(struct input_dev *idev)
	179	{
	180	struct wm831x_ts *wm831x_ts = input_get_drvdata(idev);
	181	struct wm831x *wm831x = wm831x_ts->wm831x;
	182
	183	wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_1,
	184	WM831X_TCH_ENA \| WM831X_TCH_CVT_ENA \|
	185	WM831X_TCH_X_ENA \| WM831X_TCH_Y_ENA \|
	186	WM831X_TCH_Z_ENA, 0);
	187
	188	if (wm831x_ts->pen_down)
	189	disable_irq(wm831x_ts->data_irq);
	190	}
	191
	192	static __devinit int wm831x_ts_probe(struct platform_device *pdev)
	193	{
	194	struct wm831x_ts *wm831x_ts;
	195	struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
	196	struct wm831x_pdata *core_pdata = dev_get_platdata(pdev->dev.parent);
723d9284	197	struct wm831x_touch_pdata *pdata = NULL;
00cfa730 MB	198	struct input_dev *input_dev;
	199	int error;
	200
723d9284 MB	201	if (core_pdata)
	202	pdata = core_pdata->touch;
	203
00cfa730 MB	204	wm831x_ts = kzalloc(sizeof(struct wm831x_ts), GFP_KERNEL);
	205	input_dev = input_allocate_device();
	206	if (!wm831x_ts \|\| !input_dev) {
	207	error = -ENOMEM;
	208	goto err_alloc;
	209	}
	210
	211	wm831x_ts->wm831x = wm831x;
	212	wm831x_ts->input_dev = input_dev;
	213
	214	/*
	215	* If we have a direct IRQ use it, otherwise use the interrupt
	216	* from the WM831x IRQ controller.
	217	*/
	218	if (pdata && pdata->data_irq)
	219	wm831x_ts->data_irq = pdata->data_irq;
	220	else
	221	wm831x_ts->data_irq = platform_get_irq_byname(pdev, "TCHDATA");
	222
	223	if (pdata && pdata->pd_irq)
	224	wm831x_ts->pd_irq = pdata->pd_irq;
	225	else
	226	wm831x_ts->pd_irq = platform_get_irq_byname(pdev, "TCHPD");
	227
	228	wm831x_ts->pressure = pdata && pdata->pressure;
	229
	230	/* Five wire touchscreens can't report pressure */
	231	if (pdata && pdata->fivewire) {
	232	wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_2,
	233	WM831X_TCH_5WIRE, WM831X_TCH_5WIRE);
	234
	235	/* Pressure measurements are not possible for five wire mode */
	236	WARN_ON(pdata->pressure && pdata->fivewire);
	237	wm831x_ts->pressure = false;
	238	} else {
	239	wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_2,
	240	WM831X_TCH_5WIRE, 0);
	241	}
	242
	243	if (pdata) {
	244	switch (pdata->isel) {
	245	default:
	246	dev_err(&pdev->dev, "Unsupported ISEL setting: %d\n",
	247	pdata->isel);
	248	/* Fall through */
	249	case 200:
	250	case 0:
	251	wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_2,
	252	WM831X_TCH_ISEL, 0);
	253	break;
	254	case 400:
	255	wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_2,
	256	WM831X_TCH_ISEL, WM831X_TCH_ISEL);
	257	break;
	258	}
	259	}
	260
	261	wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_2,
	262	WM831X_TCH_PDONLY, 0);
	263
	264	/* Default to 96 samples/sec */
	265	wm831x_set_bits(wm831x, WM831X_TOUCH_CONTROL_1,
	266	WM831X_TCH_RATE_MASK, 6);
	267
268	error = request_threaded_irq(wm831x_ts->data_irq,
269	NULL, wm831x_ts_data_irq,
270	IRQF_ONESHOT,
271	"Touchscreen data", wm831x_ts);
272	if (error) {
273	dev_err(&pdev->dev, "Failed to request data IRQ %d: %d\n",
274	wm831x_ts->data_irq, error);
275	goto err_alloc;
276	}
277	disable_irq(wm831x_ts->data_irq);
278
279	error = request_threaded_irq(wm831x_ts->pd_irq,
280	NULL, wm831x_ts_pen_down_irq,
281	IRQF_ONESHOT,
282	"Touchscreen pen down", wm831x_ts);
283	if (error) {
284	dev_err(&pdev->dev, "Failed to request pen down IRQ %d: %d\n",
285	wm831x_ts->pd_irq, error);
286	goto err_data_irq;
287	}
288
289	/* set up touch configuration */
290	input_dev->name = "WM831x touchscreen";
291	input_dev->phys = "wm831x";
292	input_dev->open = wm831x_ts_input_open;
293	input_dev->close = wm831x_ts_input_close;
294
295	__set_bit(EV_ABS, input_dev->evbit);
296	__set_bit(EV_KEY, input_dev->evbit);
297	__set_bit(BTN_TOUCH, input_dev->keybit);
298
299	input_set_abs_params(input_dev, ABS_X, 0, 4095, 5, 0);
300	input_set_abs_params(input_dev, ABS_Y, 0, 4095, 5, 0);
301	if (wm831x_ts->pressure)
302	input_set_abs_params(input_dev, ABS_PRESSURE, 0, 4095, 5, 0);
303
304	input_set_drvdata(input_dev, wm831x_ts);
305	input_dev->dev.parent = &pdev->dev;
306
307	error = input_register_device(input_dev);
308	if (error)
309	goto err_pd_irq;
310
311	platform_set_drvdata(pdev, wm831x_ts);
312	return 0;
313
314	err_pd_irq:
315	free_irq(wm831x_ts->pd_irq, wm831x_ts);
316	err_data_irq:
317	free_irq(wm831x_ts->data_irq, wm831x_ts);
318	err_alloc:
319	input_free_device(input_dev);
320	kfree(wm831x_ts);
321
322	return error;
323	}
324
325	static __devexit int wm831x_ts_remove(struct platform_device *pdev)
326	{
327	struct wm831x_ts *wm831x_ts = platform_get_drvdata(pdev);
328
329	free_irq(wm831x_ts->pd_irq, wm831x_ts);
330	free_irq(wm831x_ts->data_irq, wm831x_ts);
331	input_unregister_device(wm831x_ts->input_dev);
332	kfree(wm831x_ts);
333
334	platform_set_drvdata(pdev, NULL);
335	return 0;
336	}
337
338	static struct platform_driver wm831x_ts_driver = {
339	.driver = {
340	.name = "wm831x-touch",
341	.owner = THIS_MODULE,
342	},
343	.probe = wm831x_ts_probe,
344	.remove = __devexit_p(wm831x_ts_remove),
345	};
346
347	static int __init wm831x_ts_init(void)
348	{
349	return platform_driver_register(&wm831x_ts_driver);
350	}
351	module_init(wm831x_ts_init);
352
353	static void __exit wm831x_ts_exit(void)
354	{
355	platform_driver_unregister(&wm831x_ts_driver);
356	}
357	module_exit(wm831x_ts_exit);
358
359	/* Module information */
360	MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
361	MODULE_DESCRIPTION("WM831x PMIC touchscreen driver");
362	MODULE_LICENSE("GPL");
363	MODULE_ALIAS("platform:wm831x-touch");