Linux Audio

Check our new training course

Loading...
v3.15
  1/*
  2 * TSI driver for Dialog DA9052
  3 *
  4 * Copyright(c) 2012 Dialog Semiconductor Ltd.
  5 *
  6 * Author: David Dajun Chen <dchen@diasemi.com>
  7 *
  8 *  This program is free software; you can redistribute  it and/or modify it
  9 *  under  the terms of  the GNU General  Public License as published by the
 10 *  Free Software Foundation;  either version 2 of the  License, or (at your
 11 *  option) any later version.
 12 *
 13 */
 14#include <linux/module.h>
 15#include <linux/input.h>
 16#include <linux/delay.h>
 17#include <linux/platform_device.h>
 18#include <linux/interrupt.h>
 19
 20#include <linux/mfd/da9052/reg.h>
 21#include <linux/mfd/da9052/da9052.h>
 22
 23#define TSI_PEN_DOWN_STATUS 0x40
 24
 25struct da9052_tsi {
 26	struct da9052 *da9052;
 27	struct input_dev *dev;
 28	struct delayed_work ts_pen_work;
 29	struct mutex mutex;
 
 
 30	bool stopped;
 31	bool adc_on;
 32};
 33
 34static void da9052_ts_adc_toggle(struct da9052_tsi *tsi, bool on)
 35{
 36	da9052_reg_update(tsi->da9052, DA9052_TSI_CONT_A_REG, 1 << 0, on);
 37	tsi->adc_on = on;
 38}
 39
 40static irqreturn_t da9052_ts_pendwn_irq(int irq, void *data)
 41{
 42	struct da9052_tsi *tsi = data;
 43
 44	if (!tsi->stopped) {
 45		/* Mask PEN_DOWN event and unmask TSI_READY event */
 46		da9052_disable_irq_nosync(tsi->da9052, DA9052_IRQ_PENDOWN);
 47		da9052_enable_irq(tsi->da9052, DA9052_IRQ_TSIREADY);
 48
 49		da9052_ts_adc_toggle(tsi, true);
 50
 51		schedule_delayed_work(&tsi->ts_pen_work, HZ / 50);
 52	}
 53
 54	return IRQ_HANDLED;
 55}
 56
 57static void da9052_ts_read(struct da9052_tsi *tsi)
 58{
 59	struct input_dev *input = tsi->dev;
 60	int ret;
 61	u16 x, y, z;
 62	u8 v;
 63
 64	ret = da9052_reg_read(tsi->da9052, DA9052_TSI_X_MSB_REG);
 65	if (ret < 0)
 66		return;
 67
 68	x = (u16) ret;
 69
 70	ret = da9052_reg_read(tsi->da9052, DA9052_TSI_Y_MSB_REG);
 71	if (ret < 0)
 72		return;
 73
 74	y = (u16) ret;
 75
 76	ret = da9052_reg_read(tsi->da9052, DA9052_TSI_Z_MSB_REG);
 77	if (ret < 0)
 78		return;
 79
 80	z = (u16) ret;
 81
 82	ret = da9052_reg_read(tsi->da9052, DA9052_TSI_LSB_REG);
 83	if (ret < 0)
 84		return;
 85
 86	v = (u8) ret;
 87
 88	x = ((x << 2) & 0x3fc) | (v & 0x3);
 89	y = ((y << 2) & 0x3fc) | ((v & 0xc) >> 2);
 90	z = ((z << 2) & 0x3fc) | ((v & 0x30) >> 4);
 91
 92	input_report_key(input, BTN_TOUCH, 1);
 93	input_report_abs(input, ABS_X, x);
 94	input_report_abs(input, ABS_Y, y);
 95	input_report_abs(input, ABS_PRESSURE, z);
 96	input_sync(input);
 97}
 98
 99static irqreturn_t da9052_ts_datardy_irq(int irq, void *data)
100{
101	struct da9052_tsi *tsi = data;
102
103	da9052_ts_read(tsi);
104
105	return IRQ_HANDLED;
106}
107
108static void da9052_ts_pen_work(struct work_struct *work)
109{
110	struct da9052_tsi *tsi = container_of(work, struct da9052_tsi,
111					      ts_pen_work.work);
112	if (!tsi->stopped) {
113		int ret = da9052_reg_read(tsi->da9052, DA9052_TSI_LSB_REG);
114		if (ret < 0 || (ret & TSI_PEN_DOWN_STATUS)) {
115			/* Pen is still DOWN (or read error) */
116			schedule_delayed_work(&tsi->ts_pen_work, HZ / 50);
117		} else {
118			struct input_dev *input = tsi->dev;
119
120			/* Pen UP */
121			da9052_ts_adc_toggle(tsi, false);
122
123			/* Report Pen UP */
124			input_report_key(input, BTN_TOUCH, 0);
125			input_report_abs(input, ABS_PRESSURE, 0);
126			input_sync(input);
127
128			/*
129			 * FIXME: Fixes the unhandled irq issue when quick
130			 * pen down and pen up events occurs
131			 */
132			ret = da9052_reg_update(tsi->da9052,
133						DA9052_EVENT_B_REG, 0xC0, 0xC0);
134			if (ret < 0)
135				return;
136
137			/* Mask TSI_READY event and unmask PEN_DOWN event */
138			da9052_disable_irq(tsi->da9052, DA9052_IRQ_TSIREADY);
139			da9052_enable_irq(tsi->da9052, DA9052_IRQ_PENDOWN);
140		}
141	}
142}
143
144static int da9052_ts_configure_gpio(struct da9052 *da9052)
145{
146	int error;
147
148	error = da9052_reg_update(da9052, DA9052_GPIO_2_3_REG, 0x30, 0);
149	if (error < 0)
150		return error;
151
152	error = da9052_reg_update(da9052, DA9052_GPIO_4_5_REG, 0x33, 0);
153	if (error < 0)
154		return error;
155
156	error = da9052_reg_update(da9052, DA9052_GPIO_6_7_REG, 0x33, 0);
157	if (error < 0)
158		return error;
159
160	return 0;
161}
162
163static int da9052_configure_tsi(struct da9052_tsi *tsi)
164{
165	int error;
166
167	error = da9052_ts_configure_gpio(tsi->da9052);
168	if (error)
169		return error;
170
171	/* Measure TSI sample every 1ms */
172	error = da9052_reg_update(tsi->da9052, DA9052_ADC_CONT_REG,
173				  1 << 6, 1 << 6);
174	if (error < 0)
175		return error;
176
177	/* TSI_DELAY: 3 slots, TSI_SKIP: 0 slots, TSI_MODE: XYZP */
178	error = da9052_reg_update(tsi->da9052, DA9052_TSI_CONT_A_REG, 0xFC, 0xC0);
179	if (error < 0)
180		return error;
181
182	/* Supply TSIRef through LD09 */
183	error = da9052_reg_write(tsi->da9052, DA9052_LDO9_REG, 0x59);
184	if (error < 0)
185		return error;
186
187	return 0;
188}
189
190static int da9052_ts_input_open(struct input_dev *input_dev)
191{
192	struct da9052_tsi *tsi = input_get_drvdata(input_dev);
193
194	tsi->stopped = false;
195	mb();
196
197	/* Unmask PEN_DOWN event */
198	da9052_enable_irq(tsi->da9052, DA9052_IRQ_PENDOWN);
199
200	/* Enable Pen Detect Circuit */
201	return da9052_reg_update(tsi->da9052, DA9052_TSI_CONT_A_REG,
202				 1 << 1, 1 << 1);
203}
204
205static void da9052_ts_input_close(struct input_dev *input_dev)
206{
207	struct da9052_tsi *tsi = input_get_drvdata(input_dev);
208
209	tsi->stopped = true;
210	mb();
211	da9052_disable_irq(tsi->da9052, DA9052_IRQ_PENDOWN);
212	cancel_delayed_work_sync(&tsi->ts_pen_work);
213
214	if (tsi->adc_on) {
215		da9052_disable_irq(tsi->da9052, DA9052_IRQ_TSIREADY);
216		da9052_ts_adc_toggle(tsi, false);
217
218		/*
219		 * If ADC was on that means that pendwn IRQ was disabled
220		 * twice and we need to enable it to keep enable/disable
221		 * counter balanced. IRQ is still off though.
222		 */
223		da9052_enable_irq(tsi->da9052, DA9052_IRQ_PENDOWN);
224	}
225
226	/* Disable Pen Detect Circuit */
227	da9052_reg_update(tsi->da9052, DA9052_TSI_CONT_A_REG, 1 << 1, 0);
228}
229
230static int da9052_ts_probe(struct platform_device *pdev)
231{
232	struct da9052 *da9052;
233	struct da9052_tsi *tsi;
234	struct input_dev *input_dev;
 
 
235	int error;
236
237	da9052 = dev_get_drvdata(pdev->dev.parent);
238	if (!da9052)
239		return -EINVAL;
240
 
 
 
 
 
 
 
241	tsi = kzalloc(sizeof(struct da9052_tsi), GFP_KERNEL);
242	input_dev = input_allocate_device();
243	if (!tsi || !input_dev) {
244		error = -ENOMEM;
245		goto err_free_mem;
246	}
247
248	tsi->da9052 = da9052;
249	tsi->dev = input_dev;
 
 
250	tsi->stopped = true;
251	INIT_DELAYED_WORK(&tsi->ts_pen_work, da9052_ts_pen_work);
252
253	input_dev->id.version = 0x0101;
254	input_dev->id.vendor = 0x15B6;
255	input_dev->id.product = 0x9052;
256	input_dev->name = "Dialog DA9052 TouchScreen Driver";
257	input_dev->dev.parent = &pdev->dev;
258	input_dev->open = da9052_ts_input_open;
259	input_dev->close = da9052_ts_input_close;
260
261	__set_bit(EV_ABS, input_dev->evbit);
262	__set_bit(EV_KEY, input_dev->evbit);
263	__set_bit(BTN_TOUCH, input_dev->keybit);
264
265	input_set_abs_params(input_dev, ABS_X, 0, 1023, 0, 0);
266	input_set_abs_params(input_dev, ABS_Y, 0, 1023, 0, 0);
267	input_set_abs_params(input_dev, ABS_PRESSURE, 0, 1023, 0, 0);
268
269	input_set_drvdata(input_dev, tsi);
270
271	/* Disable Pen Detect Circuit */
272	da9052_reg_update(tsi->da9052, DA9052_TSI_CONT_A_REG, 1 << 1, 0);
273
274	/* Disable ADC */
275	da9052_ts_adc_toggle(tsi, false);
276
277	error = da9052_request_irq(tsi->da9052, DA9052_IRQ_PENDOWN,
278				"pendown-irq", da9052_ts_pendwn_irq, tsi);
 
 
279	if (error) {
280		dev_err(tsi->da9052->dev,
281			"Failed to register PENDWN IRQ: %d\n", error);
 
282		goto err_free_mem;
283	}
284
285	error = da9052_request_irq(tsi->da9052, DA9052_IRQ_TSIREADY,
286				"tsiready-irq", da9052_ts_datardy_irq, tsi);
 
 
287	if (error) {
288		dev_err(tsi->da9052->dev,
289			"Failed to register TSIRDY IRQ :%d\n", error);
 
290		goto err_free_pendwn_irq;
291	}
292
293	/* Mask PEN_DOWN and TSI_READY events */
294	da9052_disable_irq(tsi->da9052, DA9052_IRQ_PENDOWN);
295	da9052_disable_irq(tsi->da9052, DA9052_IRQ_TSIREADY);
296
297	error = da9052_configure_tsi(tsi);
298	if (error)
299		goto err_free_datardy_irq;
300
301	error = input_register_device(tsi->dev);
302	if (error)
303		goto err_free_datardy_irq;
304
305	platform_set_drvdata(pdev, tsi);
306
307	return 0;
308
309err_free_datardy_irq:
310	da9052_free_irq(tsi->da9052, DA9052_IRQ_TSIREADY, tsi);
311err_free_pendwn_irq:
312	da9052_free_irq(tsi->da9052, DA9052_IRQ_PENDOWN, tsi);
313err_free_mem:
314	kfree(tsi);
315	input_free_device(input_dev);
316
317	return error;
318}
319
320static int  da9052_ts_remove(struct platform_device *pdev)
321{
322	struct da9052_tsi *tsi = platform_get_drvdata(pdev);
323
324	da9052_reg_write(tsi->da9052, DA9052_LDO9_REG, 0x19);
325
326	da9052_free_irq(tsi->da9052, DA9052_IRQ_TSIREADY, tsi);
327	da9052_free_irq(tsi->da9052, DA9052_IRQ_PENDOWN, tsi);
328
329	input_unregister_device(tsi->dev);
330	kfree(tsi);
331
 
 
332	return 0;
333}
334
335static struct platform_driver da9052_tsi_driver = {
336	.probe	= da9052_ts_probe,
337	.remove	= da9052_ts_remove,
338	.driver	= {
339		.name	= "da9052-tsi",
340		.owner	= THIS_MODULE,
341	},
342};
343
344module_platform_driver(da9052_tsi_driver);
345
346MODULE_DESCRIPTION("Touchscreen driver for Dialog Semiconductor DA9052");
347MODULE_AUTHOR("Anthony Olech <Anthony.Olech@diasemi.com>");
348MODULE_LICENSE("GPL");
349MODULE_ALIAS("platform:da9052-tsi");
v3.5.6
  1/*
  2 * TSI driver for Dialog DA9052
  3 *
  4 * Copyright(c) 2012 Dialog Semiconductor Ltd.
  5 *
  6 * Author: David Dajun Chen <dchen@diasemi.com>
  7 *
  8 *  This program is free software; you can redistribute  it and/or modify it
  9 *  under  the terms of  the GNU General  Public License as published by the
 10 *  Free Software Foundation;  either version 2 of the  License, or (at your
 11 *  option) any later version.
 12 *
 13 */
 14#include <linux/module.h>
 15#include <linux/input.h>
 16#include <linux/delay.h>
 17#include <linux/platform_device.h>
 18#include <linux/interrupt.h>
 19
 20#include <linux/mfd/da9052/reg.h>
 21#include <linux/mfd/da9052/da9052.h>
 22
 23#define TSI_PEN_DOWN_STATUS 0x40
 24
 25struct da9052_tsi {
 26	struct da9052 *da9052;
 27	struct input_dev *dev;
 28	struct delayed_work ts_pen_work;
 29	struct mutex mutex;
 30	unsigned int irq_pendwn;
 31	unsigned int irq_datardy;
 32	bool stopped;
 33	bool adc_on;
 34};
 35
 36static void da9052_ts_adc_toggle(struct da9052_tsi *tsi, bool on)
 37{
 38	da9052_reg_update(tsi->da9052, DA9052_TSI_CONT_A_REG, 1 << 0, on);
 39	tsi->adc_on = on;
 40}
 41
 42static irqreturn_t da9052_ts_pendwn_irq(int irq, void *data)
 43{
 44	struct da9052_tsi *tsi = data;
 45
 46	if (!tsi->stopped) {
 47		/* Mask PEN_DOWN event and unmask TSI_READY event */
 48		disable_irq_nosync(tsi->irq_pendwn);
 49		enable_irq(tsi->irq_datardy);
 50
 51		da9052_ts_adc_toggle(tsi, true);
 52
 53		schedule_delayed_work(&tsi->ts_pen_work, HZ / 50);
 54	}
 55
 56	return IRQ_HANDLED;
 57}
 58
 59static void da9052_ts_read(struct da9052_tsi *tsi)
 60{
 61	struct input_dev *input = tsi->dev;
 62	int ret;
 63	u16 x, y, z;
 64	u8 v;
 65
 66	ret = da9052_reg_read(tsi->da9052, DA9052_TSI_X_MSB_REG);
 67	if (ret < 0)
 68		return;
 69
 70	x = (u16) ret;
 71
 72	ret = da9052_reg_read(tsi->da9052, DA9052_TSI_Y_MSB_REG);
 73	if (ret < 0)
 74		return;
 75
 76	y = (u16) ret;
 77
 78	ret = da9052_reg_read(tsi->da9052, DA9052_TSI_Z_MSB_REG);
 79	if (ret < 0)
 80		return;
 81
 82	z = (u16) ret;
 83
 84	ret = da9052_reg_read(tsi->da9052, DA9052_TSI_LSB_REG);
 85	if (ret < 0)
 86		return;
 87
 88	v = (u8) ret;
 89
 90	x = ((x << 2) & 0x3fc) | (v & 0x3);
 91	y = ((y << 2) & 0x3fc) | ((v & 0xc) >> 2);
 92	z = ((z << 2) & 0x3fc) | ((v & 0x30) >> 4);
 93
 94	input_report_key(input, BTN_TOUCH, 1);
 95	input_report_abs(input, ABS_X, x);
 96	input_report_abs(input, ABS_Y, y);
 97	input_report_abs(input, ABS_PRESSURE, z);
 98	input_sync(input);
 99}
100
101static irqreturn_t da9052_ts_datardy_irq(int irq, void *data)
102{
103	struct da9052_tsi *tsi = data;
104
105	da9052_ts_read(tsi);
106
107	return IRQ_HANDLED;
108}
109
110static void da9052_ts_pen_work(struct work_struct *work)
111{
112	struct da9052_tsi *tsi = container_of(work, struct da9052_tsi,
113					      ts_pen_work.work);
114	if (!tsi->stopped) {
115		int ret = da9052_reg_read(tsi->da9052, DA9052_TSI_LSB_REG);
116		if (ret < 0 || (ret & TSI_PEN_DOWN_STATUS)) {
117			/* Pen is still DOWN (or read error) */
118			schedule_delayed_work(&tsi->ts_pen_work, HZ / 50);
119		} else {
120			struct input_dev *input = tsi->dev;
121
122			/* Pen UP */
123			da9052_ts_adc_toggle(tsi, false);
124
125			/* Report Pen UP */
126			input_report_key(input, BTN_TOUCH, 0);
127			input_report_abs(input, ABS_PRESSURE, 0);
128			input_sync(input);
129
130			/*
131			 * FIXME: Fixes the unhandled irq issue when quick
132			 * pen down and pen up events occurs
133			 */
134			ret = da9052_reg_update(tsi->da9052,
135						DA9052_EVENT_B_REG, 0xC0, 0xC0);
136			if (ret < 0)
137				return;
138
139			/* Mask TSI_READY event and unmask PEN_DOWN event */
140			disable_irq(tsi->irq_datardy);
141			enable_irq(tsi->irq_pendwn);
142		}
143	}
144}
145
146static int __devinit da9052_ts_configure_gpio(struct da9052 *da9052)
147{
148	int error;
149
150	error = da9052_reg_update(da9052, DA9052_GPIO_2_3_REG, 0x30, 0);
151	if (error < 0)
152		return error;
153
154	error = da9052_reg_update(da9052, DA9052_GPIO_4_5_REG, 0x33, 0);
155	if (error < 0)
156		return error;
157
158	error = da9052_reg_update(da9052, DA9052_GPIO_6_7_REG, 0x33, 0);
159	if (error < 0)
160		return error;
161
162	return 0;
163}
164
165static int __devinit da9052_configure_tsi(struct da9052_tsi *tsi)
166{
167	int error;
168
169	error = da9052_ts_configure_gpio(tsi->da9052);
170	if (error)
171		return error;
172
173	/* Measure TSI sample every 1ms */
174	error = da9052_reg_update(tsi->da9052, DA9052_ADC_CONT_REG,
175				  1 << 6, 1 << 6);
176	if (error < 0)
177		return error;
178
179	/* TSI_DELAY: 3 slots, TSI_SKIP: 0 slots, TSI_MODE: XYZP */
180	error = da9052_reg_update(tsi->da9052, DA9052_TSI_CONT_A_REG, 0xFC, 0xC0);
181	if (error < 0)
182		return error;
183
184	/* Supply TSIRef through LD09 */
185	error = da9052_reg_write(tsi->da9052, DA9052_LDO9_REG, 0x59);
186	if (error < 0)
187		return error;
188
189	return 0;
190}
191
192static int da9052_ts_input_open(struct input_dev *input_dev)
193{
194	struct da9052_tsi *tsi = input_get_drvdata(input_dev);
195
196	tsi->stopped = false;
197	mb();
198
199	/* Unmask PEN_DOWN event */
200	enable_irq(tsi->irq_pendwn);
201
202	/* Enable Pen Detect Circuit */
203	return da9052_reg_update(tsi->da9052, DA9052_TSI_CONT_A_REG,
204				 1 << 1, 1 << 1);
205}
206
207static void da9052_ts_input_close(struct input_dev *input_dev)
208{
209	struct da9052_tsi *tsi = input_get_drvdata(input_dev);
210
211	tsi->stopped = true;
212	mb();
213	disable_irq(tsi->irq_pendwn);
214	cancel_delayed_work_sync(&tsi->ts_pen_work);
215
216	if (tsi->adc_on) {
217		disable_irq(tsi->irq_datardy);
218		da9052_ts_adc_toggle(tsi, false);
219
220		/*
221		 * If ADC was on that means that pendwn IRQ was disabled
222		 * twice and we need to enable it to keep enable/disable
223		 * counter balanced. IRQ is still off though.
224		 */
225		enable_irq(tsi->irq_pendwn);
226	}
227
228	/* Disable Pen Detect Circuit */
229	da9052_reg_update(tsi->da9052, DA9052_TSI_CONT_A_REG, 1 << 1, 0);
230}
231
232static int __devinit da9052_ts_probe(struct platform_device *pdev)
233{
234	struct da9052 *da9052;
235	struct da9052_tsi *tsi;
236	struct input_dev *input_dev;
237	int irq_pendwn;
238	int irq_datardy;
239	int error;
240
241	da9052 = dev_get_drvdata(pdev->dev.parent);
242	if (!da9052)
243		return -EINVAL;
244
245	irq_pendwn = platform_get_irq_byname(pdev, "PENDWN");
246	irq_datardy = platform_get_irq_byname(pdev, "TSIRDY");
247	if (irq_pendwn < 0 || irq_datardy < 0) {
248		dev_err(da9052->dev, "Unable to determine device interrupts\n");
249		return -ENXIO;
250	}
251
252	tsi = kzalloc(sizeof(struct da9052_tsi), GFP_KERNEL);
253	input_dev = input_allocate_device();
254	if (!tsi || !input_dev) {
255		error = -ENOMEM;
256		goto err_free_mem;
257	}
258
259	tsi->da9052 = da9052;
260	tsi->dev = input_dev;
261	tsi->irq_pendwn = da9052->irq_base + irq_pendwn;
262	tsi->irq_datardy = da9052->irq_base + irq_datardy;
263	tsi->stopped = true;
264	INIT_DELAYED_WORK(&tsi->ts_pen_work, da9052_ts_pen_work);
265
266	input_dev->id.version = 0x0101;
267	input_dev->id.vendor = 0x15B6;
268	input_dev->id.product = 0x9052;
269	input_dev->name = "Dialog DA9052 TouchScreen Driver";
270	input_dev->dev.parent = &pdev->dev;
271	input_dev->open = da9052_ts_input_open;
272	input_dev->close = da9052_ts_input_close;
273
274	__set_bit(EV_ABS, input_dev->evbit);
275	__set_bit(EV_KEY, input_dev->evbit);
276	__set_bit(BTN_TOUCH, input_dev->keybit);
277
278	input_set_abs_params(input_dev, ABS_X, 0, 1023, 0, 0);
279	input_set_abs_params(input_dev, ABS_Y, 0, 1023, 0, 0);
280	input_set_abs_params(input_dev, ABS_PRESSURE, 0, 1023, 0, 0);
281
282	input_set_drvdata(input_dev, tsi);
283
284	/* Disable Pen Detect Circuit */
285	da9052_reg_update(tsi->da9052, DA9052_TSI_CONT_A_REG, 1 << 1, 0);
286
287	/* Disable ADC */
288	da9052_ts_adc_toggle(tsi, false);
289
290	error = request_threaded_irq(tsi->irq_pendwn,
291				     NULL, da9052_ts_pendwn_irq,
292				     IRQF_TRIGGER_LOW | IRQF_ONESHOT,
293				     "PENDWN", tsi);
294	if (error) {
295		dev_err(tsi->da9052->dev,
296			"Failed to register PENDWN IRQ %d, error = %d\n",
297			tsi->irq_pendwn, error);
298		goto err_free_mem;
299	}
300
301	error = request_threaded_irq(tsi->irq_datardy,
302				     NULL, da9052_ts_datardy_irq,
303				     IRQF_TRIGGER_LOW | IRQF_ONESHOT,
304				     "TSIRDY", tsi);
305	if (error) {
306		dev_err(tsi->da9052->dev,
307			"Failed to register TSIRDY IRQ %d, error = %d\n",
308			tsi->irq_datardy, error);
309		goto err_free_pendwn_irq;
310	}
311
312	/* Mask PEN_DOWN and TSI_READY events */
313	disable_irq(tsi->irq_pendwn);
314	disable_irq(tsi->irq_datardy);
315
316	error = da9052_configure_tsi(tsi);
317	if (error)
318		goto err_free_datardy_irq;
319
320	error = input_register_device(tsi->dev);
321	if (error)
322		goto err_free_datardy_irq;
323
324	platform_set_drvdata(pdev, tsi);
325
326	return 0;
327
328err_free_datardy_irq:
329	free_irq(tsi->irq_datardy, tsi);
330err_free_pendwn_irq:
331	free_irq(tsi->irq_pendwn, tsi);
332err_free_mem:
333	kfree(tsi);
334	input_free_device(input_dev);
335
336	return error;
337}
338
339static int  __devexit da9052_ts_remove(struct platform_device *pdev)
340{
341	struct da9052_tsi *tsi = platform_get_drvdata(pdev);
342
343	da9052_reg_write(tsi->da9052, DA9052_LDO9_REG, 0x19);
344
345	free_irq(tsi->irq_pendwn, tsi);
346	free_irq(tsi->irq_datardy, tsi);
347
348	input_unregister_device(tsi->dev);
349	kfree(tsi);
350
351	platform_set_drvdata(pdev, NULL);
352
353	return 0;
354}
355
356static struct platform_driver da9052_tsi_driver = {
357	.probe	= da9052_ts_probe,
358	.remove	= __devexit_p(da9052_ts_remove),
359	.driver	= {
360		.name	= "da9052-tsi",
361		.owner	= THIS_MODULE,
362	},
363};
364
365module_platform_driver(da9052_tsi_driver);
366
367MODULE_DESCRIPTION("Touchscreen driver for Dialog Semiconductor DA9052");
368MODULE_AUTHOR("Anthony Olech <Anthony.Olech@diasemi.com>");
369MODULE_LICENSE("GPL");
370MODULE_ALIAS("platform:da9052-tsi");