xref: /OK3568_Linux_fs/kernel/drivers/input/touchscreen/gt1x/gt1x_generic.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1 /* drivers/input/touchscreen/gt1x_generic.c
2  *
3  * 2010 - 2014 Goodix Technology.
4  *
5  * This program is free software; you can redistribute it and/or modify
6  * it under the terms of the GNU General Public License as published by
7  * the Free Software Foundation; either version 2 of the License, or
8  * (at your option) any later version.
9  *
10  * This program is distributed in the hope that it will be a reference
11  * to you, when you are integrating the GOODiX's CTP IC into your system,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
14  * General Public License for more details.
15  *
16  * Version: 1.4
17  * Release Date:  2015/07/10
18  */
19 
20 /*#include "gt1x_tpd_custom.h"*/
21 #include "gt1x.h"
22 #include "gt1x_generic.h"
23 #include "gt1x_cfg.h"
24 #if GTP_PROXIMITY && defined(PLATFORM_MTK)
25 #include <linux/hwmsensor.h>
26 #include <linux/hwmsen_dev.h>
27 #include <linux/sensors_io.h>
28 #endif
29 #include <linux/input/mt.h>
30 
31 /*******************GLOBAL VARIABLE*********************/
32 struct i2c_client *gt1x_i2c_client;
33 static struct workqueue_struct *gt1x_workqueue;
34 
35 u8 gt1x_config[GTP_CONFIG_MAX_LENGTH] = { 0 };
36 u32 gt1x_cfg_length = GTP_CONFIG_MAX_LENGTH;
37 
38 CHIP_TYPE_T gt1x_chip_type = CHIP_TYPE_NONE;
39 struct gt1x_version_info gt1x_version = {
40 	.product_id = {0},
41 	.patch_id = 0,
42 	.mask_id = 0,
43 	.sensor_id = 0,
44 	.match_opt = 0
45 };
46 
47 #ifndef TPD_HAVE_BUTTON
48 #define TPD_HAVE_BUTTON  0
49 #endif
50 
51 #if GTP_HAVE_TOUCH_KEY
52 const u16 gt1x_touch_key_array[] = GTP_KEY_TAB;
53 #elif TPD_HAVE_BUTTON
54 struct key_map_t {
55 	int x;
56 	int y;
57 };
58 static struct key_map_t tpd_virtual_key_array[] = TPD_KEY_MAP_ARRAY;
59 #endif
60 
61 #if GTP_WITH_STYLUS && GTP_HAVE_STYLUS_KEY
62 static const u16 gt1x_stylus_key_array[] = GTP_STYLUS_KEY_TAB;
63 #endif
64 
65 #define GOODIX_SYSFS_DIR      "goodix"
66 static struct kobject *sysfs_rootdir;
67 
68 volatile int gt1x_rawdiff_mode;
69 u8 gt1x_wakeup_level;
70 u8 gt1x_init_failed;
71 u8 gt1x_int_type;
72 u32 gt1x_abs_x_max;
73 u32 gt1x_abs_y_max;
74 int gt1x_halt;
75 bool gt1x_ics_slot_report;
76 
77 #if GTP_DEBUG_NODE
78 static ssize_t gt1x_debug_read_proc(struct file *, char __user *, size_t, loff_t *);
79 static ssize_t gt1x_debug_write_proc(struct file *, const char __user *, size_t, loff_t *);
80 
81 static struct proc_dir_entry *gt1x_debug_proc_entry;
82 static const struct file_operations gt1x_debug_fops = {
83 	.owner = THIS_MODULE,
84 	.read = gt1x_debug_read_proc,
85 	.write = gt1x_debug_write_proc,
86 };
87 
gt1x_init_debug_node(void)88 static s32 gt1x_init_debug_node(void)
89 {
90 	gt1x_debug_proc_entry = proc_create(GT1X_DEBUG_PROC_FILE, 0660, NULL, &gt1x_debug_fops);
91 	if (gt1x_debug_proc_entry == NULL) {
92 		GTP_ERROR("Create proc entry /proc/%s FAILED!", GT1X_DEBUG_PROC_FILE);
93 		return -1;
94 	}
95 	GTP_INFO("Created proc entry /proc/%s.", GT1X_DEBUG_PROC_FILE);
96 	return 0;
97 }
98 
gt1x_deinit_debug_node(void)99 static void gt1x_deinit_debug_node(void)
100 {
101 	if (gt1x_debug_proc_entry != NULL) {
102 		remove_proc_entry(GT1X_DEBUG_PROC_FILE, NULL);
103 	}
104 }
105 
gt1x_debug_read_proc(struct file * file,char __user * page,size_t size,loff_t * ppos)106 static ssize_t gt1x_debug_read_proc(struct file *file, char __user *page, size_t size, loff_t *ppos)
107 {
108 	char *ptr = page;
109 	char temp_data[GTP_CONFIG_MAX_LENGTH] = { 0 };
110 	int i;
111 
112 	if (*ppos) {
113 		return 0;
114 	}
115 
116 	ptr += sprintf(ptr, "==== GT1X default config setting in driver====\n");
117 
118 	for (i = 0; i < GTP_CONFIG_MAX_LENGTH; i++) {
119 		ptr += sprintf(ptr, "0x%02X,", gt1x_config[i]);
120 		if (i % 10 == 9)
121 			ptr += sprintf(ptr, "\n");
122 	}
123 
124 	ptr += sprintf(ptr, "\n");
125 
126 	ptr += sprintf(ptr, "==== GT1X config read from chip====\n");
127 	i = gt1x_i2c_read(GTP_REG_CONFIG_DATA, temp_data, GTP_CONFIG_MAX_LENGTH);
128 	GTP_INFO("I2C TRANSFER: %d", i);
129 	for (i = 0; i < GTP_CONFIG_MAX_LENGTH; i++) {
130 		ptr += sprintf(ptr, "0x%02X,", temp_data[i]);
131 
132 		if (i % 10 == 9)
133 			ptr += sprintf(ptr, "\n");
134 	}
135 
136 	ptr += sprintf(ptr, "\n");
137 	/* Touch PID & VID */
138 	ptr += sprintf(ptr, "==== GT1X Version Info ====\n");
139 
140 	gt1x_i2c_read(GTP_REG_VERSION, temp_data, 12);
141 	ptr += sprintf(ptr, "ProductID: GT%c%c%c%c\n", temp_data[0], temp_data[1], temp_data[2], temp_data[3]);
142 	ptr += sprintf(ptr, "PatchID: %02X%02X\n", temp_data[4], temp_data[5]);
143 	ptr += sprintf(ptr, "MaskID: %02X%02X\n", temp_data[7], temp_data[8]);
144 	ptr += sprintf(ptr, "SensorID: %02X\n", temp_data[10] & 0x0F);
145 
146 	*ppos += ptr - page;
147 	return (ptr - page);
148 }
149 
gt1x_debug_write_proc(struct file * file,const char * buffer,size_t count,loff_t * ppos)150 static ssize_t gt1x_debug_write_proc(struct file *file, const char *buffer, size_t count, loff_t *ppos)
151 {
152 	s32 ret = 0;
153 	u8 buf[GTP_CONFIG_MAX_LENGTH] = { 0 };
154 	char mode_str[50] = { 0 };
155 	int mode;
156 	int cfg_len;
157 	char arg1[50] = { 0 };
158 	u8 temp_config[GTP_CONFIG_MAX_LENGTH] = { 0 };
159 
160 	GTP_DEBUG("write count %ld\n", (unsigned long)count);
161 
162 	if (count > GTP_CONFIG_MAX_LENGTH) {
163 		GTP_ERROR("Too much data, buffer size: %d, data:%ld", GTP_CONFIG_MAX_LENGTH, (unsigned long)count);
164 		return -EFAULT;
165 	}
166 
167 	if (copy_from_user(buf, buffer, count)) {
168 		GTP_ERROR("copy from user fail!");
169 		return -EFAULT;
170 	}
171 	/*send config*/
172 	if (count == gt1x_cfg_length) {
173 		memcpy(gt1x_config, buf, count);
174 		ret = gt1x_send_cfg(gt1x_config, gt1x_cfg_length);
175 		if (ret < 0) {
176 			GTP_ERROR("send gt1x_config failed.");
177 			return -EFAULT;
178 		}
179 		gt1x_abs_x_max = (gt1x_config[RESOLUTION_LOC + 1] << 8) + gt1x_config[RESOLUTION_LOC];
180 		gt1x_abs_y_max = (gt1x_config[RESOLUTION_LOC + 3] << 8) + gt1x_config[RESOLUTION_LOC + 2];
181 
182 		return count;
183 	}
184 
185 	sscanf(buf, "%s %d", (char *)&mode_str, &mode);
186 
187 	/*force clear gt1x_config*/
188 	if (strcmp(mode_str, "clear_config") == 0) {
189 		GTP_INFO("Force clear gt1x_config");
190 		gt1x_send_cmd(GTP_CMD_CLEAR_CFG, 0);
191 		return count;
192 	}
193 	if (strcmp(mode_str, "init") == 0) {
194 		GTP_INFO("Init panel");
195 		gt1x_init_panel();
196 		return count;
197 	}
198 	if (strcmp(mode_str, "chip") == 0) {
199 		GTP_INFO("Get chip type:");
200 		gt1x_get_chip_type();
201 		return count;
202 	}
203 	if (strcmp(mode_str, "int") == 0) {
204 		if (mode == 0) {
205 			GTP_INFO("Disable irq.");
206 			gt1x_irq_disable();
207 		} else {
208 			GTP_INFO("Enable irq.");
209 			gt1x_irq_enable();
210 		}
211 		return count;
212 	}
213 
214 	if (strcmp(mode_str, "poweron") == 0) {
215 		gt1x_power_switch(1);
216 		return count;
217 	}
218 
219 	if (strcmp(mode_str, "poweroff") == 0) {
220 		gt1x_power_switch(0);
221 		return count;
222 	}
223 
224 	if (strcmp(mode_str, "version") == 0) {
225 		gt1x_read_version(NULL);
226 		return count;
227 	}
228 
229 	if (strcmp(mode_str, "reset") == 0) {
230 		gt1x_irq_disable();
231 		gt1x_reset_guitar();
232 		gt1x_irq_enable();
233 		return count;
234 	}
235 #if GTP_CHARGER_SWITCH
236 	if (strcmp(mode_str, "charger") == 0) {
237 		gt1x_charger_config(mode);
238 		return count;
239 	}
240 #endif
241 	sscanf(buf, "%s %s", (char *)&mode_str, (char *)&arg1);
242 	if (strcmp(mode_str, "update") == 0) {
243 		gt1x_update_firmware(arg1);
244 		return count;
245 	}
246 #if 0 //close for GKI
247 	if (strcmp(mode_str, "sendconfig") == 0) {
248 		cfg_len = gt1x_parse_config(arg1, temp_config);
249 		if (cfg_len < 0) {
250 			return -1;
251 		}
252 		gt1x_send_cfg(temp_config, gt1x_cfg_length);
253 		return count;
254 	}
255 #endif
256 	if (strcmp(mode_str, "debug_gesture") == 0) {
257 #if GTP_GESTURE_WAKEUP
258 		gt1x_gesture_debug(!!mode);
259 #endif
260 	}
261 
262 	if (strcmp(mode_str, "force_update") == 0) {
263 		update_info.force_update = !!mode;
264 	}
265 	return gt1x_debug_proc(buf, count);
266 }
267 #endif
268 
ascii2hex(u8 a)269 static u8 __maybe_unused ascii2hex(u8 a)
270 {
271 	s8 value = 0;
272 	if (a >= '0' && a <= '9') {
273 		value = a - '0';
274 	} else if (a >= 'A' && a <= 'F') {
275 		value = a - 'A' + 0x0A;
276 	} else if (a >= 'a' && a <= 'f') {
277 		value = a - 'a' + 0x0A;
278 	} else {
279 		value = 0xff;
280 	}
281 	return value;
282 }
283 
284 #if 0 //close for GKI
285 int gt1x_parse_config(char *filename, u8 *config)
286 {
287 	mm_segment_t old_fs;
288 	struct file *fp = NULL;
289 	u8 *buf;
290 	int i;
291 	int len;
292 	int cur_len = -1;
293 	u8 high, low;
294 
295 	old_fs = get_fs();
296 	set_fs(KERNEL_DS);
297 
298 	fp = filp_open(filename, O_RDONLY, 0);
299 	if (IS_ERR(fp)) {
300 		GTP_ERROR("Open config file error!(file: %s)", filename);
301 		goto parse_cfg_fail1;
302 	}
303 	len = fp->f_op->llseek(fp, 0, SEEK_END);
304 	if (len > GTP_CONFIG_MAX_LENGTH * 6 || len < GTP_CONFIG_MAX_LENGTH) {
305 		GTP_ERROR("Config is invalid!(length: %d)", len);
306 		goto parse_cfg_fail2;
307 	}
308 	buf = kzalloc(len, GFP_KERNEL);
309 	if (buf == NULL) {
310 		GTP_ERROR("Allocate memory failed!(size: %d)", len);
311 		goto parse_cfg_fail2;
312 	}
313 	fp->f_op->llseek(fp, 0, SEEK_SET);
314 	if (fp->f_op->read(fp, (char *)buf, len, &fp->f_pos) != len) {
315 		GTP_ERROR("Read %d bytes from file failed!", len);
316 	}
317 
318 	GTP_INFO("Parse config file: %s (%d bytes)", filename, len);
319 
320 	for (i = 0, cur_len = 0; i < len && cur_len < GTP_CONFIG_MAX_LENGTH;) {
321 		if (buf[i] == ' ' || buf[i] == '\r' || buf[i] == '\n' || buf[i] == ',') {
322 			i++;
323 			continue;
324 		}
325 		if (buf[i] == '0' && (buf[i + 1] == 'x' || buf[i + 1] == 'X')) {
326 
327 			high = ascii2hex(buf[i + 2]);
328 			low = ascii2hex(buf[i + 3]);
329 
330 			if (high != 0xFF && low != 0xFF) {
331 				config[cur_len++] = (high << 4) + low;
332 				i += 4;
333 				continue;
334 			}
335 		}
336 		GTP_ERROR("Illegal config file!");
337 		cur_len = -1;
338 		break;
339 	}
340 
341 	if (cur_len < GTP_CONFIG_MIN_LENGTH || config[cur_len - 1] != 0x01) {
342 		cur_len = -1;
343 	} else {
344 		for (i = 0; i < cur_len; i++) {
345 			if (i % 10 == 0) {
346 				printk("\n<<GTP-DBG>>:");
347 			}
348 			printk("0x%02x,", config[i]);
349 		}
350 		printk("\n");
351 	}
352 
353 	kfree(buf);
354 parse_cfg_fail2:
355 	filp_close(fp, NULL);
356 parse_cfg_fail1:
357 	set_fs(old_fs);
358 
359 	return cur_len;
360 }
361 #endif
362 
_do_i2c_read(struct i2c_msg * msgs,u16 addr,u8 * buffer,s32 len)363 s32 _do_i2c_read(struct i2c_msg *msgs, u16 addr, u8 *buffer, s32 len)
364 {
365 	s32 ret = -1;
366 	s32 pos = 0;
367 	s32 data_length = len;
368 	s32 transfer_length = 0;
369 	u8 *data = NULL;
370 	u16 address = addr;
371 
372 	data = kmalloc(IIC_MAX_TRANSFER_SIZE < (len + GTP_ADDR_LENGTH) ? IIC_MAX_TRANSFER_SIZE : (len + GTP_ADDR_LENGTH), GFP_KERNEL);
373 	if (data == NULL) {
374 		return ERROR_MEM;
375 	}
376 	msgs[1].buf = data;
377 
378 	while (pos != data_length) {
379 		if ((data_length - pos) > IIC_MAX_TRANSFER_SIZE) {
380 			transfer_length = IIC_MAX_TRANSFER_SIZE;
381 		} else {
382 			transfer_length = data_length - pos;
383 		}
384 		msgs[0].buf[0] = (address >> 8) & 0xFF;
385 		msgs[0].buf[1] = address & 0xFF;
386 		msgs[1].len = transfer_length;
387 
388 		ret = i2c_transfer(gt1x_i2c_client->adapter, msgs, 2);
389 		if (ret != 2) {
390 			GTP_ERROR("I2c Transfer error! (%d)", ret);
391 			kfree(data);
392 			return ERROR_IIC;
393 		}
394 		memcpy(&buffer[pos], msgs[1].buf, transfer_length);
395 		pos += transfer_length;
396 		address += transfer_length;
397 	}
398 
399 	kfree(data);
400 	return 0;
401 }
402 
_do_i2c_write(struct i2c_msg * msg,u16 addr,u8 * buffer,s32 len)403 s32 _do_i2c_write(struct i2c_msg *msg, u16 addr, u8 *buffer, s32 len)
404 {
405 	s32 ret = -1;
406 	s32 pos = 0;
407 	s32 data_length = len;
408 	s32 transfer_length = 0;
409 	u8 *data = NULL;
410 	u16 address = addr;
411 
412 	data = kmalloc(IIC_MAX_TRANSFER_SIZE < (len + GTP_ADDR_LENGTH) ? IIC_MAX_TRANSFER_SIZE : (len + GTP_ADDR_LENGTH), GFP_KERNEL);
413 	if (data == NULL) {
414 		return ERROR_MEM;
415 	}
416 	msg->buf = data;
417 
418 	while (pos != data_length) {
419 		if ((data_length - pos) > (IIC_MAX_TRANSFER_SIZE - GTP_ADDR_LENGTH)) {
420 			transfer_length = IIC_MAX_TRANSFER_SIZE - GTP_ADDR_LENGTH;
421 		} else {
422 			transfer_length = data_length - pos;
423 		}
424 
425 		msg->buf[0] = (address >> 8) & 0xFF;
426 		msg->buf[1] = address & 0xFF;
427 		msg->len = transfer_length + GTP_ADDR_LENGTH;
428 		memcpy(&msg->buf[GTP_ADDR_LENGTH], &buffer[pos], transfer_length);
429 
430 		ret = i2c_transfer(gt1x_i2c_client->adapter, msg, 1);
431 		if (ret != 1) {
432 			GTP_ERROR("I2c transfer error! (%d)", ret);
433 			kfree(data);
434 			return ERROR_IIC;
435 		}
436 		pos += transfer_length;
437 		address += transfer_length;
438 	}
439 
440 	kfree(data);
441 	return 0;
442 }
443 
444 #if !GTP_ESD_PROTECT
gt1x_i2c_test(void)445 static s32 gt1x_i2c_test(void)
446 {
447 	u8 retry = 0;
448 	s32 ret = -1;
449 	u32 hw_info = 0;
450 	GTP_DEBUG_FUNC();
451 
452 	while (retry++ < 3) {
453 		ret = gt1x_i2c_read(GTP_REG_HW_INFO, (u8 *) &hw_info, sizeof(hw_info));
454 		if (!ret) {
455 			GTP_INFO("Hardware Info:%08X", hw_info);
456 			return ret;
457 		}
458 
459 		usleep_range(10000, 11000);
460 		GTP_ERROR("Hardware Info:%08X", hw_info);
461 		GTP_ERROR("I2c failed%d.", retry);
462 	}
463 
464 	return ERROR_RETRY;
465 }
466 #endif
467 
468 /**
469  * gt1x_i2c_read_dbl_check - read twice and double check
470  * @addr: register address
471  * @buffer: data buffer
472  * @len: bytes to read
473  * Return    <0: i2c error, 0: ok, 1:fail
474  */
gt1x_i2c_read_dbl_check(u16 addr,u8 * buffer,s32 len)475 s32 gt1x_i2c_read_dbl_check(u16 addr, u8 *buffer, s32 len)
476 {
477 	u8 buf[16] = { 0 };
478 	u8 confirm_buf[16] = { 0 };
479 	int ret;
480 
481 	if (len > 16) {
482 		GTP_ERROR("i2c_read_dbl_check length %d is too long, exceed %zu", len, sizeof(buf));
483 		return ERROR;
484 	}
485 
486 	memset(buf, 0xAA, sizeof(buf));
487 	ret = gt1x_i2c_read(addr, buf, len);
488 	if (ret < 0) {
489 		return ret;
490 	}
491 
492 	usleep_range(5000, 6000);
493 	memset(confirm_buf, 0, sizeof(confirm_buf));
494 	ret = gt1x_i2c_read(addr, confirm_buf, len);
495 	if (ret < 0) {
496 		return ret;
497 	}
498 
499 	if (!memcmp(buf, confirm_buf, len)) {
500 		memcpy(buffer, confirm_buf, len);
501 		return 0;
502 	}
503 	GTP_ERROR("i2c read 0x%04X, %d bytes, double check failed!", addr, len);
504 	return 1;
505 }
506 
507 /**
508  * gt1x_send_cfg - Send gt1x_config Function.
509  * @config: pointer of the configuration array.
510  * @cfg_len: length of configuration array.
511  * Return 0--success,non-0--fail.
512  */
gt1x_send_cfg(u8 * config,int cfg_len)513 s32 gt1x_send_cfg(u8 *config, int cfg_len)
514 {
515 #if GTP_DRIVER_SEND_CFG
516 	static DEFINE_MUTEX(mutex_cfg);
517 	int i;
518 	s32 ret = 0;
519 	s32 retry = 0;
520 	u16 checksum = 0;
521 
522 	if (update_info.status) {
523 		GTP_DEBUG("Ignore cfg during fw update.");
524 		return -1;
525 	}
526 	mutex_lock(&mutex_cfg);
527 	GTP_DEBUG("Driver send config, length:%d", cfg_len);
528 	for (i = 0; i < cfg_len - 3; i += 2) {
529 		checksum += (config[i] << 8) + config[i + 1];
530 	}
531 	if (!checksum) {
532 		GTP_ERROR("Invalid config, all of the bytes is zero!");
533 		mutex_unlock(&mutex_cfg);
534 		return -1;
535 	}
536 	checksum = 0 - checksum;
537 	GTP_DEBUG("Config checksum: 0x%04X", checksum);
538 	config[cfg_len - 3] = (checksum >> 8) & 0xFF;
539 	config[cfg_len - 2] = checksum & 0xFF;
540 	config[cfg_len - 1] = 0x01;
541 
542 	while (retry++ < 5) {
543 		ret = gt1x_i2c_write(GTP_REG_CONFIG_DATA, config, cfg_len);
544 		if (!ret) {
545 			msleep(200);	/* at least 200ms, wait for storing config into flash. */
546 			mutex_unlock(&mutex_cfg);
547 			GTP_DEBUG("Send config successfully!");
548 			return 0;
549 		}
550 	}
551 	GTP_ERROR("Send config failed!");
552 	mutex_unlock(&mutex_cfg);
553 	return ret;
554 #endif
555 	return 0;
556 }
557 
558 /**
559  * gt1x_init_panel - Prepare config data for touch ic, don't call this function
560  * after initialization.
561  *
562  * Return 0--success,<0 --fail.
563  */
gt1x_init_panel(void)564 s32 gt1x_init_panel(void)
565 {
566 	s32 ret = 0;
567 	u8 cfg_len = 0;
568 
569 #if GTP_DRIVER_SEND_CFG
570 	u8 sensor_id = 0;
571 
572 	const u8 cfg_grp0[] = GTP_CFG_GROUP0;
573 	const u8 cfg_grp1[] = GTP_CFG_GROUP1;
574 	const u8 cfg_grp2[] = GTP_CFG_GROUP2;
575 	const u8 cfg_grp3[] = GTP_CFG_GROUP3;
576 	const u8 cfg_grp4[] = GTP_CFG_GROUP4;
577 	const u8 cfg_grp5[] = GTP_CFG_GROUP5;
578 	const u8 *cfgs[] = {
579 		cfg_grp0, cfg_grp1, cfg_grp2,
580 		cfg_grp3, cfg_grp4, cfg_grp5
581 	};
582 	u8 cfg_lens[] = {
583 		CFG_GROUP_LEN(cfg_grp0),
584 		CFG_GROUP_LEN(cfg_grp1),
585 		CFG_GROUP_LEN(cfg_grp2),
586 		CFG_GROUP_LEN(cfg_grp3),
587 		CFG_GROUP_LEN(cfg_grp4),
588 		CFG_GROUP_LEN(cfg_grp5)
589 	};
590 
591 	if (gt1x_gt5688) {
592 		cfgs[0] = gtp_dat_5688;
593 		cfg_lens[0] = CFG_GROUP_LEN(gtp_dat_5688);
594 	}
595 
596 	GTP_DEBUG("Config groups length:%d,%d,%d,%d,%d,%d", cfg_lens[0], cfg_lens[1], cfg_lens[2], cfg_lens[3], cfg_lens[4], cfg_lens[5]);
597 
598 	sensor_id = gt1x_version.sensor_id;
599 	if (sensor_id >= 6 || cfg_lens[sensor_id] < GTP_CONFIG_MIN_LENGTH || cfg_lens[sensor_id] > GTP_CONFIG_MAX_LENGTH) {
600 		sensor_id = 0;
601 		gt1x_version.sensor_id = 0;
602 	}
603 
604 	cfg_len = cfg_lens[sensor_id];
605 
606 	GTP_INFO("Config group%d used, length:%d", sensor_id, cfg_len);
607 
608 	if (cfg_len < GTP_CONFIG_MIN_LENGTH || cfg_len > GTP_CONFIG_MAX_LENGTH) {
609 		GTP_ERROR("Config group%d is INVALID! You need to check you header file CFG_GROUP section!", sensor_id + 1);
610 		return -1;
611 	}
612 
613 	memset(gt1x_config, 0, sizeof(gt1x_config));
614 	memcpy(gt1x_config, cfgs[sensor_id], cfg_len);
615 
616 	/* clear the flag, avoid failure when send the_config of driver. */
617 	gt1x_config[0] &= 0x7F;
618 
619 #if GTP_CUSTOM_CFG
620 	gt1x_config[RESOLUTION_LOC] = (u8) GTP_MAX_WIDTH;
621 	gt1x_config[RESOLUTION_LOC + 1] = (u8) (GTP_MAX_WIDTH >> 8);
622 	gt1x_config[RESOLUTION_LOC + 2] = (u8) GTP_MAX_HEIGHT;
623 	gt1x_config[RESOLUTION_LOC + 3] = (u8) (GTP_MAX_HEIGHT >> 8);
624 
625 	if (GTP_INT_TRIGGER == 0) {	/* RISING  */
626 		gt1x_config[TRIGGER_LOC] &= 0xfe;
627 	} else if (GTP_INT_TRIGGER == 1) {	/* FALLING */
628 		gt1x_config[TRIGGER_LOC] |= 0x01;
629 	}
630 	set_reg_bit(gt1x_config[MODULE_SWITCH3_LOC], 5, !gt1x_wakeup_level);
631 #endif /* END GTP_CUSTOM_CFG */
632 
633 #else /* DRIVER NOT SEND CONFIG */
634 	cfg_len = GTP_CONFIG_MAX_LENGTH;
635 	ret = gt1x_i2c_read(GTP_REG_CONFIG_DATA, gt1x_config, cfg_len);
636 	if (ret < 0) {
637 		return ret;
638 	}
639 #endif /* END GTP_DRIVER_SEND_CFG */
640 
641 	GTP_DEBUG_FUNC();
642 	/* match resolution when gt1x_abs_x_max & gt1x_abs_y_max have been set already */
643 	if ((gt1x_abs_x_max == 0) && (gt1x_abs_y_max == 0)) {
644 		gt1x_abs_x_max = (gt1x_config[RESOLUTION_LOC + 1] << 8) + gt1x_config[RESOLUTION_LOC];
645 		gt1x_abs_y_max = (gt1x_config[RESOLUTION_LOC + 3] << 8) + gt1x_config[RESOLUTION_LOC + 2];
646 		gt1x_int_type = (gt1x_config[TRIGGER_LOC]) & 0x03;
647 		gt1x_wakeup_level = !(gt1x_config[MODULE_SWITCH3_LOC] & 0x20);
648 	} else {
649 		gt1x_config[RESOLUTION_LOC] = (u8) gt1x_abs_x_max;
650 		gt1x_config[RESOLUTION_LOC + 1] = (u8) (gt1x_abs_x_max >> 8);
651 		gt1x_config[RESOLUTION_LOC + 2] = (u8) gt1x_abs_y_max;
652 		gt1x_config[RESOLUTION_LOC + 3] = (u8) (gt1x_abs_y_max >> 8);
653 		set_reg_bit(gt1x_config[MODULE_SWITCH3_LOC], 5, !gt1x_wakeup_level);
654 		gt1x_config[TRIGGER_LOC] = (gt1x_config[TRIGGER_LOC] & 0xFC) | gt1x_int_type;
655 	}
656 
657 	GTP_INFO("X_MAX=%d,Y_MAX=%d,TRIGGER=0x%02x,WAKEUP_LEVEL=%d", gt1x_abs_x_max, gt1x_abs_y_max, gt1x_int_type, gt1x_wakeup_level);
658 
659 	gt1x_cfg_length = cfg_len;
660 	ret = gt1x_send_cfg(gt1x_config, gt1x_cfg_length);
661 	return ret;
662 }
663 
gt1x_select_addr(void)664 void gt1x_select_addr(void)
665 {
666 	if (gpio_is_valid(gt1x_rst_gpio))
667 		GTP_GPIO_OUTPUT(GTP_RST_PORT, 0);
668 	GTP_GPIO_OUTPUT(GTP_INT_PORT, gt1x_i2c_client->addr == 0x14);
669 	usleep_range(2000, 3000);
670 	if (gpio_is_valid(gt1x_rst_gpio))
671 		GTP_GPIO_OUTPUT(GTP_RST_PORT, 1);
672 	usleep_range(2000, 3000);
673 }
674 
gt1x_set_reset_status(void)675 static s32 gt1x_set_reset_status(void)
676 {
677 	/* 0x8040 ~ 0x8043 */
678 	u8 value[] = {0xAA, 0x00, 0x56, 0xAA};
679 	int ret;
680 
681 	GTP_DEBUG("Set reset status.");
682 	ret = gt1x_i2c_write(GTP_REG_CMD + 1, &value[1], 3);
683 	if (ret < 0)
684 		return ret;
685 
686 	return gt1x_i2c_write(GTP_REG_CMD, value, 1);
687 }
688 
689 #if GTP_INCELL_PANEL
gt1x_write_and_readback(u16 addr,u8 * buffer,s32 len)690 int gt1x_write_and_readback(u16 addr, u8 *buffer, s32 len)
691 {
692 	int ret;
693 	u8 d[len];
694 
695 	ret = gt1x_i2c_write(addr, buffer, len);
696 	if (ret < 0)
697 		return -1;
698 
699 	ret = gt1x_i2c_read(addr, d, len);
700 	if (ret < 0 || memcmp(buffer, d, len))
701 		return -1;
702 
703 	return 0;
704 }
705 
gt1x_incell_reset(void)706 int gt1x_incell_reset(void)
707 {
708 #define RST_RETRY       5
709 	int ret, retry = RST_RETRY;
710 	u8 d[2];
711 
712 	do {
713 		/* select i2c address */
714 		gt1x_select_addr();
715 
716 		/* test i2c */
717 		ret = gt1x_i2c_read(0x4220, d, 1);
718 
719 	} while (--retry && ret < 0);
720 
721 	if (ret < 0) {
722 		return -1;
723 	}
724 
725 	/* Stop cpu of the touch ic */
726 	retry = RST_RETRY;
727 	do {
728 		d[0] = 0x0C;
729 		ret = gt1x_write_and_readback(0x4180, d, 1);
730 
731 	} while (--retry && ret < 0);
732 
733 	if (ret < 0) {
734 		GTP_ERROR("Hold error.");
735 		return -1;
736 	}
737 
738 	/* skip sensor id check. [start] */
739 	retry = RST_RETRY;
740 	do {
741 		d[0] = 0x00;
742 		ret = gt1x_write_and_readback(0x4305, d, 1);
743 		if (ret < 0)
744 			continue;
745 
746 		d[0] = 0x2B;
747 		d[1] = 0x24;
748 		ret = gt1x_write_and_readback(0x42c4, d, 2);
749 		if (ret < 0)
750 			continue;
751 
752 		d[0] = 0xE1;
753 		d[1] = 0xD3;
754 		ret = gt1x_write_and_readback(0x42e4, d, 2);
755 		if (ret < 0)
756 			continue;
757 		d[0] = 0x01;
758 		ret = gt1x_write_and_readback(0x4305, d, 1);
759 		if (ret < 0)
760 			continue;
761 		else
762 			break;
763 	} while (--retry);
764 
765 	if (!retry)
766 		return -1;
767 	/* skip sensor id check. [end] */
768 
769 	/* release hold of cpu */
770 	retry = RST_RETRY;
771 	do {
772 		d[0] = 0x00;
773 		ret = gt1x_write_and_readback(0x4180, d, 1);
774 
775 	} while (--retry && ret < 0);
776 
777 	if (ret < 0)
778 		return -1;
779 
780 	return 0;
781 }
782 #endif
783 
gt1x_reset_guitar(void)784 s32 gt1x_reset_guitar(void)
785 {
786 	int ret;
787 
788 	GTP_INFO("GTP RESET!");
789 
790 #if GTP_INCELL_PANEL
791 	ret = gt1x_incell_reset();
792 	if (ret < 0)
793 		return ret;
794 #else
795 	gt1x_select_addr();
796 	usleep_range(8000, 9000);     /* must >= 6ms */
797 #endif
798 
799 	/* int synchronization */
800 	GTP_GPIO_OUTPUT(GTP_INT_PORT, 0);
801 	msleep(50);
802 	GTP_GPIO_AS_INT(GTP_INT_PORT);
803 
804 	/* this operation is necessary even when the esd check
805 	   fucntion dose not turn on */
806 	ret = gt1x_set_reset_status();
807 	return ret;
808 }
809 
810 /**
811  * gt1x_read_version - Read gt1x version info.
812  * @ver_info: address to store version info
813  * Return 0-succeed.
814  */
gt1x_read_version(struct gt1x_version_info * ver_info)815 s32 gt1x_read_version(struct gt1x_version_info *ver_info)
816 {
817 	s32 ret = -1;
818 	u8 buf[12] = { 0 };
819 	u32 mask_id = 0;
820 	u32 patch_id = 0;
821 	u8 product_id[5] = { 0 };
822 	u8 sensor_id = 0;
823 	u8 match_opt = 0;
824 	unsigned int i, retry = 3;
825 	u8 checksum = 0;
826 
827 	GTP_DEBUG_FUNC();
828 
829 	while (retry--) {
830 		ret = gt1x_i2c_read_dbl_check(GTP_REG_VERSION, buf, sizeof(buf));
831 		if (!ret) {
832 			checksum = 0;
833 
834 			for (i = 0; i < sizeof(buf); i++) {
835 				checksum += buf[i];
836 			}
837 
838 			if (checksum == 0 &&	/* first 3 bytes must be number or char */
839 			    IS_NUM_OR_CHAR(buf[0]) && IS_NUM_OR_CHAR(buf[1]) && IS_NUM_OR_CHAR(buf[2]) && buf[10] != 0xFF) {	/*sensor id == 0xFF, retry */
840 				break;
841 			} else {
842 				GTP_ERROR("Read version failed!(checksum error)");
843 			}
844 		} else {
845 			GTP_ERROR("Read version failed!");
846 		}
847 		GTP_DEBUG("Read version : %d", retry);
848 		msleep(100);
849 	}
850 
851 	if (retry <= 0) {
852 		if (ver_info)
853 			ver_info->sensor_id = 0;
854 		return -1;
855 	}
856 
857 	mask_id = (u32) ((buf[7] << 16) | (buf[8] << 8) | buf[9]);
858 	patch_id = (u32) ((buf[4] << 16) | (buf[5] << 8) | buf[6]);
859 	memcpy(product_id, buf, 4);
860 	sensor_id = buf[10] & 0x0F;
861 	match_opt = (buf[10] >> 4) & 0x0F;
862 
863 	GTP_INFO("IC VERSION:GT%s_%06X(Patch)_%04X(Mask)_%02X(SensorID)", product_id, patch_id, mask_id >> 8, sensor_id);
864 
865 	if (ver_info != NULL) {
866 		ver_info->mask_id = mask_id;
867 		ver_info->patch_id = patch_id;
868 		memcpy(ver_info->product_id, product_id, 5);
869 		ver_info->sensor_id = sensor_id;
870 		ver_info->match_opt = match_opt;
871 	}
872 	return 0;
873 }
874 
875 /**
876  * gt1x_get_chip_type - get chip type .
877  *
878  * different chip synchronize in different way,
879  */
gt1x_get_chip_type(void)880 s32 gt1x_get_chip_type(void)
881 {
882 	u8 opr_buf[4] = { 0x00 };
883 	u8 gt1x_data[] = { 0x02, 0x08, 0x90, 0x00 };
884 	u8 gt9l_data[] = { 0x03, 0x10, 0x90, 0x00 };
885 	s32 ret = -1;
886 
887 	/* chip type already exist */
888 	if (gt1x_chip_type != CHIP_TYPE_NONE) {
889 		return 0;
890 	}
891 
892 	/* read hardware */
893 	ret = gt1x_i2c_read_dbl_check(GTP_REG_HW_INFO, opr_buf, sizeof(opr_buf));
894 	if (ret) {
895 		GTP_ERROR("I2c communication error.");
896 		return -1;
897 	}
898 
899 	/* find chip type */
900 	if (!memcmp(opr_buf, gt1x_data, sizeof(gt1x_data))) {
901 		gt1x_chip_type = CHIP_TYPE_GT1X;
902 	} else if (!memcmp(opr_buf, gt9l_data, sizeof(gt9l_data))) {
903 		gt1x_chip_type = CHIP_TYPE_GT2X;
904 	}
905 
906 	if (gt1x_chip_type != CHIP_TYPE_NONE) {
907 		GTP_INFO("Chip Type: %s", (gt1x_chip_type == CHIP_TYPE_GT1X) ? "GT1X" : "GT2X");
908 		return 0;
909 	} else {
910 		return -1;
911 	}
912 }
913 
914 /**
915  * gt1x_enter_sleep - Eter sleep function.
916  *
917  * Returns  0--success,non-0--fail.
918  */
gt1x_enter_sleep(void)919 static s32 gt1x_enter_sleep(void)
920 {
921 	s32 retry = 0;
922 
923 #if GTP_POWER_CTRL_SLEEP
924 	if (!gt1x_power_switch(SWITCH_OFF)) {
925 		GTP_INFO("Enter sleep mode by poweroff");
926 		return 0;
927 	}
928 #endif
929 
930 	if (gt1x_wakeup_level == 1) {	/* high level wakeup */
931 		GTP_GPIO_OUTPUT(GTP_INT_PORT, 0);
932 	}
933 	usleep_range(5000, 6000);
934 
935 	while (retry++ < 3) {
936 		if (!gt1x_send_cmd(GTP_CMD_SLEEP, 0)) {
937 			GTP_INFO("Enter sleep mode!");
938 			return 0;
939 		}
940 		usleep_range(10000, 11000);
941 	}
942 
943 	GTP_ERROR("Enter sleep mode failed.");
944 	return -1;
945 }
946 
947 /**
948  * gt1x_wakeup_sleep - wakeup from sleep mode Function.
949  *
950  * Return: 0--success,non-0--fail.
951  */
gt1x_wakeup_sleep(void)952 static s32 gt1x_wakeup_sleep(void)
953 {
954 	u8 retry = 0;
955 	s32 ret = -1;
956 	int flag = 0;
957 
958 	GTP_DEBUG("Wake up begin.");
959 	gt1x_irq_disable();
960 
961 #if GTP_POWER_CTRL_SLEEP	/* power manager unit control the procedure */
962 	if (!gt1x_power_switch(SWITCH_ON)) {
963 		gt1x_power_reset();
964 		GTP_INFO("Wakeup by poweron");
965 		return 0;
966 	}
967 #endif
968 
969 	/* gesture wakeup & int port wakeup */
970 	while (retry++ < 2) {
971 #if GTP_GESTURE_WAKEUP
972 		if (gesture_enabled) {
973 			gesture_doze_status = DOZE_DISABLED;
974 			ret = gt1x_reset_guitar();
975 			if (!ret) {
976 				break;
977 			}
978 		} else
979 #endif
980 		{
981 			/* wake up through int port */
982 			GTP_GPIO_OUTPUT(GTP_INT_PORT, gt1x_wakeup_level);
983 			usleep_range(5000, 6000);
984 
985 			/* Synchronize int IO */
986 			GTP_GPIO_OUTPUT(GTP_INT_PORT, 0);
987 			msleep(50);
988 			GTP_GPIO_AS_INT(GTP_INT_PORT);
989 			flag = 1;
990 
991 #if GTP_ESD_PROTECT
992 			ret = gt1x_set_reset_status();
993 #else
994 			ret = gt1x_i2c_test();
995 #endif
996 			if (!ret)
997 				break;
998 		} /* end int wakeup */
999 	}
1000 
1001 	if (ret < 0 && flag) {		/* int  wakeup failed , try waking up by reset */
1002 		while (retry--) {
1003 			ret = gt1x_reset_guitar();
1004 			if (!ret)
1005 				break;
1006 		}
1007 	}
1008 
1009 	if (ret) {
1010 		GTP_ERROR("Wake up sleep failed.");
1011 		return -1;
1012 	} else {
1013 		GTP_INFO("Wake up end.");
1014 		return 0;
1015 	}
1016 }
1017 
1018 /**
1019  * gt1x_send_cmd - seng cmd
1020  * must write data & checksum first
1021  * byte    content
1022  * 0       cmd
1023  * 1       data
1024  * 2       checksum
1025  * Returns 0 - succeed,non-0 - failed
1026  */
gt1x_send_cmd(u8 cmd,u8 data)1027 s32 gt1x_send_cmd(u8 cmd, u8 data)
1028 {
1029 	s32 ret;
1030 	static DEFINE_MUTEX(cmd_mutex);
1031 	u8 buffer[3] = { cmd, data, 0 };
1032 
1033 	mutex_lock(&cmd_mutex);
1034 	buffer[2] = (u8) ((0 - cmd - data) & 0xFF);
1035 	ret = gt1x_i2c_write(GTP_REG_CMD + 1, &buffer[1], 2);
1036 	ret |= gt1x_i2c_write(GTP_REG_CMD, &buffer[0], 1);
1037 	msleep(50);
1038 	mutex_unlock(&cmd_mutex);
1039 
1040 	return ret;
1041 }
1042 
gt1x_power_reset(void)1043 void gt1x_power_reset(void)
1044 {
1045 	static int rst_flag;
1046 	s32 i = 0;
1047 
1048 	if (rst_flag || update_info.status) {
1049 		return;
1050 	}
1051 	GTP_INFO("force_reset_guitar");
1052 	rst_flag = 1;
1053 	gt1x_irq_disable();
1054 	gt1x_power_switch(SWITCH_OFF);
1055 	msleep(30);
1056 	gt1x_power_switch(SWITCH_ON);
1057 	msleep(30);
1058 
1059 	for (i = 0; i < 5; i++) {
1060 		if (gt1x_reset_guitar()) {
1061 			continue;
1062 		}
1063 		if (gt1x_send_cfg(gt1x_config, gt1x_cfg_length)) {
1064 			msleep(500);
1065 			continue;
1066 		}
1067 		break;
1068 	}
1069 	gt1x_irq_enable();
1070 	rst_flag = 0;
1071 }
1072 
gt1x_request_event_handler(void)1073 s32 gt1x_request_event_handler(void)
1074 {
1075 	s32 ret = -1;
1076 	u8 rqst_data = 0;
1077 
1078 	ret = gt1x_i2c_read(GTP_REG_RQST, &rqst_data, 1);
1079 	if (ret) {
1080 		GTP_ERROR("I2C transfer error. errno:%d", ret);
1081 		return -1;
1082 	}
1083 	GTP_DEBUG("Request state:0x%02x.", rqst_data);
1084 	switch (rqst_data & 0x0F) {
1085 	case GTP_RQST_CONFIG:
1086 		GTP_INFO("Request Config.");
1087 		ret = gt1x_send_cfg(gt1x_config, gt1x_cfg_length);
1088 		if (ret) {
1089 			GTP_ERROR("Send gt1x_config error.");
1090 		} else {
1091 			GTP_INFO("Send gt1x_config success.");
1092 			rqst_data = GTP_RQST_RESPONDED;
1093 			gt1x_i2c_write(GTP_REG_RQST, &rqst_data, 1);
1094 		}
1095 		break;
1096 	case GTP_RQST_RESET:
1097 		GTP_INFO("Request Reset.");
1098 		gt1x_reset_guitar();
1099 		rqst_data = GTP_RQST_RESPONDED;
1100 		gt1x_i2c_write(GTP_REG_RQST, &rqst_data, 1);
1101 		break;
1102 	case GTP_RQST_BAK_REF:
1103 		GTP_INFO("Request Ref.");
1104 		break;
1105 	case GTP_RQST_MAIN_CLOCK:
1106 		GTP_INFO("Request main clock.");
1107 		break;
1108 #if GTP_HOTKNOT
1109 	case GTP_RQST_HOTKNOT_CODE:
1110 		GTP_INFO("Request HotKnot Code.");
1111 		break;
1112 #endif
1113 	default:
1114 		break;
1115 	}
1116 	return 0;
1117 }
1118 
1119 /**
1120  * gt1x_touch_event_handler - handle touch event
1121  * (pen event, key event, finger touch envent)
1122  * @data:
1123  * Return    <0: failed, 0: succeed
1124  */
gt1x_touch_event_handler(u8 * data,struct input_dev * dev,struct input_dev * pen_dev)1125 s32 gt1x_touch_event_handler(u8 *data, struct input_dev *dev, struct input_dev *pen_dev)
1126 {
1127 	u8 touch_data[1 + 8 * GTP_MAX_TOUCH + 2] = { 0 };
1128 	static u16 pre_event;
1129 	static u16 pre_index;
1130 	u8 touch_num = 0;
1131 	u8 key_value = 0;
1132 	u16 cur_event = 0;
1133 	u8 *coor_data = NULL;
1134 	u8 check_sum = 0;
1135 	s32 input_x = 0;
1136 	s32 input_y = 0;
1137 	s32 input_w = 0;
1138 	s32 id = 0;
1139 	s32 i = 0;
1140 	s32 ret = -1;
1141 
1142 	GTP_DEBUG_FUNC();
1143 	touch_num = data[0] & 0x0f;
1144 	if (touch_num > GTP_MAX_TOUCH) {
1145 		GTP_ERROR("Illegal finger number!");
1146 		return ERROR_VALUE;
1147 	}
1148 
1149 	memcpy(touch_data, data, 11);
1150 
1151 	/* read the remaining coor data
1152 	 * 0x814E(touch status) + 8(every coordinate consist of 8 bytes data) * touch num +
1153 	 * keycode + checksum
1154 	 */
1155 	if (touch_num > 1) {
1156 		ret = gt1x_i2c_read((GTP_READ_COOR_ADDR + 11), &touch_data[11], 1 + 8 * touch_num + 2 - 11);
1157 		if (ret) {
1158 			return ret;
1159 		}
1160 	}
1161 
1162 	/* cacl checksum */
1163 	for (i = 0; i < 1 + 8 * touch_num + 2; i++) {
1164 		check_sum += touch_data[i];
1165 	}
1166 	if (check_sum) { /* checksum error*/
1167 		ret = gt1x_i2c_read(GTP_READ_COOR_ADDR, touch_data, 3 + 8 * touch_num);
1168 		if (ret) {
1169 			return ret;
1170 		}
1171 
1172 		for (i = 0, check_sum = 0; i < 3 + 8 * touch_num; i++) {
1173 			check_sum += touch_data[i];
1174 		}
1175 		if (check_sum) {
1176 			GTP_ERROR("Checksum error[%x]", check_sum);
1177 			return ERROR_VALUE;
1178 		}
1179 	}
1180 	/*
1181 	 * cur_event , pre_event bit defination
1182 	 * bits:     bit4	bit3		    bit2	 bit1	   bit0
1183 	 * event:  hover  stylus_key  stylus    key    touch
1184 	 */
1185 	key_value = touch_data[1 + 8 * touch_num];
1186 	/*  start check current event */
1187 	if ((touch_data[0] & 0x10) && key_value) {
1188 #if (GTP_HAVE_STYLUS_KEY || GTP_HAVE_TOUCH_KEY || TPD_HAVE_BUTTON)
1189 		/* get current key states */
1190 		if (key_value & 0xF0) {
1191 			SET_BIT(cur_event, BIT_STYLUS_KEY);
1192 		} else if (key_value & 0x0F) {
1193 			SET_BIT(cur_event, BIT_TOUCH_KEY);
1194 		}
1195 #endif
1196 	}
1197 #if GTP_WITH_STYLUS
1198 	else if (touch_data[1] & 0x80) {
1199 		SET_BIT(cur_event, BIT_STYLUS);
1200 	}
1201 #endif
1202 	else if (touch_num) {
1203 		SET_BIT(cur_event, BIT_TOUCH);
1204 	}
1205 
1206 	/* start handle current event and pre-event */
1207 #if GTP_HAVE_STYLUS_KEY
1208 	if (CHK_BIT(cur_event, BIT_STYLUS_KEY) || CHK_BIT(pre_event, BIT_STYLUS_KEY)) {
1209 		/*
1210 		 * 0x10 -- stylus key0 down
1211 		 * 0x20 -- stylus key1 down
1212 		 * 0x40 -- stylus key0 & stylus key1 both down
1213 		 */
1214 		u8 temp = (key_value & 0x40) ? 0x30 : key_value;
1215 		for (i = 4; i < 6; i++) {
1216 			input_report_key(pen_dev, gt1x_stylus_key_array[i - 4], temp & (0x01 << i));
1217 		}
1218 		GTP_DEBUG("Stulus key event.");
1219 	}
1220 #endif
1221 
1222 #if GTP_WITH_STYLUS
1223 	if (CHK_BIT(cur_event, BIT_STYLUS)) {
1224 		coor_data = &touch_data[1];
1225 		id = coor_data[0] & 0x7F;
1226 		input_x = coor_data[1] | (coor_data[2] << 8);
1227 		input_y = coor_data[3] | (coor_data[4] << 8);
1228 		input_w = coor_data[5] | (coor_data[6] << 8);
1229 
1230 		input_x = GTP_WARP_X(gt1x_abs_x_max, input_x);
1231 		input_y = GTP_WARP_Y(gt1x_abs_y_max, input_y);
1232 
1233 		GTP_DEBUG("Pen touch DOWN.");
1234 		gt1x_pen_down(input_x, input_y, input_w, 0);
1235 	} else if (CHK_BIT(pre_event, BIT_STYLUS)) {
1236 		GTP_DEBUG("Pen touch UP.");
1237 		gt1x_pen_up(0);
1238 	}
1239 #endif
1240 
1241 #if GTP_HAVE_TOUCH_KEY
1242 	if (CHK_BIT(cur_event, BIT_TOUCH_KEY) || CHK_BIT(pre_event, BIT_TOUCH_KEY)) {
1243 		for (i = 0; i < GTP_MAX_KEY_NUM; i++) {
1244 			input_report_key(dev, gt1x_touch_key_array[i], key_value & (0x01 << i));
1245 		}
1246 		if (CHK_BIT(cur_event, BIT_TOUCH_KEY)) {
1247 			GTP_DEBUG("Key Down.");
1248 		} else {
1249 			GTP_DEBUG("Key Up.");
1250 		}
1251 	}
1252 #elif TPD_HAVE_BUTTON
1253 	if (CHK_BIT(cur_event, BIT_TOUCH_KEY) || CHK_BIT(pre_event, BIT_TOUCH_KEY)) {
1254 		for (i = 0; i < TPD_KEY_COUNT; i++) {
1255 			if (key_value & (0x01 << i)) {
1256 				gt1x_touch_down(tpd_virtual_key_array[i].x, tpd_virtual_key_array[i].y, 0, 0);
1257 				GTP_DEBUG("Key Down.");
1258 				break;
1259 			}
1260 		}
1261 		if (i == TPD_KEY_COUNT) {
1262 			gt1x_touch_up(0);
1263 			GTP_DEBUG("Key Up.");
1264 		}
1265 	}
1266 #endif
1267 
1268 	/* finger touch event*/
1269 	if (CHK_BIT(cur_event, BIT_TOUCH)) {
1270 		u8 report_num = 0;
1271 		coor_data = &touch_data[1];
1272 		id = coor_data[0] & 0x0F;
1273 		for (i = 0; i < GTP_MAX_TOUCH; i++) {
1274 			if (i == id) {
1275 				input_x = coor_data[1] | (coor_data[2] << 8);
1276 				input_y = coor_data[3] | (coor_data[4] << 8);
1277 				input_w = coor_data[5] | (coor_data[6] << 8);
1278 
1279 				input_x = GTP_WARP_X(gt1x_abs_x_max, input_x);
1280 				input_y = GTP_WARP_Y(gt1x_abs_y_max, input_y);
1281 
1282 				GTP_DEBUG("(%d)(%d,%d)[%d]", id, input_x, input_y, input_w);
1283 				gt1x_touch_down(input_x, input_y, input_w, i);
1284 				if (report_num++ < touch_num) {
1285 					coor_data += 8;
1286 					id = coor_data[0] & 0x0F;
1287 				}
1288 				pre_index |= 0x01 << i;
1289 			} else if (pre_index & (0x01 << i)) {
1290 				if (gt1x_ics_slot_report)
1291 					gt1x_touch_up(i);
1292 				pre_index &= ~(0x01 << i);
1293 			}
1294 		}
1295 	} else if (CHK_BIT(pre_event, BIT_TOUCH)) {
1296 		if (gt1x_ics_slot_report) {
1297 			int cycles = pre_index < 3 ? 3 : GTP_MAX_TOUCH;
1298 
1299 			for (i = 0; i < cycles; i++) {
1300 				if (pre_index >> i & 0x01)
1301 					gt1x_touch_up(i);
1302 			}
1303 		} else {
1304 			gt1x_touch_up(0);
1305 		}
1306 		GTP_DEBUG("Released Touch.");
1307 		pre_index = 0;
1308 	}
1309 
1310 	/* start sync input report */
1311 	if (CHK_BIT(cur_event, BIT_STYLUS_KEY | BIT_STYLUS)
1312 			|| CHK_BIT(pre_event, BIT_STYLUS_KEY | BIT_STYLUS)) {
1313 		input_sync(pen_dev);
1314 	}
1315 
1316 	if (CHK_BIT(cur_event, BIT_TOUCH_KEY | BIT_TOUCH)
1317 			|| CHK_BIT(pre_event, BIT_TOUCH_KEY | BIT_TOUCH)) {
1318 		input_sync(dev);
1319 	}
1320 
1321 	if (unlikely(!pre_event && !cur_event)) {
1322 		GTP_DEBUG("Additional Int Pulse.");
1323 	} else {
1324 		pre_event = cur_event;
1325 	}
1326 
1327 	return 0;
1328 }
1329 
1330 #if GTP_WITH_STYLUS
1331 struct input_dev *pen_dev;
1332 
gt1x_pen_init(void)1333 static void gt1x_pen_init(void)
1334 {
1335 	s32 ret = 0;
1336 
1337 	pen_dev = input_allocate_device();
1338 	if (pen_dev == NULL) {
1339 		GTP_ERROR("Failed to allocate input device for pen/stylus.");
1340 		return;
1341 	}
1342 
1343 	pen_dev->evbit[0] = BIT_MASK(EV_SYN) | BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS);
1344 	pen_dev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH);
1345 
1346 	set_bit(BTN_TOOL_PEN, pen_dev->keybit);
1347 	set_bit(INPUT_PROP_DIRECT, pen_dev->propbit);
1348 
1349 #if GTP_HAVE_STYLUS_KEY
1350 	input_set_capability(pen_dev, EV_KEY, BTN_STYLUS);
1351 	input_set_capability(pen_dev, EV_KEY, BTN_STYLUS2);
1352 #endif
1353 
1354 	input_set_abs_params(pen_dev, ABS_MT_POSITION_X, 0, gt1x_abs_x_max, 0, 0);
1355 	input_set_abs_params(pen_dev, ABS_MT_POSITION_Y, 0, gt1x_abs_y_max, 0, 0);
1356 	input_set_abs_params(pen_dev, ABS_MT_PRESSURE, 0, 255, 0, 0);
1357 	input_set_abs_params(pen_dev, ABS_MT_TOUCH_MAJOR, 0, 255, 0, 0);
1358 	input_set_abs_params(pen_dev, ABS_MT_TRACKING_ID, 0, 255, 0, 0);
1359 
1360 	pen_dev->name = "goodix-pen";
1361 	pen_dev->phys = "input/ts";
1362 	pen_dev->id.bustype = BUS_I2C;
1363 
1364 	ret = input_register_device(pen_dev);
1365 	if (ret) {
1366 		GTP_ERROR("Register %s input device failed", pen_dev->name);
1367 		return;
1368 	}
1369 }
1370 
gt1x_pen_down(s32 x,s32 y,s32 size,s32 id)1371 void gt1x_pen_down(s32 x, s32 y, s32 size, s32 id)
1372 {
1373 	input_report_key(pen_dev, BTN_TOOL_PEN, 1);
1374 #if GTP_CHANGE_X2Y
1375 	GTP_SWAP(x, y);
1376 #endif
1377 
1378 	if (gt1x_ics_slot_report) {
1379 		input_mt_slot(pen_dev, id);
1380 		input_report_abs(pen_dev, ABS_MT_PRESSURE, size);
1381 		input_report_abs(pen_dev, ABS_MT_TOUCH_MAJOR, size);
1382 		input_report_abs(pen_dev, ABS_MT_TRACKING_ID, id);
1383 		input_report_abs(pen_dev, ABS_MT_POSITION_X, x);
1384 		input_report_abs(pen_dev, ABS_MT_POSITION_Y, y);
1385 	} else {
1386 		input_report_key(pen_dev, BTN_TOUCH, 1);
1387 		if ((!size) && (!id)) {
1388 			/* for virtual button */
1389 			input_report_abs(pen_dev, ABS_MT_PRESSURE, 100);
1390 			input_report_abs(pen_dev, ABS_MT_TOUCH_MAJOR, 100);
1391 		} else {
1392 			input_report_abs(pen_dev, ABS_MT_PRESSURE, size);
1393 			input_report_abs(pen_dev, ABS_MT_TOUCH_MAJOR, size);
1394 			input_report_abs(pen_dev, ABS_MT_TRACKING_ID, id);
1395 		}
1396 		input_report_abs(pen_dev, ABS_MT_POSITION_X, x);
1397 		input_report_abs(pen_dev, ABS_MT_POSITION_Y, y);
1398 		input_mt_sync(pen_dev);
1399 	}
1400 }
1401 
gt1x_pen_up(s32 id)1402 void gt1x_pen_up(s32 id)
1403 {
1404 	input_report_key(pen_dev, BTN_TOOL_PEN, 0);
1405 	if (gt1x_ics_slot_report) {
1406 		input_mt_slot(pen_dev, id);
1407 		input_report_abs(pen_dev, ABS_MT_TRACKING_ID, -1);
1408 	} else {
1409 		input_report_key(pen_dev, BTN_TOUCH, 0);
1410 		input_mt_sync(pen_dev);
1411 	}
1412 }
1413 #endif
1414 
1415 /**
1416  * Proximity Module
1417  */
1418 #if GTP_PROXIMITY
1419 #define GTP_PS_DEV_NAME             "goodix_proximity"
1420 #define GTP_REG_PROXIMITY_ENABLE    0x8049
1421 #define PS_FARAWAY                  1
1422 #define PS_NEAR                     0
1423 struct gt1x_ps_device{
1424     int enabled; /* module enabled/disabled */
1425     int state;   /* Faraway or Near */
1426 #ifdef PLATFORM_MTK
1427     struct hwmsen_object obj_ps;
1428 #else
1429     struct input_dev *input_dev;
1430     struct kobject *kobj;
1431 #endif
1432 };
1433 static struct gt1x_ps_device *gt1x_ps_dev;
1434 
gt1x_ps_report(int state)1435 static void gt1x_ps_report(int state)
1436 {
1437 #ifdef PLATFORM_MTK
1438 	s32 ret = -1;
1439 
1440 	hwm_sensor_data sensor_data;
1441 	/*map and store data to hwm_sensor_data*/
1442 	sensor_data.values[0] = !!state;
1443 	sensor_data.value_divide = 1;
1444 	sensor_data.status = SENSOR_STATUS_ACCURACY_MEDIUM;
1445 	/*report to the up-layer*/
1446 	ret = hwmsen_get_interrupt_data(ID_PROXIMITY, &sensor_data);
1447 	if (ret) {
1448 		GTP_ERROR("Call hwmsen_get_interrupt_data fail = %d\n", ret);
1449 	}
1450 #else
1451 	input_report_abs(gt1x_ps_dev->input_dev, ABS_DISTANCE, !!state);
1452 	input_sync(gt1x_ps_dev->input_dev);
1453 #endif /* End PLATFROM_MTK */
1454 
1455 	GTP_INFO("Report proximity state: %s", state == PS_FARAWAY ? "FARAWAY":"NEAR");
1456 }
1457 
gt1x_ps_enable(s32 enable)1458 static s32 gt1x_ps_enable(s32 enable)
1459 {
1460 	u8 state;
1461 	s32 ret = -1;
1462 
1463 	GTP_INFO("Proximity function to be %s.", enable ? "on" : "off");
1464 	state = enable ? 1 : 0;
1465 	if (gt1x_chip_type == CHIP_TYPE_GT1X)
1466 		ret = gt1x_i2c_write(GTP_REG_PROXIMITY_ENABLE, &state, 1);
1467 	else if (gt1x_chip_type == CHIP_TYPE_GT2X)
1468 		ret = gt1x_send_cmd(state ? 0x12 : 0x13, 0);
1469 	if (ret) {
1470 		GTP_ERROR("GTP %s proximity cmd failed.", state ? "enable" : "disable");
1471 	}
1472 
1473 	if (!ret && enable) {
1474 		gt1x_ps_dev->enabled = 1;
1475 	} else {
1476 		gt1x_ps_dev->enabled = 0;
1477 	}
1478 	gt1x_ps_dev->state = PS_FARAWAY;
1479 	GTP_INFO("Proximity function %s %s.", state ? "enable" : "disable", ret ? "fail" : "success");
1480 	return ret;
1481 }
1482 
gt1x_prox_event_handler(u8 * data)1483 int gt1x_prox_event_handler(u8 *data)
1484 {
1485 	u8 ps = 0;
1486 
1487 	if (gt1x_ps_dev && gt1x_ps_dev->enabled) {
1488 		ps = (data[0] & 0x60) ? 0 : 1;
1489 		if (ps != gt1x_ps_dev->state) {
1490 			gt1x_ps_report(ps);
1491 			gt1x_ps_dev->state = ps;
1492 			GTP_DEBUG("REG INDEX[0x814E]:0x%02X\n", data[0]);
1493 		}
1494 
1495 		return (ps == PS_NEAR ? 1 : 0);
1496 	}
1497 	return -1;
1498 }
1499 
1500 #ifdef PLATFORM_MTK
gt1x_get_ps_value(void)1501 static inline s32 gt1x_get_ps_value(void)
1502 {
1503 	return gt1x_ps_dev->state;
1504 }
1505 
gt1x_ps_operate(void * self,u32 command,void * buff_in,s32 size_in,void * buff_out,s32 size_out,s32 * actualout)1506 static s32 gt1x_ps_operate(void *self, u32 command, void *buff_in, s32 size_in, void *buff_out, s32 size_out, s32 *actualout)
1507 {
1508 	s32 err = 0;
1509 	s32 value;
1510 	hwm_sensor_data *sensor_data;
1511 
1512 	GTP_INFO("psensor operator cmd:%d", command);
1513 	switch (command) {
1514 	case SENSOR_DELAY:
1515 		if ((buff_in == NULL) || (size_in < sizeof(int))) {
1516 			GTP_ERROR("Set delay parameter error!");
1517 			err = -EINVAL;
1518 		}
1519 		/*Do nothing*/
1520 		break;
1521 
1522 	case SENSOR_ENABLE:
1523 		if ((buff_in == NULL) || (size_in < sizeof(int))) {
1524 			GTP_ERROR("Enable sensor parameter error!");
1525 			err = -EINVAL;
1526 		} else {
1527 			value = *(int *)buff_in;
1528 			err = gt1x_ps_enable(value);
1529 		}
1530 
1531 		break;
1532 
1533 	case SENSOR_GET_DATA:
1534 		if ((buff_out == NULL) || (size_out < sizeof(hwm_sensor_data))) {
1535 			GTP_ERROR("Get sensor data parameter error!");
1536 			err = -EINVAL;
1537 		} else {
1538 			sensor_data = (hwm_sensor_data *) buff_out;
1539 			sensor_data->values[0] = gt1x_get_ps_value();
1540 			sensor_data->value_divide = 1;
1541 			sensor_data->status = SENSOR_STATUS_ACCURACY_MEDIUM;
1542 		}
1543 
1544 		break;
1545 
1546 	default:
1547 		GTP_ERROR("proxmy sensor operate function no this parameter %d!\n", command);
1548 		err = -1;
1549 		break;
1550 	}
1551 
1552 	return err;
1553 }
1554 #endif
1555 
1556 #ifndef PLATFORM_MTK
gt1x_ps_enable_show(struct kobject * kobj,struct kobj_attribute * attr,char * buf)1557 static ssize_t gt1x_ps_enable_show(struct kobject *kobj, struct kobj_attribute *attr,
1558 		char *buf)
1559 {
1560 	return scnprintf(buf, PAGE_SIZE, "%d", gt1x_ps_dev->enabled);
1561 }
1562 
gt1x_ps_enable_store(struct kobject * kobj,struct kobj_attribute * attr,const char * buf,size_t count)1563 static ssize_t gt1x_ps_enable_store(struct kobject *kobj, struct kobj_attribute *attr,
1564 		const char *buf, size_t count)
1565 {
1566 	unsigned int input;
1567 	if (sscanf(buf, "%u", &input) != 1) {
1568 		return -EINVAL;
1569 	}
1570 	if (input == 1) {
1571 		gt1x_ps_enable(1);
1572 		gt1x_ps_report(PS_FARAWAY);
1573 	} else if (input == 0) {
1574 		gt1x_ps_report(PS_FARAWAY);
1575 		gt1x_ps_enable(0);
1576 	} else {
1577 		return -EINVAL;
1578 	}
1579 	return count;
1580 }
1581 
gt1x_ps_state_show(struct kobject * kobj,struct kobj_attribute * attr,char * buf)1582 static ssize_t gt1x_ps_state_show(struct kobject *kobj, struct kobj_attribute *attr,
1583 		char *buf)
1584 {
1585 	return scnprintf(buf, PAGE_SIZE, "%d", gt1x_ps_dev->state);
1586 }
1587 
gt1x_ps_state_store(struct kobject * kobj,struct kobj_attribute * attr,const char * buf,size_t count)1588 static ssize_t gt1x_ps_state_store(struct kobject *kobj, struct kobj_attribute *attr,
1589 		const char *buf, size_t count)
1590 {
1591 	unsigned int input;
1592 
1593 	if (sscanf(buf, "%u", &input) != 1) {
1594 		return -EINVAL;
1595 	}
1596 
1597 	if (!gt1x_ps_dev->enabled) {
1598 		return -EINVAL;
1599 	}
1600 
1601 	if (input == 1) {
1602 		gt1x_ps_dev->state = PS_FARAWAY;
1603 	} else if (input == 0) {
1604 		gt1x_ps_dev->state = PS_NEAR;
1605 	} else {
1606 		return -EINVAL;
1607 	}
1608 
1609 	gt1x_ps_report(gt1x_ps_dev->state);
1610 	return count;
1611 }
1612 
1613 static struct kobj_attribute ps_attrs[] = {
1614 	__ATTR(enable, S_IWUGO | S_IRUGO, gt1x_ps_enable_show, gt1x_ps_enable_store),
1615 	__ATTR(state, S_IWUGO | S_IRUGO, gt1x_ps_state_show, gt1x_ps_state_store)
1616 };
1617 
1618 #endif /* End PLATFORM_MTK */
1619 
gt1x_ps_init(void)1620 static int gt1x_ps_init(void)
1621 {
1622 	int err;
1623 
1624 	gt1x_ps_dev = kzalloc(sizeof(struct gt1x_ps_device), GFP_KERNEL);
1625 	if (!gt1x_ps_dev) {
1626 		return  -ENOMEM;
1627 	}
1628 
1629 	gt1x_ps_dev->state = PS_FARAWAY;
1630 
1631 #ifdef PLATFORM_MTK
1632 	gt1x_ps_dev->obj_ps.polling = 0;	/* 0--interrupt mode;1--polling mode; */
1633 	gt1x_ps_dev->obj_ps.sensor_operate = gt1x_ps_operate;
1634 
1635 	if (hwmsen_attach(ID_PROXIMITY, &gt1x_ps_dev->obj_ps)) {
1636 		GTP_ERROR("hwmsen attach fail, return:%d.", err);
1637 		goto err_exit;
1638 	}
1639 
1640 	GTP_INFO("hwmsen attach OK.");
1641 	return 0;
1642 #else
1643 	gt1x_ps_dev->input_dev = input_allocate_device();
1644 	if (!gt1x_ps_dev->input_dev) {
1645 		GTP_ERROR("Failed to alloc inpput device for proximity!");
1646 		err = -ENOMEM;
1647 		goto err_exit;
1648 	}
1649 
1650 	gt1x_ps_dev->input_dev->name = GTP_PS_DEV_NAME;
1651 	gt1x_ps_dev->input_dev->phys = "goodix/proximity";
1652 	gt1x_ps_dev->input_dev->id.bustype = BUS_I2C;
1653 	gt1x_ps_dev->input_dev->id.vendor = 0xDEED;
1654 	gt1x_ps_dev->input_dev->id.product = 0xBEEF;
1655 	gt1x_ps_dev->input_dev->id.version = 1;
1656 	set_bit(EV_ABS, gt1x_ps_dev->input_dev->evbit);
1657 	input_set_abs_params(gt1x_ps_dev->input_dev, ABS_DISTANCE, 0, 1, 0, 0);
1658 
1659 	err = input_register_device(gt1x_ps_dev->input_dev);
1660 	if (err) {
1661 		GTP_ERROR("Failed to register proximity input device: %s!", gt1x_ps_dev->input_dev->name);
1662 		goto err_register_dev;
1663 	}
1664 	/* register sysfs interface  */
1665 	if (!sysfs_rootdir) {
1666 		sysfs_rootdir = kobject_create_and_add("goodix", NULL);
1667 		if (!sysfs_rootdir) {
1668 			GTP_ERROR("Failed to create and add sysfs interface: goodix.");
1669 			err = -ENOMEM;
1670 			goto err_register_dev;
1671 		}
1672 	}
1673 
1674 	gt1x_ps_dev->kobj = kobject_create_and_add("proximity", sysfs_rootdir);
1675 	if (!gt1x_ps_dev->kobj) {
1676 		GTP_ERROR("Failed to create and add sysfs interface: proximity.");
1677 		err = -ENOMEM;
1678 		goto err_register_dev;
1679 	}
1680 	/*create sysfs files*/
1681 	{
1682 		int i;
1683 		for (i = 0; i < sizeof(ps_attrs)/sizeof(ps_attrs[0]); i++) {
1684 			if (sysfs_create_file(gt1x_ps_dev->kobj, &ps_attrs[i].attr)) {
1685 				goto err_create_file;
1686 			}
1687 		}
1688 	}
1689 
1690 	GTP_INFO("Proximity sensor init OK.");
1691 	return 0;
1692 err_create_file:
1693 	kobject_put(gt1x_ps_dev->kobj);
1694 err_register_dev:
1695 	input_free_device(gt1x_ps_dev->input_dev);
1696 #endif  /* End PLATFROM_MTK */
1697 
1698 err_exit:
1699 	kfree(gt1x_ps_dev);
1700 	gt1x_ps_dev = NULL;
1701 	return err;
1702 }
1703 
gt1x_ps_deinit(void)1704 static void gt1x_ps_deinit(void)
1705 {
1706 	if (gt1x_ps_dev) {
1707 #ifndef PLATFORM_MTK
1708 		int i = 0;
1709 		for (; i < sizeof(ps_attrs) / sizeof(ps_attrs[0]); i++) {
1710 			sysfs_remove_file(gt1x_ps_dev->kobj, &ps_attrs[i].attr);
1711 		}
1712 		kobject_del(gt1x_ps_dev->kobj);
1713 		input_free_device(gt1x_ps_dev->input_dev);
1714 #endif
1715 		kfree(gt1x_ps_dev);
1716 	}
1717 }
1718 
1719 #endif /*GTP_PROXIMITY */
1720 
1721 /**
1722  *			ESD Protect Module
1723  */
1724 #if GTP_ESD_PROTECT
1725 static int esd_work_cycle = 200;
1726 static struct delayed_work esd_check_work;
1727 static int esd_running;
1728 static struct mutex esd_lock;
1729 static void gt1x_esd_check_func(struct work_struct *);
1730 
gt1x_init_esd_protect(void)1731 void gt1x_init_esd_protect(void)
1732 {
1733 	esd_work_cycle = 2 * HZ;	/* HZ: clock ticks in 1 second generated by system */
1734 	GTP_DEBUG("Clock ticks for an esd cycle: %d", esd_work_cycle);
1735 	INIT_DELAYED_WORK(&esd_check_work, gt1x_esd_check_func);
1736 	mutex_init(&esd_lock);
1737 }
1738 
gt1x_deinit_esd_protect(void)1739 static void gt1x_deinit_esd_protect(void)
1740 {
1741 	gt1x_esd_switch(SWITCH_OFF);
1742 }
1743 
gt1x_esd_switch(s32 on)1744 void gt1x_esd_switch(s32 on)
1745 {
1746 	mutex_lock(&esd_lock);
1747 	if (SWITCH_ON == on) {	/* switch on esd check */
1748 		if (!esd_running) {
1749 			esd_running = 1;
1750 			GTP_INFO("Esd protector started!");
1751 			queue_delayed_work(gt1x_workqueue, &esd_check_work, esd_work_cycle);
1752 		}
1753 	} else {		/* switch off esd check */
1754 		if (esd_running) {
1755 			esd_running = 0;
1756 			GTP_INFO("Esd protector stoped!");
1757 			cancel_delayed_work(&esd_check_work);
1758 		}
1759 	}
1760 	mutex_unlock(&esd_lock);
1761 }
1762 
gt1x_esd_check_func(struct work_struct * work)1763 static void gt1x_esd_check_func(struct work_struct *work)
1764 {
1765 	s32 i = 0;
1766 	s32 ret = -1;
1767 	u8 esd_buf[4] = { 0 };
1768 
1769 	if (!esd_running) {
1770 		GTP_INFO("Esd protector suspended!");
1771 		return;
1772 	}
1773 
1774 	for (i = 0; i < 3; i++) {
1775 		ret = gt1x_i2c_read(GTP_REG_CMD, esd_buf, 4);
1776 		GTP_DEBUG("[Esd]0x8040 = 0x%02X, 0x8043 = 0x%02X", esd_buf[0], esd_buf[3]);
1777 		if (!ret && esd_buf[0] != 0xAA && esd_buf[3] == 0xAA) {
1778 			break;
1779 		}
1780 		msleep(50);
1781 	}
1782 
1783 	if (likely(i < 3)) {
1784 		/* IC works normally, Write 0x8040 0xAA, feed the watchdog */
1785 		gt1x_send_cmd(GTP_CMD_ESD, 0);
1786 	} else {
1787 		if (esd_running) {
1788 			GTP_ERROR("IC works abnormally! Process reset guitar.");
1789 			memset(esd_buf, 0x01, sizeof(esd_buf));
1790 			gt1x_i2c_write(0x4226, esd_buf, sizeof(esd_buf));
1791 			msleep(50);
1792 
1793 			gt1x_power_reset();
1794 		} else {
1795 			GTP_INFO("Esd protector suspended, no need reset!");
1796 		}
1797 	}
1798 
1799 	mutex_lock(&esd_lock);
1800 	if (esd_running) {
1801 		queue_delayed_work(gt1x_workqueue, &esd_check_work, esd_work_cycle);
1802 	} else {
1803 		GTP_INFO("Esd protector suspended!");
1804 	}
1805 	mutex_unlock(&esd_lock);
1806 }
1807 #endif
1808 
1809 /**
1810  *              Smart Cover Module
1811  */
1812 #if GTP_SMART_COVER
1813 struct smart_cover_device{
1814     int enabled;
1815     int state; /* 0:cover faraway 1:near */
1816     int suspended;  /* suspended or woring */
1817     struct kobject *kobj;
1818     u8 config[GTP_CONFIG_MAX_LENGTH];
1819     int cfg_len;
1820 };
1821 static struct smart_cover_device *gt1x_sc_dev;
1822 
1823 /**
1824  * gt1x_smart_cover_update_state - update smart cover config
1825  */
gt1x_smart_cover_update_state(void)1826 static int gt1x_smart_cover_update_state(void)
1827 {
1828 	int ret = 0;
1829 	struct smart_cover_device *dev = gt1x_sc_dev;
1830 
1831 	if (!dev) {
1832 		return -ENODEV;
1833 	}
1834 
1835 	if (!dev->suspended) {
1836 		if (dev->state) {  /* near */
1837 			ret = gt1x_send_cfg(dev->config, dev->cfg_len);
1838 		} else {
1839 #if GTP_CHARGER_SWITCH
1840 			gt1x_charger_config(1);  /*charger detector module check and*/
1841 			/*send a config*/
1842 #else
1843 			ret = gt1x_send_cfg(gt1x_config, gt1x_cfg_length);
1844 #endif
1845 		}
1846 		GTP_DEBUG("Update cover state %s.", dev->state ? "Nearby" : "Far away");
1847 	} else {
1848 		GTP_DEBUG("TP is suspended, do nothing.");
1849 	}
1850 	return ret;
1851 }
1852 
smart_cover_show(struct kobject * kobj,struct kobj_attribute * attr,char * buf)1853 static ssize_t smart_cover_show(struct kobject *kobj, struct kobj_attribute *attr, char *buf)
1854 {
1855 	struct smart_cover_device *dev = gt1x_sc_dev;
1856 
1857 	if (!dev) {
1858 		return -ENODEV;
1859 	}
1860 
1861 	return scnprintf(buf, PAGE_SIZE, "%d", dev->state);
1862 }
1863 
smart_cover_store(struct kobject * kobj,struct kobj_attribute * attr,const char * buf,size_t count)1864 static ssize_t smart_cover_store(struct kobject *kobj, struct kobj_attribute *attr, const char *buf, size_t count)
1865 {
1866 	struct smart_cover_device *dev = gt1x_sc_dev;
1867 	int s = (buf[0] - '0');
1868 
1869 	if (!dev || !dev->enabled || s > 1 || s == dev->state) {
1870 		return count;
1871 	}
1872 
1873 	dev->state = s;
1874 	gt1x_smart_cover_update_state();
1875 
1876 	return count;
1877 }
1878 
1879 /**
1880  * gt1x_parse_sc_cfg - parse smart cover config
1881  * @sensor_id: sensor id of the hardware
1882  */
gt1x_parse_sc_cfg(int sensor_id)1883 int gt1x_parse_sc_cfg(int sensor_id)
1884 {
1885 #undef _cfg_array_
1886 #define _cfg_array_(n)   GTP_SMART_COVER_CFG_GROUP##n
1887 	u8 *cfg;
1888 	int *len;
1889 
1890 	if (!gt1x_sc_dev)
1891 		return -ENODEV;
1892 	cfg = gt1x_sc_dev->config;
1893 	len = &gt1x_sc_dev->cfg_len;
1894 
1895 #if GTP_DRIVER_SEND_CFG
1896 	do {
1897 		u8 cfg_grp0[] = _cfg_array_(0);
1898 		u8 cfg_grp1[] = _cfg_array_(1);
1899 		u8 cfg_grp2[] = _cfg_array_(2);
1900 		u8 cfg_grp3[] = _cfg_array_(3);
1901 		u8 cfg_grp4[] = _cfg_array_(4);
1902 		u8 cfg_grp5[] = _cfg_array_(5);
1903 		u8 *cfgs[] = {
1904 			cfg_grp0, cfg_grp1, cfg_grp2,
1905 			cfg_grp3, cfg_grp4, cfg_grp5
1906 		};
1907 		u8 cfg_lens[] = {
1908 			CFG_GROUP_LEN(cfg_grp0), CFG_GROUP_LEN(cfg_grp1),
1909 			CFG_GROUP_LEN(cfg_grp2), CFG_GROUP_LEN(cfg_grp3),
1910 			CFG_GROUP_LEN(cfg_grp4), CFG_GROUP_LEN(cfg_grp5)
1911 		};
1912 
1913 		if (sensor_id >= sizeof(cfgs) / sizeof(cfgs[0])) {
1914 			GTP_ERROR("Invalid sensor id.");
1915 			return -1;
1916 		}
1917 
1918 		*len = cfg_lens[sensor_id];
1919 		if (*len == 0 || *len != gt1x_cfg_length) {
1920 			memset(cfg, 0, GTP_CONFIG_MAX_LENGTH);
1921 			*len = 0;
1922 			GTP_ERROR("Length of config is incorrect.");
1923 			return -1;
1924 		}
1925 
1926 		memcpy(cfg, cfgs[sensor_id], cfg_lens[sensor_id]);
1927 
1928 		cfg[0] &= 0x7F;
1929 		set_reg_bit(cfg[TRIGGER_LOC], 0, gt1x_int_type);
1930 		set_reg_bit(cfg[MODULE_SWITCH3_LOC], 5, !gt1x_wakeup_level);
1931 	} while (0);
1932 #endif
1933 	return 0;
1934 }
1935 
1936 
1937 static struct kobj_attribute sc_attr =
1938     __ATTR(state, S_IWUGO | S_IRUGO, smart_cover_show, smart_cover_store);
gt1x_smart_cover_init(void)1939 static int gt1x_smart_cover_init(void)
1940 {
1941 	int err = 0;
1942 
1943 	gt1x_sc_dev = kzalloc(sizeof(struct smart_cover_device), GFP_KERNEL);
1944 	if (!gt1x_sc_dev) {
1945 		GTP_ERROR("SmartCover init failed in step: 1.");
1946 		return -ENOMEM;
1947 	}
1948 
1949 	gt1x_sc_dev->enabled = 1;
1950 	gt1x_parse_sc_cfg(gt1x_version.sensor_id);
1951 
1952 	if (!sysfs_rootdir) {
1953 		/*this kobject is shared between modules, do not free it when error occur*/
1954 		sysfs_rootdir = kobject_create_and_add(GOODIX_SYSFS_DIR, NULL);
1955 		if (!sysfs_rootdir) {
1956 			err = -2;
1957 			goto exit_free_mem;
1958 		}
1959 	}
1960 
1961 	if (!gt1x_sc_dev->kobj)
1962 		gt1x_sc_dev->kobj = kobject_create_and_add("smartcover", sysfs_rootdir);
1963 	if (!gt1x_sc_dev->kobj) {
1964 		err = -3;
1965 		goto exit_free_mem;
1966 	}
1967 
1968 	if (sysfs_create_file(gt1x_sc_dev->kobj, &sc_attr.attr)) {
1969 		err = -4;
1970 		goto exit_put_kobj;
1971 	}
1972 	GTP_INFO("SmartCover module init OK.");
1973 	return 0;
1974 exit_put_kobj:
1975 	kobject_put(gt1x_sc_dev->kobj);
1976 exit_free_mem:
1977 	kfree(gt1x_sc_dev);
1978 	gt1x_sc_dev = NULL;
1979 	GTP_ERROR("SmartCover init failed in step:%d", -err);
1980 	return err;
1981 }
1982 
gt1x_smart_cover_deinit(void)1983 static void gt1x_smart_cover_deinit(void)
1984 {
1985 	if (!gt1x_sc_dev) {
1986 		return;
1987 	}
1988 
1989 	kobject_del(gt1x_sc_dev->kobj);
1990 	kfree(gt1x_sc_dev);
1991 	gt1x_sc_dev = NULL;
1992 }
1993 #endif
1994 
1995 /**
1996  * Charger Detect & Switch Module
1997  */
1998 #if GTP_CHARGER_SWITCH
1999 static u8 gt1x_config_charger[GTP_CONFIG_MAX_LENGTH] = { 0 };
2000 static struct delayed_work charger_switch_work;
2001 static int charger_work_cycle = 200;
2002 static spinlock_t charger_lock;
2003 static int charger_running;
2004 static void gt1x_charger_work_func(struct work_struct *);
2005 
2006 /**
2007  * gt1x_parse_chr_cfg - parse  charger config
2008  * @sensor_id: sensor id of the hardware
2009  * Return:  0: succeed, <0 error
2010  */
gt1x_parse_chr_cfg(int sensor_id)2011 int gt1x_parse_chr_cfg(int sensor_id)
2012 {
2013 #undef _cfg_array_
2014 #define _cfg_array_(n)   GTP_CHARGER_CFG_GROUP##n
2015 	u8 *cfg;
2016 	int len;
2017 	cfg = gt1x_config_charger;
2018 
2019 #if GTP_DRIVER_SEND_CFG
2020 	do {
2021 		u8 cfg_grp0[] = _cfg_array_(0);
2022 		u8 cfg_grp1[] = _cfg_array_(1);
2023 		u8 cfg_grp2[] = _cfg_array_(2);
2024 		u8 cfg_grp3[] = _cfg_array_(3);
2025 		u8 cfg_grp4[] = _cfg_array_(4);
2026 		u8 cfg_grp5[] = _cfg_array_(5);
2027 		u8 *cfgs[] = {
2028 			cfg_grp0, cfg_grp1, cfg_grp2,
2029 			cfg_grp3, cfg_grp4, cfg_grp5
2030 		};
2031 		u8 cfg_lens[] = {
2032 			CFG_GROUP_LEN(cfg_grp0), CFG_GROUP_LEN(cfg_grp1),
2033 			CFG_GROUP_LEN(cfg_grp2), CFG_GROUP_LEN(cfg_grp3),
2034 			CFG_GROUP_LEN(cfg_grp4), CFG_GROUP_LEN(cfg_grp5)
2035 		};
2036 
2037 		if (sensor_id >= sizeof(cfgs) / sizeof(cfgs[0])) {
2038 			return -1;
2039 		}
2040 
2041 		len = cfg_lens[sensor_id];
2042 		if (len == 0 || len != gt1x_cfg_length) {
2043 			memset(cfg, 0, GTP_CONFIG_MAX_LENGTH);
2044 			GTP_ERROR("Length of config is incorrect.");
2045 			return -1;
2046 		}
2047 
2048 		memcpy(cfg, cfgs[sensor_id], cfg_lens[sensor_id]);
2049 
2050 		cfg[0] &= 0x7F;
2051 		cfg[RESOLUTION_LOC] = (u8) gt1x_abs_x_max;
2052 		cfg[RESOLUTION_LOC + 1] = (u8) (gt1x_abs_x_max >> 8);
2053 		cfg[RESOLUTION_LOC + 2] = (u8) gt1x_abs_y_max;
2054 		cfg[RESOLUTION_LOC + 3] = (u8) (gt1x_abs_y_max >> 8);
2055 
2056 		set_reg_bit(cfg[TRIGGER_LOC], 0, gt1x_int_type);
2057 		set_reg_bit(cfg[MODULE_SWITCH3_LOC], 5, !gt1x_wakeup_level);
2058 	} while (0);
2059 #endif
2060 	return 0;
2061 }
2062 
2063 
gt1x_init_charger(void)2064 static void gt1x_init_charger(void)
2065 {
2066 	charger_work_cycle = 2 * HZ;	/* HZ: clock ticks in 1 second generated by system */
2067 	GTP_DEBUG("Clock ticks for an charger cycle: %d", charger_work_cycle);
2068 	INIT_DELAYED_WORK(&charger_switch_work, gt1x_charger_work_func);
2069 	spin_lock_init(&charger_lock);
2070 
2071 	if (gt1x_parse_chr_cfg(gt1x_version.sensor_id) < 0) {
2072 		GTP_ERROR("Error occured when parse charger config.");
2073 	}
2074 }
2075 
2076 /**
2077  * gt1x_charger_switch - switch states of charging work thread
2078  *
2079  * @on: SWITCH_ON - start work thread, SWITCH_OFF: stop .
2080  */
gt1x_charger_switch(s32 on)2081 void gt1x_charger_switch(s32 on)
2082 {
2083 	spin_lock(&charger_lock);
2084 	if (SWITCH_ON == on) {
2085 		if (!charger_running) {
2086 			charger_running = 1;
2087 			spin_unlock(&charger_lock);
2088 			GTP_INFO("Charger checker started!");
2089 			queue_delayed_work(gt1x_workqueue, &charger_switch_work, charger_work_cycle);
2090 		} else {
2091 			spin_unlock(&charger_lock);
2092 		}
2093 	} else {
2094 		if (charger_running) {
2095 			charger_running = 0;
2096 			spin_unlock(&charger_lock);
2097 			cancel_delayed_work(&charger_switch_work);
2098 			GTP_INFO("Charger checker stoped!");
2099 		} else {
2100 			spin_unlock(&charger_lock);
2101 		}
2102 	}
2103 }
2104 
2105 /**
2106  * gt1x_charger_config - check and update charging status configuration
2107  * @dir_update
2108  * 	 0: check before send charging status configuration
2109  *  	 1: directly send charging status configuration
2110  *
2111  */
gt1x_charger_config(s32 dir_update)2112 void gt1x_charger_config(s32 dir_update)
2113 {
2114 	static u8 chr_pluggedin;
2115 
2116 #if GTP_SMART_COVER
2117 	if (gt1x_sc_dev && gt1x_sc_dev->enabled
2118 			&& gt1x_sc_dev->state) {
2119 		return;
2120 	}
2121 #endif
2122 
2123 	if (gt1x_get_charger_status()) {
2124 		if (!chr_pluggedin || dir_update) {
2125 			GTP_INFO("Charger Plugin.");
2126 			if (gt1x_send_cfg(gt1x_config_charger, gt1x_cfg_length)) {
2127 				GTP_ERROR("Send config for Charger Plugin failed!");
2128 			}
2129 			if (gt1x_send_cmd(GTP_CMD_CHARGER_ON, 0)) {
2130 				GTP_ERROR("Update status for Charger Plugin failed!");
2131 			}
2132 			chr_pluggedin = 1;
2133 		}
2134 	} else {
2135 		if (chr_pluggedin || dir_update) {
2136 			GTP_INFO("Charger Plugout.");
2137 			if (gt1x_send_cfg(gt1x_config, gt1x_cfg_length)) {
2138 				GTP_ERROR("Send config for Charger Plugout failed!");
2139 			}
2140 			if (gt1x_send_cmd(GTP_CMD_CHARGER_OFF, 0)) {
2141 				GTP_ERROR("Update status for Charger Plugout failed!");
2142 			}
2143 			chr_pluggedin = 0;
2144 		}
2145 	}
2146 }
2147 
gt1x_charger_work_func(struct work_struct * work)2148 static void gt1x_charger_work_func(struct work_struct *work)
2149 {
2150 	if (!charger_running) {
2151 		GTP_INFO("Charger checker suspended!");
2152 		return;
2153 	}
2154 
2155 	gt1x_charger_config(0);
2156 
2157 	GTP_DEBUG("Charger check done!");
2158 	if (charger_running) {
2159 		queue_delayed_work(gt1x_workqueue, &charger_switch_work, charger_work_cycle);
2160 	}
2161 }
2162 #endif
2163 
gt1x_suspend(void)2164 int gt1x_suspend(void)
2165 {
2166 	s32 ret = -1;
2167 #if GTP_HOTKNOT && !HOTKNOT_BLOCK_RW
2168 	u8 buf[1] = { 0 };
2169 #endif
2170 
2171 	if (update_info.status) {
2172 		return 0;
2173 	}
2174 #if GTP_SMART_COVER
2175 	if (gt1x_sc_dev) {
2176 		gt1x_sc_dev->suspended = 1;
2177 	}
2178 #endif
2179 	GTP_INFO("Suspend start...");
2180 #if GTP_PROXIMITY
2181 	if (gt1x_ps_dev && gt1x_ps_dev->enabled) {
2182 		GTP_INFO("proximity is detected!");
2183 		return 0;
2184 	}
2185 #endif
2186 
2187 #if GTP_HOTKNOT
2188 	if (hotknot_enabled) {
2189 #if HOTKNOT_BLOCK_RW
2190 		if (hotknot_paired_flag) {
2191 			GTP_INFO("hotknot is paired!");
2192 			return 0;
2193 		}
2194 #else
2195 		ret = gt1x_i2c_read_dbl_check(GTP_REG_HN_PAIRED, buf, sizeof(buf));
2196 		if ((!ret && buf[0] == 0x55) || hotknot_transfer_mode) {
2197 			GTP_DEBUG("0x81AA: 0x%02X", buf[0]);
2198 			GTP_INFO("hotknot is paired!");
2199 			return 0;
2200 		}
2201 #endif
2202 	}
2203 #endif
2204 
2205 	gt1x_halt = 1;
2206 #if GTP_ESD_PROTECT
2207 	gt1x_esd_switch(SWITCH_OFF);
2208 #endif
2209 #if GTP_CHARGER_SWITCH
2210 	gt1x_charger_switch(SWITCH_OFF);
2211 #endif
2212 	gt1x_irq_disable();
2213 
2214 #if GTP_GESTURE_WAKEUP
2215 	gesture_clear_wakeup_data();
2216 	if (gesture_enabled) {
2217 		gesture_enter_doze();
2218 		gt1x_irq_enable();
2219 		gt1x_halt = 0;
2220 	} else
2221 #endif
2222 	{
2223 		ret = gt1x_enter_sleep();
2224 		if (ret < 0) {
2225 			GTP_ERROR("Suspend failed.");
2226 		}
2227 	}
2228 
2229 	/* to avoid waking up while not sleeping
2230 	   delay 48 + 10ms to ensure reliability */
2231 	msleep(58);
2232 	GTP_INFO("Suspend end...");
2233 	return 0;
2234 }
2235 
gt1x_resume(void)2236 int gt1x_resume(void)
2237 {
2238 	s32 ret = -1;
2239 
2240 	if (update_info.status) {
2241 		return 0;
2242 	}
2243 
2244 #if GTP_SMART_COVER
2245 	if (gt1x_sc_dev) {
2246 		gt1x_sc_dev->suspended = 0;
2247 	}
2248 #endif
2249 	GTP_DEBUG("Resume start...");
2250 
2251 #if GTP_PROXIMITY
2252 	if (gt1x_ps_dev && gt1x_ps_dev->enabled) {
2253 		GTP_INFO("Proximity is on!");
2254 		return 0;
2255 	}
2256 #endif
2257 
2258 #if GTP_HOTKNOT
2259 	if (hotknot_enabled) {
2260 #if HOTKNOT_BLOCK_RW
2261 		if (hotknot_paired_flag) {
2262 			hotknot_paired_flag = 0;
2263 			GTP_INFO("Hotknot is paired!");
2264 			return 0;
2265 		}
2266 #endif
2267 	}
2268 #endif
2269 
2270 #if GTP_GESTURE_WAKEUP
2271 	/* just return 0 if IC does not suspend */
2272 	if (!gesture_enabled && !gt1x_halt)
2273 		return 0;
2274 #else
2275 	if (!gt1x_halt)
2276 		return 0;
2277 #endif
2278 
2279 	ret = gt1x_wakeup_sleep();
2280 	if (ret < 0) {
2281 		GTP_ERROR("Resume failed.");
2282 	}
2283 #if GTP_HOTKNOT
2284 	if (!hotknot_enabled) {
2285 		gt1x_send_cmd(GTP_CMD_HN_EXIT_SLAVE, 0);
2286 	}
2287 #endif
2288 
2289 #if GTP_CHARGER_SWITCH
2290 	gt1x_charger_config(0);
2291 	gt1x_charger_switch(SWITCH_ON);
2292 #endif
2293 
2294 	gt1x_halt = 0;
2295 	gt1x_irq_enable();
2296 
2297 #if GTP_ESD_PROTECT
2298 	gt1x_esd_switch(SWITCH_ON);
2299 #endif
2300 
2301 	GTP_DEBUG("Resume end.");
2302 	return 0;
2303 }
2304 
gt1x_init(void)2305 s32 gt1x_init(void)
2306 {
2307 	s32 ret = -1;
2308 	s32 retry = 0;
2309 	u8 reg_val[1];
2310 
2311 	/* power on */
2312 	gt1x_power_switch(SWITCH_ON);
2313 
2314 	while (retry++ < 5) {
2315 		gt1x_init_failed = 0;
2316 		/* reset ic */
2317 		ret = gt1x_reset_guitar();
2318 		if (ret != 0) {
2319 			GTP_ERROR("Reset guitar failed!");
2320 			continue;
2321 		}
2322 
2323 		/* check main system firmware */
2324 		ret = gt1x_i2c_read_dbl_check(GTP_REG_FW_CHK_MAINSYS, reg_val, 1);
2325 		if (ret != 0) {
2326 			continue;
2327 		} else if (reg_val[0] != 0xBE) {
2328 			GTP_ERROR("Check main system not pass[0x%2X].", reg_val[0]);
2329 			gt1x_init_failed = 1;
2330 		}
2331 
2332 #if !GTP_AUTO_UPDATE
2333 		/* debug info  */
2334 		ret = gt1x_i2c_read_dbl_check(GTP_REG_FW_CHK_SUBSYS, reg_val, 1);
2335 		if (!ret && reg_val[0] == 0xAA) {
2336 			GTP_ERROR("Check subsystem not pass[0x%2X].", reg_val[0]);
2337 		}
2338 #endif
2339 		break;
2340 	}
2341 
2342 	/* if the initialization fails, set default setting */
2343 	ret |= gt1x_init_failed;
2344 	if (ret) {
2345 		GTP_ERROR("Init failed, use default setting");
2346 		gt1x_abs_x_max = GTP_MAX_WIDTH;
2347 		gt1x_abs_y_max = GTP_MAX_HEIGHT;
2348 		gt1x_int_type = GTP_INT_TRIGGER;
2349 		gt1x_wakeup_level = GTP_WAKEUP_LEVEL;
2350 	}
2351 
2352 	/* get chip type */
2353 	ret = gt1x_get_chip_type();
2354 	if (ret != 0) {
2355 		GTP_ERROR("Get chip type failed!");
2356 	}
2357 
2358 	/* read version information */
2359 	ret = gt1x_read_version(&gt1x_version);
2360 	if (ret != 0) {
2361 		GTP_ERROR("Get verision failed!");
2362 	}
2363 
2364 	/* init and send configs */
2365 	ret = gt1x_init_panel();
2366 	if (ret != 0) {
2367 		GTP_ERROR("Init panel failed.");
2368 	}
2369 
2370 	gt1x_workqueue = create_singlethread_workqueue("gt1x_workthread");
2371 	if (gt1x_workqueue == NULL) {
2372 		GTP_ERROR("Create workqueue failed!");
2373 	}
2374 
2375 	/* init auxiliary  node and functions */
2376 #if GTP_DEBUG_NODE
2377 	gt1x_init_debug_node();
2378 #endif
2379 
2380 #if GTP_CREATE_WR_NODE
2381 	gt1x_init_tool_node();
2382 #endif
2383 
2384 #if GTP_GESTURE_WAKEUP || GTP_HOTKNOT
2385 	gt1x_init_node();
2386 #endif
2387 
2388 #if GTP_PROXIMITY
2389 	gt1x_ps_init();
2390 #endif
2391 
2392 #if GTP_CHARGER_SWITCH
2393 	gt1x_init_charger();
2394 	gt1x_charger_config(1);
2395 	gt1x_charger_switch(SWITCH_ON);
2396 #endif
2397 
2398 #if GTP_SMART_COVER
2399 	gt1x_smart_cover_init();
2400 #endif
2401 
2402 #if GTP_WITH_STYLUS
2403 	gt1x_pen_init();
2404 #endif
2405 	if (ret != 0)
2406 		gt1x_power_switch(SWITCH_OFF);
2407 
2408 	return ret;
2409 }
2410 
gt1x_deinit(void)2411 void gt1x_deinit(void)
2412 {
2413 #if GTP_DEBUG_NODE
2414 	gt1x_deinit_debug_node();
2415 #endif
2416 
2417 #if GTP_GESTURE_WAKEUP || GTP_HOTKNOT
2418 	gt1x_deinit_node();
2419 #endif
2420 
2421 #if GTP_CREATE_WR_NODE
2422 	gt1x_deinit_tool_node();
2423 #endif
2424 
2425 #if GTP_ESD_PROTECT
2426 	gt1x_deinit_esd_protect();
2427 #endif
2428 
2429 #if GTP_CHARGER_SWITCH
2430 	gt1x_charger_switch(SWITCH_OFF);
2431 #endif
2432 
2433 #if GTP_PROXIMITY
2434 	gt1x_ps_deinit();
2435 #endif
2436 
2437 #if GTP_SMART_COVER
2438 	gt1x_smart_cover_deinit();
2439 #endif
2440 
2441 	if (sysfs_rootdir) {
2442 		kobject_del(sysfs_rootdir);
2443 		sysfs_rootdir = NULL;
2444 	}
2445 
2446 	if (gt1x_workqueue) {
2447 		destroy_workqueue(gt1x_workqueue);
2448 	}
2449 
2450 }
2451 
2452