1c6d81bd7SHeiko Stübner /*
2c6d81bd7SHeiko Stübner  * Copyright (C) 2012-2013 MundoReader S.L.
3c6d81bd7SHeiko Stübner  * Author: Heiko Stuebner <heiko@sntech.de>
4c6d81bd7SHeiko Stübner  *
5c6d81bd7SHeiko Stübner  * based in parts on Nook zforce driver
6c6d81bd7SHeiko Stübner  *
7c6d81bd7SHeiko Stübner  * Copyright (C) 2010 Barnes & Noble, Inc.
8c6d81bd7SHeiko Stübner  * Author: Pieter Truter<ptruter@intrinsyc.com>
9c6d81bd7SHeiko Stübner  *
10c6d81bd7SHeiko Stübner  * This software is licensed under the terms of the GNU General Public
11c6d81bd7SHeiko Stübner  * License version 2, as published by the Free Software Foundation, and
12c6d81bd7SHeiko Stübner  * may be copied, distributed, and modified under those terms.
13c6d81bd7SHeiko Stübner  *
14c6d81bd7SHeiko Stübner  * This program is distributed in the hope that it will be useful,
15c6d81bd7SHeiko Stübner  * but WITHOUT ANY WARRANTY; without even the implied warranty of
16c6d81bd7SHeiko Stübner  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
17c6d81bd7SHeiko Stübner  * GNU General Public License for more details.
18c6d81bd7SHeiko Stübner  */
19c6d81bd7SHeiko Stübner 
20c6d81bd7SHeiko Stübner #include <linux/module.h>
21c6d81bd7SHeiko Stübner #include <linux/hrtimer.h>
22c6d81bd7SHeiko Stübner #include <linux/slab.h>
23c6d81bd7SHeiko Stübner #include <linux/input.h>
24c6d81bd7SHeiko Stübner #include <linux/interrupt.h>
25c6d81bd7SHeiko Stübner #include <linux/i2c.h>
26c6d81bd7SHeiko Stübner #include <linux/delay.h>
27c6d81bd7SHeiko Stübner #include <linux/gpio.h>
28c6d81bd7SHeiko Stübner #include <linux/device.h>
29c6d81bd7SHeiko Stübner #include <linux/sysfs.h>
30c6d81bd7SHeiko Stübner #include <linux/input/mt.h>
31c6d81bd7SHeiko Stübner #include <linux/platform_data/zforce_ts.h>
32c6d81bd7SHeiko Stübner 
33c6d81bd7SHeiko Stübner #define WAIT_TIMEOUT		msecs_to_jiffies(1000)
34c6d81bd7SHeiko Stübner 
35c6d81bd7SHeiko Stübner #define FRAME_START		0xee
36c6d81bd7SHeiko Stübner 
37c6d81bd7SHeiko Stübner /* Offsets of the different parts of the payload the controller sends */
38c6d81bd7SHeiko Stübner #define PAYLOAD_HEADER		0
39c6d81bd7SHeiko Stübner #define PAYLOAD_LENGTH		1
40c6d81bd7SHeiko Stübner #define PAYLOAD_BODY		2
41c6d81bd7SHeiko Stübner 
42c6d81bd7SHeiko Stübner /* Response offsets */
43c6d81bd7SHeiko Stübner #define RESPONSE_ID		0
44c6d81bd7SHeiko Stübner #define RESPONSE_DATA		1
45c6d81bd7SHeiko Stübner 
46c6d81bd7SHeiko Stübner /* Commands */
47c6d81bd7SHeiko Stübner #define COMMAND_DEACTIVATE	0x00
48c6d81bd7SHeiko Stübner #define COMMAND_INITIALIZE	0x01
49c6d81bd7SHeiko Stübner #define COMMAND_RESOLUTION	0x02
50c6d81bd7SHeiko Stübner #define COMMAND_SETCONFIG	0x03
51c6d81bd7SHeiko Stübner #define COMMAND_DATAREQUEST	0x04
52c6d81bd7SHeiko Stübner #define COMMAND_SCANFREQ	0x08
53c6d81bd7SHeiko Stübner #define COMMAND_STATUS		0X1e
54c6d81bd7SHeiko Stübner 
55c6d81bd7SHeiko Stübner /*
56c6d81bd7SHeiko Stübner  * Responses the controller sends as a result of
57c6d81bd7SHeiko Stübner  * command requests
58c6d81bd7SHeiko Stübner  */
59c6d81bd7SHeiko Stübner #define RESPONSE_DEACTIVATE	0x00
60c6d81bd7SHeiko Stübner #define RESPONSE_INITIALIZE	0x01
61c6d81bd7SHeiko Stübner #define RESPONSE_RESOLUTION	0x02
62c6d81bd7SHeiko Stübner #define RESPONSE_SETCONFIG	0x03
63c6d81bd7SHeiko Stübner #define RESPONSE_SCANFREQ	0x08
64c6d81bd7SHeiko Stübner #define RESPONSE_STATUS		0X1e
65c6d81bd7SHeiko Stübner 
66c6d81bd7SHeiko Stübner /*
67c6d81bd7SHeiko Stübner  * Notifications are send by the touch controller without
68c6d81bd7SHeiko Stübner  * being requested by the driver and include for example
69c6d81bd7SHeiko Stübner  * touch indications
70c6d81bd7SHeiko Stübner  */
71c6d81bd7SHeiko Stübner #define NOTIFICATION_TOUCH		0x04
72c6d81bd7SHeiko Stübner #define NOTIFICATION_BOOTCOMPLETE	0x07
73c6d81bd7SHeiko Stübner #define NOTIFICATION_OVERRUN		0x25
74c6d81bd7SHeiko Stübner #define NOTIFICATION_PROXIMITY		0x26
75c6d81bd7SHeiko Stübner #define NOTIFICATION_INVALID_COMMAND	0xfe
76c6d81bd7SHeiko Stübner 
77c6d81bd7SHeiko Stübner #define ZFORCE_REPORT_POINTS		2
78c6d81bd7SHeiko Stübner #define ZFORCE_MAX_AREA			0xff
79c6d81bd7SHeiko Stübner 
80c6d81bd7SHeiko Stübner #define STATE_DOWN			0
81c6d81bd7SHeiko Stübner #define STATE_MOVE			1
82c6d81bd7SHeiko Stübner #define STATE_UP			2
83c6d81bd7SHeiko Stübner 
84c6d81bd7SHeiko Stübner #define SETCONFIG_DUALTOUCH		(1 << 0)
85c6d81bd7SHeiko Stübner 
86c6d81bd7SHeiko Stübner struct zforce_point {
87c6d81bd7SHeiko Stübner 	int coord_x;
88c6d81bd7SHeiko Stübner 	int coord_y;
89c6d81bd7SHeiko Stübner 	int state;
90c6d81bd7SHeiko Stübner 	int id;
91c6d81bd7SHeiko Stübner 	int area_major;
92c6d81bd7SHeiko Stübner 	int area_minor;
93c6d81bd7SHeiko Stübner 	int orientation;
94c6d81bd7SHeiko Stübner 	int pressure;
95c6d81bd7SHeiko Stübner 	int prblty;
96c6d81bd7SHeiko Stübner };
97c6d81bd7SHeiko Stübner 
98c6d81bd7SHeiko Stübner /*
99c6d81bd7SHeiko Stübner  * @client		the i2c_client
100c6d81bd7SHeiko Stübner  * @input		the input device
101c6d81bd7SHeiko Stübner  * @suspending		in the process of going to suspend (don't emit wakeup
102c6d81bd7SHeiko Stübner  *			events for commands executed to suspend the device)
103c6d81bd7SHeiko Stübner  * @suspended		device suspended
104c6d81bd7SHeiko Stübner  * @access_mutex	serialize i2c-access, to keep multipart reads together
105c6d81bd7SHeiko Stübner  * @command_done	completion to wait for the command result
106c6d81bd7SHeiko Stübner  * @command_mutex	serialize commands send to the ic
107c6d81bd7SHeiko Stübner  * @command_waiting	the id of the command that that is currently waiting
108c6d81bd7SHeiko Stübner  *			for a result
109c6d81bd7SHeiko Stübner  * @command_result	returned result of the command
110c6d81bd7SHeiko Stübner  */
111c6d81bd7SHeiko Stübner struct zforce_ts {
112c6d81bd7SHeiko Stübner 	struct i2c_client	*client;
113c6d81bd7SHeiko Stübner 	struct input_dev	*input;
114c6d81bd7SHeiko Stübner 	const struct zforce_ts_platdata *pdata;
115c6d81bd7SHeiko Stübner 	char			phys[32];
116c6d81bd7SHeiko Stübner 
117c6d81bd7SHeiko Stübner 	bool			suspending;
118c6d81bd7SHeiko Stübner 	bool			suspended;
119c6d81bd7SHeiko Stübner 	bool			boot_complete;
120c6d81bd7SHeiko Stübner 
121c6d81bd7SHeiko Stübner 	/* Firmware version information */
122c6d81bd7SHeiko Stübner 	u16			version_major;
123c6d81bd7SHeiko Stübner 	u16			version_minor;
124c6d81bd7SHeiko Stübner 	u16			version_build;
125c6d81bd7SHeiko Stübner 	u16			version_rev;
126c6d81bd7SHeiko Stübner 
127c6d81bd7SHeiko Stübner 	struct mutex		access_mutex;
128c6d81bd7SHeiko Stübner 
129c6d81bd7SHeiko Stübner 	struct completion	command_done;
130c6d81bd7SHeiko Stübner 	struct mutex		command_mutex;
131c6d81bd7SHeiko Stübner 	int			command_waiting;
132c6d81bd7SHeiko Stübner 	int			command_result;
133c6d81bd7SHeiko Stübner };
134c6d81bd7SHeiko Stübner 
135c6d81bd7SHeiko Stübner static int zforce_command(struct zforce_ts *ts, u8 cmd)
136c6d81bd7SHeiko Stübner {
137c6d81bd7SHeiko Stübner 	struct i2c_client *client = ts->client;
138c6d81bd7SHeiko Stübner 	char buf[3];
139c6d81bd7SHeiko Stübner 	int ret;
140c6d81bd7SHeiko Stübner 
141c6d81bd7SHeiko Stübner 	dev_dbg(&client->dev, "%s: 0x%x\n", __func__, cmd);
142c6d81bd7SHeiko Stübner 
143c6d81bd7SHeiko Stübner 	buf[0] = FRAME_START;
144c6d81bd7SHeiko Stübner 	buf[1] = 1; /* data size, command only */
145c6d81bd7SHeiko Stübner 	buf[2] = cmd;
146c6d81bd7SHeiko Stübner 
147c6d81bd7SHeiko Stübner 	mutex_lock(&ts->access_mutex);
148c6d81bd7SHeiko Stübner 	ret = i2c_master_send(client, &buf[0], ARRAY_SIZE(buf));
149c6d81bd7SHeiko Stübner 	mutex_unlock(&ts->access_mutex);
150c6d81bd7SHeiko Stübner 	if (ret < 0) {
151c6d81bd7SHeiko Stübner 		dev_err(&client->dev, "i2c send data request error: %d\n", ret);
152c6d81bd7SHeiko Stübner 		return ret;
153c6d81bd7SHeiko Stübner 	}
154c6d81bd7SHeiko Stübner 
155c6d81bd7SHeiko Stübner 	return 0;
156c6d81bd7SHeiko Stübner }
157c6d81bd7SHeiko Stübner 
158c6d81bd7SHeiko Stübner static int zforce_send_wait(struct zforce_ts *ts, const char *buf, int len)
159c6d81bd7SHeiko Stübner {
160c6d81bd7SHeiko Stübner 	struct i2c_client *client = ts->client;
161c6d81bd7SHeiko Stübner 	int ret;
162c6d81bd7SHeiko Stübner 
163c6d81bd7SHeiko Stübner 	ret = mutex_trylock(&ts->command_mutex);
164c6d81bd7SHeiko Stübner 	if (!ret) {
165c6d81bd7SHeiko Stübner 		dev_err(&client->dev, "already waiting for a command\n");
166c6d81bd7SHeiko Stübner 		return -EBUSY;
167c6d81bd7SHeiko Stübner 	}
168c6d81bd7SHeiko Stübner 
169c6d81bd7SHeiko Stübner 	dev_dbg(&client->dev, "sending %d bytes for command 0x%x\n",
170c6d81bd7SHeiko Stübner 		buf[1], buf[2]);
171c6d81bd7SHeiko Stübner 
172c6d81bd7SHeiko Stübner 	ts->command_waiting = buf[2];
173c6d81bd7SHeiko Stübner 
174c6d81bd7SHeiko Stübner 	mutex_lock(&ts->access_mutex);
175c6d81bd7SHeiko Stübner 	ret = i2c_master_send(client, buf, len);
176c6d81bd7SHeiko Stübner 	mutex_unlock(&ts->access_mutex);
177c6d81bd7SHeiko Stübner 	if (ret < 0) {
178c6d81bd7SHeiko Stübner 		dev_err(&client->dev, "i2c send data request error: %d\n", ret);
179c6d81bd7SHeiko Stübner 		goto unlock;
180c6d81bd7SHeiko Stübner 	}
181c6d81bd7SHeiko Stübner 
182c6d81bd7SHeiko Stübner 	dev_dbg(&client->dev, "waiting for result for command 0x%x\n", buf[2]);
183c6d81bd7SHeiko Stübner 
184c6d81bd7SHeiko Stübner 	if (wait_for_completion_timeout(&ts->command_done, WAIT_TIMEOUT) == 0) {
185c6d81bd7SHeiko Stübner 		ret = -ETIME;
186c6d81bd7SHeiko Stübner 		goto unlock;
187c6d81bd7SHeiko Stübner 	}
188c6d81bd7SHeiko Stübner 
189c6d81bd7SHeiko Stübner 	ret = ts->command_result;
190c6d81bd7SHeiko Stübner 
191c6d81bd7SHeiko Stübner unlock:
192c6d81bd7SHeiko Stübner 	mutex_unlock(&ts->command_mutex);
193c6d81bd7SHeiko Stübner 	return ret;
194c6d81bd7SHeiko Stübner }
195c6d81bd7SHeiko Stübner 
196c6d81bd7SHeiko Stübner static int zforce_command_wait(struct zforce_ts *ts, u8 cmd)
197c6d81bd7SHeiko Stübner {
198c6d81bd7SHeiko Stübner 	struct i2c_client *client = ts->client;
199c6d81bd7SHeiko Stübner 	char buf[3];
200c6d81bd7SHeiko Stübner 	int ret;
201c6d81bd7SHeiko Stübner 
202c6d81bd7SHeiko Stübner 	dev_dbg(&client->dev, "%s: 0x%x\n", __func__, cmd);
203c6d81bd7SHeiko Stübner 
204c6d81bd7SHeiko Stübner 	buf[0] = FRAME_START;
205c6d81bd7SHeiko Stübner 	buf[1] = 1; /* data size, command only */
206c6d81bd7SHeiko Stübner 	buf[2] = cmd;
207c6d81bd7SHeiko Stübner 
208c6d81bd7SHeiko Stübner 	ret = zforce_send_wait(ts, &buf[0], ARRAY_SIZE(buf));
209c6d81bd7SHeiko Stübner 	if (ret < 0) {
210c6d81bd7SHeiko Stübner 		dev_err(&client->dev, "i2c send data request error: %d\n", ret);
211c6d81bd7SHeiko Stübner 		return ret;
212c6d81bd7SHeiko Stübner 	}
213c6d81bd7SHeiko Stübner 
214c6d81bd7SHeiko Stübner 	return 0;
215c6d81bd7SHeiko Stübner }
216c6d81bd7SHeiko Stübner 
217c6d81bd7SHeiko Stübner static int zforce_resolution(struct zforce_ts *ts, u16 x, u16 y)
218c6d81bd7SHeiko Stübner {
219c6d81bd7SHeiko Stübner 	struct i2c_client *client = ts->client;
220c6d81bd7SHeiko Stübner 	char buf[7] = { FRAME_START, 5, COMMAND_RESOLUTION,
221c6d81bd7SHeiko Stübner 			(x & 0xff), ((x >> 8) & 0xff),
222c6d81bd7SHeiko Stübner 			(y & 0xff), ((y >> 8) & 0xff) };
223c6d81bd7SHeiko Stübner 
224c6d81bd7SHeiko Stübner 	dev_dbg(&client->dev, "set resolution to (%d,%d)\n", x, y);
225c6d81bd7SHeiko Stübner 
226c6d81bd7SHeiko Stübner 	return zforce_send_wait(ts, &buf[0], ARRAY_SIZE(buf));
227c6d81bd7SHeiko Stübner }
228c6d81bd7SHeiko Stübner 
229c6d81bd7SHeiko Stübner static int zforce_scan_frequency(struct zforce_ts *ts, u16 idle, u16 finger,
230c6d81bd7SHeiko Stübner 				 u16 stylus)
231c6d81bd7SHeiko Stübner {
232c6d81bd7SHeiko Stübner 	struct i2c_client *client = ts->client;
233c6d81bd7SHeiko Stübner 	char buf[9] = { FRAME_START, 7, COMMAND_SCANFREQ,
234c6d81bd7SHeiko Stübner 			(idle & 0xff), ((idle >> 8) & 0xff),
235c6d81bd7SHeiko Stübner 			(finger & 0xff), ((finger >> 8) & 0xff),
236c6d81bd7SHeiko Stübner 			(stylus & 0xff), ((stylus >> 8) & 0xff) };
237c6d81bd7SHeiko Stübner 
238c6d81bd7SHeiko Stübner 	dev_dbg(&client->dev, "set scan frequency to (idle: %d, finger: %d, stylus: %d)\n",
239c6d81bd7SHeiko Stübner 		idle, finger, stylus);
240c6d81bd7SHeiko Stübner 
241c6d81bd7SHeiko Stübner 	return zforce_send_wait(ts, &buf[0], ARRAY_SIZE(buf));
242c6d81bd7SHeiko Stübner }
243c6d81bd7SHeiko Stübner 
244c6d81bd7SHeiko Stübner static int zforce_setconfig(struct zforce_ts *ts, char b1)
245c6d81bd7SHeiko Stübner {
246c6d81bd7SHeiko Stübner 	struct i2c_client *client = ts->client;
247c6d81bd7SHeiko Stübner 	char buf[7] = { FRAME_START, 5, COMMAND_SETCONFIG,
248c6d81bd7SHeiko Stübner 			b1, 0, 0, 0 };
249c6d81bd7SHeiko Stübner 
250c6d81bd7SHeiko Stübner 	dev_dbg(&client->dev, "set config to (%d)\n", b1);
251c6d81bd7SHeiko Stübner 
252c6d81bd7SHeiko Stübner 	return zforce_send_wait(ts, &buf[0], ARRAY_SIZE(buf));
253c6d81bd7SHeiko Stübner }
254c6d81bd7SHeiko Stübner 
255c6d81bd7SHeiko Stübner static int zforce_start(struct zforce_ts *ts)
256c6d81bd7SHeiko Stübner {
257c6d81bd7SHeiko Stübner 	struct i2c_client *client = ts->client;
258c6d81bd7SHeiko Stübner 	const struct zforce_ts_platdata *pdata = dev_get_platdata(&client->dev);
259c6d81bd7SHeiko Stübner 	int ret;
260c6d81bd7SHeiko Stübner 
261c6d81bd7SHeiko Stübner 	dev_dbg(&client->dev, "starting device\n");
262c6d81bd7SHeiko Stübner 
263c6d81bd7SHeiko Stübner 	ret = zforce_command_wait(ts, COMMAND_INITIALIZE);
264c6d81bd7SHeiko Stübner 	if (ret) {
265c6d81bd7SHeiko Stübner 		dev_err(&client->dev, "Unable to initialize, %d\n", ret);
266c6d81bd7SHeiko Stübner 		return ret;
267c6d81bd7SHeiko Stübner 	}
268c6d81bd7SHeiko Stübner 
269c6d81bd7SHeiko Stübner 	ret = zforce_resolution(ts, pdata->x_max, pdata->y_max);
270c6d81bd7SHeiko Stübner 	if (ret) {
271c6d81bd7SHeiko Stübner 		dev_err(&client->dev, "Unable to set resolution, %d\n", ret);
272c6d81bd7SHeiko Stübner 		goto error;
273c6d81bd7SHeiko Stübner 	}
274c6d81bd7SHeiko Stübner 
275c6d81bd7SHeiko Stübner 	ret = zforce_scan_frequency(ts, 10, 50, 50);
276c6d81bd7SHeiko Stübner 	if (ret) {
277c6d81bd7SHeiko Stübner 		dev_err(&client->dev, "Unable to set scan frequency, %d\n",
278c6d81bd7SHeiko Stübner 			ret);
279c6d81bd7SHeiko Stübner 		goto error;
280c6d81bd7SHeiko Stübner 	}
281c6d81bd7SHeiko Stübner 
282c6d81bd7SHeiko Stübner 	if (zforce_setconfig(ts, SETCONFIG_DUALTOUCH)) {
283c6d81bd7SHeiko Stübner 		dev_err(&client->dev, "Unable to set config\n");
284c6d81bd7SHeiko Stübner 		goto error;
285c6d81bd7SHeiko Stübner 	}
286c6d81bd7SHeiko Stübner 
287c6d81bd7SHeiko Stübner 	/* start sending touch events */
288c6d81bd7SHeiko Stübner 	ret = zforce_command(ts, COMMAND_DATAREQUEST);
289c6d81bd7SHeiko Stübner 	if (ret) {
290c6d81bd7SHeiko Stübner 		dev_err(&client->dev, "Unable to request data\n");
291c6d81bd7SHeiko Stübner 		goto error;
292c6d81bd7SHeiko Stübner 	}
293c6d81bd7SHeiko Stübner 
294c6d81bd7SHeiko Stübner 	/*
295c6d81bd7SHeiko Stübner 	 * Per NN, initial cal. take max. of 200msec.
296c6d81bd7SHeiko Stübner 	 * Allow time to complete this calibration
297c6d81bd7SHeiko Stübner 	 */
298c6d81bd7SHeiko Stübner 	msleep(200);
299c6d81bd7SHeiko Stübner 
300c6d81bd7SHeiko Stübner 	return 0;
301c6d81bd7SHeiko Stübner 
302c6d81bd7SHeiko Stübner error:
303c6d81bd7SHeiko Stübner 	zforce_command_wait(ts, COMMAND_DEACTIVATE);
304c6d81bd7SHeiko Stübner 	return ret;
305c6d81bd7SHeiko Stübner }
306c6d81bd7SHeiko Stübner 
307c6d81bd7SHeiko Stübner static int zforce_stop(struct zforce_ts *ts)
308c6d81bd7SHeiko Stübner {
309c6d81bd7SHeiko Stübner 	struct i2c_client *client = ts->client;
310c6d81bd7SHeiko Stübner 	int ret;
311c6d81bd7SHeiko Stübner 
312c6d81bd7SHeiko Stübner 	dev_dbg(&client->dev, "stopping device\n");
313c6d81bd7SHeiko Stübner 
314c6d81bd7SHeiko Stübner 	/* Deactivates touch sensing and puts the device into sleep. */
315c6d81bd7SHeiko Stübner 	ret = zforce_command_wait(ts, COMMAND_DEACTIVATE);
316c6d81bd7SHeiko Stübner 	if (ret != 0) {
317c6d81bd7SHeiko Stübner 		dev_err(&client->dev, "could not deactivate device, %d\n",
318c6d81bd7SHeiko Stübner 			ret);
319c6d81bd7SHeiko Stübner 		return ret;
320c6d81bd7SHeiko Stübner 	}
321c6d81bd7SHeiko Stübner 
322c6d81bd7SHeiko Stübner 	return 0;
323c6d81bd7SHeiko Stübner }
324c6d81bd7SHeiko Stübner 
325c6d81bd7SHeiko Stübner static int zforce_touch_event(struct zforce_ts *ts, u8 *payload)
326c6d81bd7SHeiko Stübner {
327c6d81bd7SHeiko Stübner 	struct i2c_client *client = ts->client;
328c6d81bd7SHeiko Stübner 	const struct zforce_ts_platdata *pdata = dev_get_platdata(&client->dev);
329c6d81bd7SHeiko Stübner 	struct zforce_point point;
330c6d81bd7SHeiko Stübner 	int count, i, num = 0;
331c6d81bd7SHeiko Stübner 
332c6d81bd7SHeiko Stübner 	count = payload[0];
333c6d81bd7SHeiko Stübner 	if (count > ZFORCE_REPORT_POINTS) {
334c6d81bd7SHeiko Stübner 		dev_warn(&client->dev, "to many coordinates %d, expected max %d\n",
335c6d81bd7SHeiko Stübner 			 count, ZFORCE_REPORT_POINTS);
336c6d81bd7SHeiko Stübner 		count = ZFORCE_REPORT_POINTS;
337c6d81bd7SHeiko Stübner 	}
338c6d81bd7SHeiko Stübner 
339c6d81bd7SHeiko Stübner 	for (i = 0; i < count; i++) {
340c6d81bd7SHeiko Stübner 		point.coord_x =
341c6d81bd7SHeiko Stübner 			payload[9 * i + 2] << 8 | payload[9 * i + 1];
342c6d81bd7SHeiko Stübner 		point.coord_y =
343c6d81bd7SHeiko Stübner 			payload[9 * i + 4] << 8 | payload[9 * i + 3];
344c6d81bd7SHeiko Stübner 
345c6d81bd7SHeiko Stübner 		if (point.coord_x > pdata->x_max ||
346c6d81bd7SHeiko Stübner 		    point.coord_y > pdata->y_max) {
347c6d81bd7SHeiko Stübner 			dev_warn(&client->dev, "coordinates (%d,%d) invalid\n",
348c6d81bd7SHeiko Stübner 				point.coord_x, point.coord_y);
349c6d81bd7SHeiko Stübner 			point.coord_x = point.coord_y = 0;
350c6d81bd7SHeiko Stübner 		}
351c6d81bd7SHeiko Stübner 
352c6d81bd7SHeiko Stübner 		point.state = payload[9 * i + 5] & 0x03;
353c6d81bd7SHeiko Stübner 		point.id = (payload[9 * i + 5] & 0xfc) >> 2;
354c6d81bd7SHeiko Stübner 
355c6d81bd7SHeiko Stübner 		/* determine touch major, minor and orientation */
356c6d81bd7SHeiko Stübner 		point.area_major = max(payload[9 * i + 6],
357c6d81bd7SHeiko Stübner 					  payload[9 * i + 7]);
358c6d81bd7SHeiko Stübner 		point.area_minor = min(payload[9 * i + 6],
359c6d81bd7SHeiko Stübner 					  payload[9 * i + 7]);
360c6d81bd7SHeiko Stübner 		point.orientation = payload[9 * i + 6] > payload[9 * i + 7];
361c6d81bd7SHeiko Stübner 
362c6d81bd7SHeiko Stübner 		point.pressure = payload[9 * i + 8];
363c6d81bd7SHeiko Stübner 		point.prblty = payload[9 * i + 9];
364c6d81bd7SHeiko Stübner 
365c6d81bd7SHeiko Stübner 		dev_dbg(&client->dev,
366c6d81bd7SHeiko Stübner 			"point %d/%d: state %d, id %d, pressure %d, prblty %d, x %d, y %d, amajor %d, aminor %d, ori %d\n",
367c6d81bd7SHeiko Stübner 			i, count, point.state, point.id,
368c6d81bd7SHeiko Stübner 			point.pressure, point.prblty,
369c6d81bd7SHeiko Stübner 			point.coord_x, point.coord_y,
370c6d81bd7SHeiko Stübner 			point.area_major, point.area_minor,
371c6d81bd7SHeiko Stübner 			point.orientation);
372c6d81bd7SHeiko Stübner 
373c6d81bd7SHeiko Stübner 		/* the zforce id starts with "1", so needs to be decreased */
374c6d81bd7SHeiko Stübner 		input_mt_slot(ts->input, point.id - 1);
375c6d81bd7SHeiko Stübner 
376c6d81bd7SHeiko Stübner 		input_mt_report_slot_state(ts->input, MT_TOOL_FINGER,
377c6d81bd7SHeiko Stübner 						point.state != STATE_UP);
378c6d81bd7SHeiko Stübner 
379c6d81bd7SHeiko Stübner 		if (point.state != STATE_UP) {
380c6d81bd7SHeiko Stübner 			input_report_abs(ts->input, ABS_MT_POSITION_X,
381c6d81bd7SHeiko Stübner 					 point.coord_x);
382c6d81bd7SHeiko Stübner 			input_report_abs(ts->input, ABS_MT_POSITION_Y,
383c6d81bd7SHeiko Stübner 					 point.coord_y);
384c6d81bd7SHeiko Stübner 			input_report_abs(ts->input, ABS_MT_TOUCH_MAJOR,
385c6d81bd7SHeiko Stübner 					 point.area_major);
386c6d81bd7SHeiko Stübner 			input_report_abs(ts->input, ABS_MT_TOUCH_MINOR,
387c6d81bd7SHeiko Stübner 					 point.area_minor);
388c6d81bd7SHeiko Stübner 			input_report_abs(ts->input, ABS_MT_ORIENTATION,
389c6d81bd7SHeiko Stübner 					 point.orientation);
390c6d81bd7SHeiko Stübner 			num++;
391c6d81bd7SHeiko Stübner 		}
392c6d81bd7SHeiko Stübner 	}
393c6d81bd7SHeiko Stübner 
394c6d81bd7SHeiko Stübner 	input_mt_sync_frame(ts->input);
395c6d81bd7SHeiko Stübner 
396c6d81bd7SHeiko Stübner 	input_mt_report_finger_count(ts->input, num);
397c6d81bd7SHeiko Stübner 
398c6d81bd7SHeiko Stübner 	input_sync(ts->input);
399c6d81bd7SHeiko Stübner 
400c6d81bd7SHeiko Stübner 	return 0;
401c6d81bd7SHeiko Stübner }
402c6d81bd7SHeiko Stübner 
403c6d81bd7SHeiko Stübner static int zforce_read_packet(struct zforce_ts *ts, u8 *buf)
404c6d81bd7SHeiko Stübner {
405c6d81bd7SHeiko Stübner 	struct i2c_client *client = ts->client;
406c6d81bd7SHeiko Stübner 	int ret;
407c6d81bd7SHeiko Stübner 
408c6d81bd7SHeiko Stübner 	mutex_lock(&ts->access_mutex);
409c6d81bd7SHeiko Stübner 
410c6d81bd7SHeiko Stübner 	/* read 2 byte message header */
411c6d81bd7SHeiko Stübner 	ret = i2c_master_recv(client, buf, 2);
412c6d81bd7SHeiko Stübner 	if (ret < 0) {
413c6d81bd7SHeiko Stübner 		dev_err(&client->dev, "error reading header: %d\n", ret);
414c6d81bd7SHeiko Stübner 		goto unlock;
415c6d81bd7SHeiko Stübner 	}
416c6d81bd7SHeiko Stübner 
417c6d81bd7SHeiko Stübner 	if (buf[PAYLOAD_HEADER] != FRAME_START) {
418c6d81bd7SHeiko Stübner 		dev_err(&client->dev, "invalid frame start: %d\n", buf[0]);
419c6d81bd7SHeiko Stübner 		ret = -EIO;
420c6d81bd7SHeiko Stübner 		goto unlock;
421c6d81bd7SHeiko Stübner 	}
422c6d81bd7SHeiko Stübner 
423c6d81bd7SHeiko Stübner 	if (buf[PAYLOAD_LENGTH] <= 0 || buf[PAYLOAD_LENGTH] > 255) {
424c6d81bd7SHeiko Stübner 		dev_err(&client->dev, "invalid payload length: %d\n",
425c6d81bd7SHeiko Stübner 			buf[PAYLOAD_LENGTH]);
426c6d81bd7SHeiko Stübner 		ret = -EIO;
427c6d81bd7SHeiko Stübner 		goto unlock;
428c6d81bd7SHeiko Stübner 	}
429c6d81bd7SHeiko Stübner 
430c6d81bd7SHeiko Stübner 	/* read the message */
431c6d81bd7SHeiko Stübner 	ret = i2c_master_recv(client, &buf[PAYLOAD_BODY], buf[PAYLOAD_LENGTH]);
432c6d81bd7SHeiko Stübner 	if (ret < 0) {
433c6d81bd7SHeiko Stübner 		dev_err(&client->dev, "error reading payload: %d\n", ret);
434c6d81bd7SHeiko Stübner 		goto unlock;
435c6d81bd7SHeiko Stübner 	}
436c6d81bd7SHeiko Stübner 
437c6d81bd7SHeiko Stübner 	dev_dbg(&client->dev, "read %d bytes for response command 0x%x\n",
438c6d81bd7SHeiko Stübner 		buf[PAYLOAD_LENGTH], buf[PAYLOAD_BODY]);
439c6d81bd7SHeiko Stübner 
440c6d81bd7SHeiko Stübner unlock:
441c6d81bd7SHeiko Stübner 	mutex_unlock(&ts->access_mutex);
442c6d81bd7SHeiko Stübner 	return ret;
443c6d81bd7SHeiko Stübner }
444c6d81bd7SHeiko Stübner 
445c6d81bd7SHeiko Stübner static void zforce_complete(struct zforce_ts *ts, int cmd, int result)
446c6d81bd7SHeiko Stübner {
447c6d81bd7SHeiko Stübner 	struct i2c_client *client = ts->client;
448c6d81bd7SHeiko Stübner 
449c6d81bd7SHeiko Stübner 	if (ts->command_waiting == cmd) {
450c6d81bd7SHeiko Stübner 		dev_dbg(&client->dev, "completing command 0x%x\n", cmd);
451c6d81bd7SHeiko Stübner 		ts->command_result = result;
452c6d81bd7SHeiko Stübner 		complete(&ts->command_done);
453c6d81bd7SHeiko Stübner 	} else {
454c6d81bd7SHeiko Stübner 		dev_dbg(&client->dev, "command %d not for us\n", cmd);
455c6d81bd7SHeiko Stübner 	}
456c6d81bd7SHeiko Stübner }
457c6d81bd7SHeiko Stübner 
458499e6127SHeiko Stübner static irqreturn_t zforce_irq(int irq, void *dev_id)
459499e6127SHeiko Stübner {
460499e6127SHeiko Stübner 	struct zforce_ts *ts = dev_id;
461499e6127SHeiko Stübner 	struct i2c_client *client = ts->client;
462499e6127SHeiko Stübner 
463499e6127SHeiko Stübner 	if (ts->suspended && device_may_wakeup(&client->dev))
464499e6127SHeiko Stübner 		pm_wakeup_event(&client->dev, 500);
465499e6127SHeiko Stübner 
466499e6127SHeiko Stübner 	return IRQ_WAKE_THREAD;
467499e6127SHeiko Stübner }
468499e6127SHeiko Stübner 
469499e6127SHeiko Stübner static irqreturn_t zforce_irq_thread(int irq, void *dev_id)
470c6d81bd7SHeiko Stübner {
471c6d81bd7SHeiko Stübner 	struct zforce_ts *ts = dev_id;
472c6d81bd7SHeiko Stübner 	struct i2c_client *client = ts->client;
473c6d81bd7SHeiko Stübner 	const struct zforce_ts_platdata *pdata = dev_get_platdata(&client->dev);
474c6d81bd7SHeiko Stübner 	int ret;
475c6d81bd7SHeiko Stübner 	u8 payload_buffer[512];
476c6d81bd7SHeiko Stübner 	u8 *payload;
477c6d81bd7SHeiko Stübner 
478c6d81bd7SHeiko Stübner 	/*
479499e6127SHeiko Stübner 	 * When still suspended, return.
480c6d81bd7SHeiko Stübner 	 * Due to the level-interrupt we will get re-triggered later.
481c6d81bd7SHeiko Stübner 	 */
482c6d81bd7SHeiko Stübner 	if (ts->suspended) {
483c6d81bd7SHeiko Stübner 		msleep(20);
484c6d81bd7SHeiko Stübner 		return IRQ_HANDLED;
485c6d81bd7SHeiko Stübner 	}
486c6d81bd7SHeiko Stübner 
487c6d81bd7SHeiko Stübner 	dev_dbg(&client->dev, "handling interrupt\n");
488c6d81bd7SHeiko Stübner 
489c6d81bd7SHeiko Stübner 	/* Don't emit wakeup events from commands run by zforce_suspend */
490c6d81bd7SHeiko Stübner 	if (!ts->suspending && device_may_wakeup(&client->dev))
491c6d81bd7SHeiko Stübner 		pm_stay_awake(&client->dev);
492c6d81bd7SHeiko Stübner 
493c6d81bd7SHeiko Stübner 	while (!gpio_get_value(pdata->gpio_int)) {
494c6d81bd7SHeiko Stübner 		ret = zforce_read_packet(ts, payload_buffer);
495c6d81bd7SHeiko Stübner 		if (ret < 0) {
496c6d81bd7SHeiko Stübner 			dev_err(&client->dev, "could not read packet, ret: %d\n",
497c6d81bd7SHeiko Stübner 				ret);
498c6d81bd7SHeiko Stübner 			break;
499c6d81bd7SHeiko Stübner 		}
500c6d81bd7SHeiko Stübner 
501c6d81bd7SHeiko Stübner 		payload =  &payload_buffer[PAYLOAD_BODY];
502c6d81bd7SHeiko Stübner 
503c6d81bd7SHeiko Stübner 		switch (payload[RESPONSE_ID]) {
504c6d81bd7SHeiko Stübner 		case NOTIFICATION_TOUCH:
505c6d81bd7SHeiko Stübner 			/*
506c6d81bd7SHeiko Stübner 			 * Always report touch-events received while
507c6d81bd7SHeiko Stübner 			 * suspending, when being a wakeup source
508c6d81bd7SHeiko Stübner 			 */
509c6d81bd7SHeiko Stübner 			if (ts->suspending && device_may_wakeup(&client->dev))
510c6d81bd7SHeiko Stübner 				pm_wakeup_event(&client->dev, 500);
511c6d81bd7SHeiko Stübner 			zforce_touch_event(ts, &payload[RESPONSE_DATA]);
512c6d81bd7SHeiko Stübner 			break;
513c6d81bd7SHeiko Stübner 
514c6d81bd7SHeiko Stübner 		case NOTIFICATION_BOOTCOMPLETE:
515c6d81bd7SHeiko Stübner 			ts->boot_complete = payload[RESPONSE_DATA];
516c6d81bd7SHeiko Stübner 			zforce_complete(ts, payload[RESPONSE_ID], 0);
517c6d81bd7SHeiko Stübner 			break;
518c6d81bd7SHeiko Stübner 
519c6d81bd7SHeiko Stübner 		case RESPONSE_INITIALIZE:
520c6d81bd7SHeiko Stübner 		case RESPONSE_DEACTIVATE:
521c6d81bd7SHeiko Stübner 		case RESPONSE_SETCONFIG:
522c6d81bd7SHeiko Stübner 		case RESPONSE_RESOLUTION:
523c6d81bd7SHeiko Stübner 		case RESPONSE_SCANFREQ:
524c6d81bd7SHeiko Stübner 			zforce_complete(ts, payload[RESPONSE_ID],
525c6d81bd7SHeiko Stübner 					payload[RESPONSE_DATA]);
526c6d81bd7SHeiko Stübner 			break;
527c6d81bd7SHeiko Stübner 
528c6d81bd7SHeiko Stübner 		case RESPONSE_STATUS:
529c6d81bd7SHeiko Stübner 			/*
530c6d81bd7SHeiko Stübner 			 * Version Payload Results
531c6d81bd7SHeiko Stübner 			 * [2:major] [2:minor] [2:build] [2:rev]
532c6d81bd7SHeiko Stübner 			 */
533c6d81bd7SHeiko Stübner 			ts->version_major = (payload[RESPONSE_DATA + 1] << 8) |
534c6d81bd7SHeiko Stübner 						payload[RESPONSE_DATA];
535c6d81bd7SHeiko Stübner 			ts->version_minor = (payload[RESPONSE_DATA + 3] << 8) |
536c6d81bd7SHeiko Stübner 						payload[RESPONSE_DATA + 2];
537c6d81bd7SHeiko Stübner 			ts->version_build = (payload[RESPONSE_DATA + 5] << 8) |
538c6d81bd7SHeiko Stübner 						payload[RESPONSE_DATA + 4];
539c6d81bd7SHeiko Stübner 			ts->version_rev   = (payload[RESPONSE_DATA + 7] << 8) |
540c6d81bd7SHeiko Stübner 						payload[RESPONSE_DATA + 6];
541c6d81bd7SHeiko Stübner 			dev_dbg(&ts->client->dev, "Firmware Version %04x:%04x %04x:%04x\n",
542c6d81bd7SHeiko Stübner 				ts->version_major, ts->version_minor,
543c6d81bd7SHeiko Stübner 				ts->version_build, ts->version_rev);
544c6d81bd7SHeiko Stübner 
545c6d81bd7SHeiko Stübner 			zforce_complete(ts, payload[RESPONSE_ID], 0);
546c6d81bd7SHeiko Stübner 			break;
547c6d81bd7SHeiko Stübner 
548c6d81bd7SHeiko Stübner 		case NOTIFICATION_INVALID_COMMAND:
549c6d81bd7SHeiko Stübner 			dev_err(&ts->client->dev, "invalid command: 0x%x\n",
550c6d81bd7SHeiko Stübner 				payload[RESPONSE_DATA]);
551c6d81bd7SHeiko Stübner 			break;
552c6d81bd7SHeiko Stübner 
553c6d81bd7SHeiko Stübner 		default:
554c6d81bd7SHeiko Stübner 			dev_err(&ts->client->dev, "unrecognized response id: 0x%x\n",
555c6d81bd7SHeiko Stübner 				payload[RESPONSE_ID]);
556c6d81bd7SHeiko Stübner 			break;
557c6d81bd7SHeiko Stübner 		}
558c6d81bd7SHeiko Stübner 	}
559c6d81bd7SHeiko Stübner 
560c6d81bd7SHeiko Stübner 	if (!ts->suspending && device_may_wakeup(&client->dev))
561c6d81bd7SHeiko Stübner 		pm_relax(&client->dev);
562c6d81bd7SHeiko Stübner 
563c6d81bd7SHeiko Stübner 	dev_dbg(&client->dev, "finished interrupt\n");
564c6d81bd7SHeiko Stübner 
565c6d81bd7SHeiko Stübner 	return IRQ_HANDLED;
566c6d81bd7SHeiko Stübner }
567c6d81bd7SHeiko Stübner 
568c6d81bd7SHeiko Stübner static int zforce_input_open(struct input_dev *dev)
569c6d81bd7SHeiko Stübner {
570c6d81bd7SHeiko Stübner 	struct zforce_ts *ts = input_get_drvdata(dev);
571c6d81bd7SHeiko Stübner 	int ret;
572c6d81bd7SHeiko Stübner 
573c6d81bd7SHeiko Stübner 	ret = zforce_start(ts);
574c6d81bd7SHeiko Stübner 	if (ret)
575c6d81bd7SHeiko Stübner 		return ret;
576c6d81bd7SHeiko Stübner 
577c6d81bd7SHeiko Stübner 	return 0;
578c6d81bd7SHeiko Stübner }
579c6d81bd7SHeiko Stübner 
580c6d81bd7SHeiko Stübner static void zforce_input_close(struct input_dev *dev)
581c6d81bd7SHeiko Stübner {
582c6d81bd7SHeiko Stübner 	struct zforce_ts *ts = input_get_drvdata(dev);
583c6d81bd7SHeiko Stübner 	struct i2c_client *client = ts->client;
584c6d81bd7SHeiko Stübner 	int ret;
585c6d81bd7SHeiko Stübner 
586c6d81bd7SHeiko Stübner 	ret = zforce_stop(ts);
587c6d81bd7SHeiko Stübner 	if (ret)
588c6d81bd7SHeiko Stübner 		dev_warn(&client->dev, "stopping zforce failed\n");
589c6d81bd7SHeiko Stübner 
590c6d81bd7SHeiko Stübner 	return;
591c6d81bd7SHeiko Stübner }
592c6d81bd7SHeiko Stübner 
593c6d81bd7SHeiko Stübner #ifdef CONFIG_PM_SLEEP
594c6d81bd7SHeiko Stübner static int zforce_suspend(struct device *dev)
595c6d81bd7SHeiko Stübner {
596c6d81bd7SHeiko Stübner 	struct i2c_client *client = to_i2c_client(dev);
597c6d81bd7SHeiko Stübner 	struct zforce_ts *ts = i2c_get_clientdata(client);
598c6d81bd7SHeiko Stübner 	struct input_dev *input = ts->input;
599c6d81bd7SHeiko Stübner 	int ret = 0;
600c6d81bd7SHeiko Stübner 
601c6d81bd7SHeiko Stübner 	mutex_lock(&input->mutex);
602c6d81bd7SHeiko Stübner 	ts->suspending = true;
603c6d81bd7SHeiko Stübner 
604c6d81bd7SHeiko Stübner 	/*
605c6d81bd7SHeiko Stübner 	 * When configured as a wakeup source device should always wake
606c6d81bd7SHeiko Stübner 	 * the system, therefore start device if necessary.
607c6d81bd7SHeiko Stübner 	 */
608c6d81bd7SHeiko Stübner 	if (device_may_wakeup(&client->dev)) {
609c6d81bd7SHeiko Stübner 		dev_dbg(&client->dev, "suspend while being a wakeup source\n");
610c6d81bd7SHeiko Stübner 
611c6d81bd7SHeiko Stübner 		/* Need to start device, if not open, to be a wakeup source. */
612c6d81bd7SHeiko Stübner 		if (!input->users) {
613c6d81bd7SHeiko Stübner 			ret = zforce_start(ts);
614c6d81bd7SHeiko Stübner 			if (ret)
615c6d81bd7SHeiko Stübner 				goto unlock;
616c6d81bd7SHeiko Stübner 		}
617c6d81bd7SHeiko Stübner 
618c6d81bd7SHeiko Stübner 		enable_irq_wake(client->irq);
619c6d81bd7SHeiko Stübner 	} else if (input->users) {
620c6d81bd7SHeiko Stübner 		dev_dbg(&client->dev, "suspend without being a wakeup source\n");
621c6d81bd7SHeiko Stübner 
622c6d81bd7SHeiko Stübner 		ret = zforce_stop(ts);
623c6d81bd7SHeiko Stübner 		if (ret)
624c6d81bd7SHeiko Stübner 			goto unlock;
625c6d81bd7SHeiko Stübner 
626c6d81bd7SHeiko Stübner 		disable_irq(client->irq);
627c6d81bd7SHeiko Stübner 	}
628c6d81bd7SHeiko Stübner 
629c6d81bd7SHeiko Stübner 	ts->suspended = true;
630c6d81bd7SHeiko Stübner 
631c6d81bd7SHeiko Stübner unlock:
632c6d81bd7SHeiko Stübner 	ts->suspending = false;
633c6d81bd7SHeiko Stübner 	mutex_unlock(&input->mutex);
634c6d81bd7SHeiko Stübner 
635c6d81bd7SHeiko Stübner 	return ret;
636c6d81bd7SHeiko Stübner }
637c6d81bd7SHeiko Stübner 
638c6d81bd7SHeiko Stübner static int zforce_resume(struct device *dev)
639c6d81bd7SHeiko Stübner {
640c6d81bd7SHeiko Stübner 	struct i2c_client *client = to_i2c_client(dev);
641c6d81bd7SHeiko Stübner 	struct zforce_ts *ts = i2c_get_clientdata(client);
642c6d81bd7SHeiko Stübner 	struct input_dev *input = ts->input;
643c6d81bd7SHeiko Stübner 	int ret = 0;
644c6d81bd7SHeiko Stübner 
645c6d81bd7SHeiko Stübner 	mutex_lock(&input->mutex);
646c6d81bd7SHeiko Stübner 
647c6d81bd7SHeiko Stübner 	ts->suspended = false;
648c6d81bd7SHeiko Stübner 
649c6d81bd7SHeiko Stübner 	if (device_may_wakeup(&client->dev)) {
650c6d81bd7SHeiko Stübner 		dev_dbg(&client->dev, "resume from being a wakeup source\n");
651c6d81bd7SHeiko Stübner 
652c6d81bd7SHeiko Stübner 		disable_irq_wake(client->irq);
653c6d81bd7SHeiko Stübner 
654c6d81bd7SHeiko Stübner 		/* need to stop device if it was not open on suspend */
655c6d81bd7SHeiko Stübner 		if (!input->users) {
656c6d81bd7SHeiko Stübner 			ret = zforce_stop(ts);
657c6d81bd7SHeiko Stübner 			if (ret)
658c6d81bd7SHeiko Stübner 				goto unlock;
659c6d81bd7SHeiko Stübner 		}
660c6d81bd7SHeiko Stübner 	} else if (input->users) {
661c6d81bd7SHeiko Stübner 		dev_dbg(&client->dev, "resume without being a wakeup source\n");
662c6d81bd7SHeiko Stübner 
663c6d81bd7SHeiko Stübner 		enable_irq(client->irq);
664c6d81bd7SHeiko Stübner 
665c6d81bd7SHeiko Stübner 		ret = zforce_start(ts);
666c6d81bd7SHeiko Stübner 		if (ret < 0)
667c6d81bd7SHeiko Stübner 			goto unlock;
668c6d81bd7SHeiko Stübner 	}
669c6d81bd7SHeiko Stübner 
670c6d81bd7SHeiko Stübner unlock:
671c6d81bd7SHeiko Stübner 	mutex_unlock(&input->mutex);
672c6d81bd7SHeiko Stübner 
673c6d81bd7SHeiko Stübner 	return ret;
674c6d81bd7SHeiko Stübner }
675c6d81bd7SHeiko Stübner #endif
676c6d81bd7SHeiko Stübner 
677c6d81bd7SHeiko Stübner static SIMPLE_DEV_PM_OPS(zforce_pm_ops, zforce_suspend, zforce_resume);
678c6d81bd7SHeiko Stübner 
679c6d81bd7SHeiko Stübner static void zforce_reset(void *data)
680c6d81bd7SHeiko Stübner {
681c6d81bd7SHeiko Stübner 	struct zforce_ts *ts = data;
682c6d81bd7SHeiko Stübner 
683c6d81bd7SHeiko Stübner 	gpio_set_value(ts->pdata->gpio_rst, 0);
684c6d81bd7SHeiko Stübner }
685c6d81bd7SHeiko Stübner 
686c6d81bd7SHeiko Stübner static int zforce_probe(struct i2c_client *client,
687c6d81bd7SHeiko Stübner 			const struct i2c_device_id *id)
688c6d81bd7SHeiko Stübner {
689c6d81bd7SHeiko Stübner 	const struct zforce_ts_platdata *pdata = dev_get_platdata(&client->dev);
690c6d81bd7SHeiko Stübner 	struct zforce_ts *ts;
691c6d81bd7SHeiko Stübner 	struct input_dev *input_dev;
692c6d81bd7SHeiko Stübner 	int ret;
693c6d81bd7SHeiko Stübner 
694c6d81bd7SHeiko Stübner 	if (!pdata)
695c6d81bd7SHeiko Stübner 		return -EINVAL;
696c6d81bd7SHeiko Stübner 
697c6d81bd7SHeiko Stübner 	ts = devm_kzalloc(&client->dev, sizeof(struct zforce_ts), GFP_KERNEL);
698c6d81bd7SHeiko Stübner 	if (!ts)
699c6d81bd7SHeiko Stübner 		return -ENOMEM;
700c6d81bd7SHeiko Stübner 
701c6d81bd7SHeiko Stübner 	ret = devm_gpio_request_one(&client->dev, pdata->gpio_int, GPIOF_IN,
702c6d81bd7SHeiko Stübner 				    "zforce_ts_int");
703c6d81bd7SHeiko Stübner 	if (ret) {
704c6d81bd7SHeiko Stübner 		dev_err(&client->dev, "request of gpio %d failed, %d\n",
705c6d81bd7SHeiko Stübner 			pdata->gpio_int, ret);
706c6d81bd7SHeiko Stübner 		return ret;
707c6d81bd7SHeiko Stübner 	}
708c6d81bd7SHeiko Stübner 
709c6d81bd7SHeiko Stübner 	ret = devm_gpio_request_one(&client->dev, pdata->gpio_rst,
710c6d81bd7SHeiko Stübner 				    GPIOF_OUT_INIT_LOW, "zforce_ts_rst");
711c6d81bd7SHeiko Stübner 	if (ret) {
712c6d81bd7SHeiko Stübner 		dev_err(&client->dev, "request of gpio %d failed, %d\n",
713c6d81bd7SHeiko Stübner 			pdata->gpio_rst, ret);
714c6d81bd7SHeiko Stübner 		return ret;
715c6d81bd7SHeiko Stübner 	}
716c6d81bd7SHeiko Stübner 
717c6d81bd7SHeiko Stübner 	ret = devm_add_action(&client->dev, zforce_reset, ts);
718c6d81bd7SHeiko Stübner 	if (ret) {
719c6d81bd7SHeiko Stübner 		dev_err(&client->dev, "failed to register reset action, %d\n",
720c6d81bd7SHeiko Stübner 			ret);
721c6d81bd7SHeiko Stübner 		return ret;
722c6d81bd7SHeiko Stübner 	}
723c6d81bd7SHeiko Stübner 
724c6d81bd7SHeiko Stübner 	snprintf(ts->phys, sizeof(ts->phys),
725c6d81bd7SHeiko Stübner 		 "%s/input0", dev_name(&client->dev));
726c6d81bd7SHeiko Stübner 
727c6d81bd7SHeiko Stübner 	input_dev = devm_input_allocate_device(&client->dev);
728c6d81bd7SHeiko Stübner 	if (!input_dev) {
729c6d81bd7SHeiko Stübner 		dev_err(&client->dev, "could not allocate input device\n");
730c6d81bd7SHeiko Stübner 		return -ENOMEM;
731c6d81bd7SHeiko Stübner 	}
732c6d81bd7SHeiko Stübner 
733c6d81bd7SHeiko Stübner 	mutex_init(&ts->access_mutex);
734c6d81bd7SHeiko Stübner 	mutex_init(&ts->command_mutex);
735c6d81bd7SHeiko Stübner 
736c6d81bd7SHeiko Stübner 	ts->pdata = pdata;
737c6d81bd7SHeiko Stübner 	ts->client = client;
738c6d81bd7SHeiko Stübner 	ts->input = input_dev;
739c6d81bd7SHeiko Stübner 
740c6d81bd7SHeiko Stübner 	input_dev->name = "Neonode zForce touchscreen";
741c6d81bd7SHeiko Stübner 	input_dev->phys = ts->phys;
742c6d81bd7SHeiko Stübner 	input_dev->id.bustype = BUS_I2C;
743c6d81bd7SHeiko Stübner 
744c6d81bd7SHeiko Stübner 	input_dev->open = zforce_input_open;
745c6d81bd7SHeiko Stübner 	input_dev->close = zforce_input_close;
746c6d81bd7SHeiko Stübner 
747c6d81bd7SHeiko Stübner 	__set_bit(EV_KEY, input_dev->evbit);
748c6d81bd7SHeiko Stübner 	__set_bit(EV_SYN, input_dev->evbit);
749c6d81bd7SHeiko Stübner 	__set_bit(EV_ABS, input_dev->evbit);
750c6d81bd7SHeiko Stübner 
751c6d81bd7SHeiko Stübner 	/* For multi touch */
752c6d81bd7SHeiko Stübner 	input_set_abs_params(input_dev, ABS_MT_POSITION_X, 0,
753c6d81bd7SHeiko Stübner 			     pdata->x_max, 0, 0);
754c6d81bd7SHeiko Stübner 	input_set_abs_params(input_dev, ABS_MT_POSITION_Y, 0,
755c6d81bd7SHeiko Stübner 			     pdata->y_max, 0, 0);
756c6d81bd7SHeiko Stübner 
757c6d81bd7SHeiko Stübner 	input_set_abs_params(input_dev, ABS_MT_TOUCH_MAJOR, 0,
758c6d81bd7SHeiko Stübner 			     ZFORCE_MAX_AREA, 0, 0);
759c6d81bd7SHeiko Stübner 	input_set_abs_params(input_dev, ABS_MT_TOUCH_MINOR, 0,
760c6d81bd7SHeiko Stübner 			     ZFORCE_MAX_AREA, 0, 0);
761c6d81bd7SHeiko Stübner 	input_set_abs_params(input_dev, ABS_MT_ORIENTATION, 0, 1, 0, 0);
762c6d81bd7SHeiko Stübner 	input_mt_init_slots(input_dev, ZFORCE_REPORT_POINTS, INPUT_MT_DIRECT);
763c6d81bd7SHeiko Stübner 
764c6d81bd7SHeiko Stübner 	input_set_drvdata(ts->input, ts);
765c6d81bd7SHeiko Stübner 
766c6d81bd7SHeiko Stübner 	init_completion(&ts->command_done);
767c6d81bd7SHeiko Stübner 
768c6d81bd7SHeiko Stübner 	/*
769c6d81bd7SHeiko Stübner 	 * The zforce pulls the interrupt low when it has data ready.
770c6d81bd7SHeiko Stübner 	 * After it is triggered the isr thread runs until all the available
771c6d81bd7SHeiko Stübner 	 * packets have been read and the interrupt is high again.
772c6d81bd7SHeiko Stübner 	 * Therefore we can trigger the interrupt anytime it is low and do
773c6d81bd7SHeiko Stübner 	 * not need to limit it to the interrupt edge.
774c6d81bd7SHeiko Stübner 	 */
775499e6127SHeiko Stübner 	ret = devm_request_threaded_irq(&client->dev, client->irq,
776499e6127SHeiko Stübner 					zforce_irq, zforce_irq_thread,
777c6d81bd7SHeiko Stübner 					IRQF_TRIGGER_LOW | IRQF_ONESHOT,
778c6d81bd7SHeiko Stübner 					input_dev->name, ts);
779c6d81bd7SHeiko Stübner 	if (ret) {
780c6d81bd7SHeiko Stübner 		dev_err(&client->dev, "irq %d request failed\n", client->irq);
781c6d81bd7SHeiko Stübner 		return ret;
782c6d81bd7SHeiko Stübner 	}
783c6d81bd7SHeiko Stübner 
784c6d81bd7SHeiko Stübner 	i2c_set_clientdata(client, ts);
785c6d81bd7SHeiko Stübner 
786c6d81bd7SHeiko Stübner 	/* let the controller boot */
787c6d81bd7SHeiko Stübner 	gpio_set_value(pdata->gpio_rst, 1);
788c6d81bd7SHeiko Stübner 
789c6d81bd7SHeiko Stübner 	ts->command_waiting = NOTIFICATION_BOOTCOMPLETE;
790c6d81bd7SHeiko Stübner 	if (wait_for_completion_timeout(&ts->command_done, WAIT_TIMEOUT) == 0)
791c6d81bd7SHeiko Stübner 		dev_warn(&client->dev, "bootcomplete timed out\n");
792c6d81bd7SHeiko Stübner 
793c6d81bd7SHeiko Stübner 	/* need to start device to get version information */
794c6d81bd7SHeiko Stübner 	ret = zforce_command_wait(ts, COMMAND_INITIALIZE);
795c6d81bd7SHeiko Stübner 	if (ret) {
796c6d81bd7SHeiko Stübner 		dev_err(&client->dev, "unable to initialize, %d\n", ret);
797c6d81bd7SHeiko Stübner 		return ret;
798c6d81bd7SHeiko Stübner 	}
799c6d81bd7SHeiko Stübner 
800c6d81bd7SHeiko Stübner 	/* this gets the firmware version among other informations */
801c6d81bd7SHeiko Stübner 	ret = zforce_command_wait(ts, COMMAND_STATUS);
802c6d81bd7SHeiko Stübner 	if (ret < 0) {
803c6d81bd7SHeiko Stübner 		dev_err(&client->dev, "couldn't get status, %d\n", ret);
804c6d81bd7SHeiko Stübner 		zforce_stop(ts);
805c6d81bd7SHeiko Stübner 		return ret;
806c6d81bd7SHeiko Stübner 	}
807c6d81bd7SHeiko Stübner 
808c6d81bd7SHeiko Stübner 	/* stop device and put it into sleep until it is opened */
809c6d81bd7SHeiko Stübner 	ret = zforce_stop(ts);
810c6d81bd7SHeiko Stübner 	if (ret < 0)
811c6d81bd7SHeiko Stübner 		return ret;
812c6d81bd7SHeiko Stübner 
813c6d81bd7SHeiko Stübner 	device_set_wakeup_capable(&client->dev, true);
814c6d81bd7SHeiko Stübner 
815c6d81bd7SHeiko Stübner 	ret = input_register_device(input_dev);
816c6d81bd7SHeiko Stübner 	if (ret) {
817c6d81bd7SHeiko Stübner 		dev_err(&client->dev, "could not register input device, %d\n",
818c6d81bd7SHeiko Stübner 			ret);
819c6d81bd7SHeiko Stübner 		return ret;
820c6d81bd7SHeiko Stübner 	}
821c6d81bd7SHeiko Stübner 
822c6d81bd7SHeiko Stübner 	return 0;
823c6d81bd7SHeiko Stübner }
824c6d81bd7SHeiko Stübner 
825c6d81bd7SHeiko Stübner static struct i2c_device_id zforce_idtable[] = {
826c6d81bd7SHeiko Stübner 	{ "zforce-ts", 0 },
827c6d81bd7SHeiko Stübner 	{ }
828c6d81bd7SHeiko Stübner };
829c6d81bd7SHeiko Stübner MODULE_DEVICE_TABLE(i2c, zforce_idtable);
830c6d81bd7SHeiko Stübner 
831c6d81bd7SHeiko Stübner static struct i2c_driver zforce_driver = {
832c6d81bd7SHeiko Stübner 	.driver = {
833c6d81bd7SHeiko Stübner 		.owner	= THIS_MODULE,
834c6d81bd7SHeiko Stübner 		.name	= "zforce-ts",
835c6d81bd7SHeiko Stübner 		.pm	= &zforce_pm_ops,
836c6d81bd7SHeiko Stübner 	},
837c6d81bd7SHeiko Stübner 	.probe		= zforce_probe,
838c6d81bd7SHeiko Stübner 	.id_table	= zforce_idtable,
839c6d81bd7SHeiko Stübner };
840c6d81bd7SHeiko Stübner 
841c6d81bd7SHeiko Stübner module_i2c_driver(zforce_driver);
842c6d81bd7SHeiko Stübner 
843c6d81bd7SHeiko Stübner MODULE_AUTHOR("Heiko Stuebner <heiko@sntech.de>");
844c6d81bd7SHeiko Stübner MODULE_DESCRIPTION("zForce TouchScreen Driver");
845c6d81bd7SHeiko Stübner MODULE_LICENSE("GPL");
846