xref: /linux/drivers/input/mouse/synaptics.c (revision 2ba9268dd603d23e17643437b2246acb6844953b)
1 /*
2  * Synaptics TouchPad PS/2 mouse driver
3  *
4  *   2003 Dmitry Torokhov <dtor@mail.ru>
5  *     Added support for pass-through port. Special thanks to Peter Berg Larsen
6  *     for explaining various Synaptics quirks.
7  *
8  *   2003 Peter Osterlund <petero2@telia.com>
9  *     Ported to 2.5 input device infrastructure.
10  *
11  *   Copyright (C) 2001 Stefan Gmeiner <riddlebox@freesurf.ch>
12  *     start merging tpconfig and gpm code to a xfree-input module
13  *     adding some changes and extensions (ex. 3rd and 4th button)
14  *
15  *   Copyright (c) 1997 C. Scott Ananian <cananian@alumni.priceton.edu>
16  *   Copyright (c) 1998-2000 Bruce Kalk <kall@compass.com>
17  *     code for the special synaptics commands (from the tpconfig-source)
18  *
19  * This program is free software; you can redistribute it and/or modify it
20  * under the terms of the GNU General Public License version 2 as published by
21  * the Free Software Foundation.
22  *
23  * Trademarks are the property of their respective owners.
24  */
25 
26 #include <linux/module.h>
27 #include <linux/delay.h>
28 #include <linux/dmi.h>
29 #include <linux/input/mt.h>
30 #include <linux/serio.h>
31 #include <linux/libps2.h>
32 #include <linux/slab.h>
33 #include "psmouse.h"
34 #include "synaptics.h"
35 
36 /*
37  * The x/y limits are taken from the Synaptics TouchPad interfacing Guide,
38  * section 2.3.2, which says that they should be valid regardless of the
39  * actual size of the sensor.
40  * Note that newer firmware allows querying device for maximum useable
41  * coordinates.
42  */
43 #define XMIN 0
44 #define XMAX 6143
45 #define YMIN 0
46 #define YMAX 6143
47 #define XMIN_NOMINAL 1472
48 #define XMAX_NOMINAL 5472
49 #define YMIN_NOMINAL 1408
50 #define YMAX_NOMINAL 4448
51 
52 /* Size in bits of absolute position values reported by the hardware */
53 #define ABS_POS_BITS 13
54 
55 /*
56  * These values should represent the absolute maximum value that will
57  * be reported for a positive position value. Some Synaptics firmware
58  * uses this value to indicate a finger near the edge of the touchpad
59  * whose precise position cannot be determined.
60  *
61  * At least one touchpad is known to report positions in excess of this
62  * value which are actually negative values truncated to the 13-bit
63  * reporting range. These values have never been observed to be lower
64  * than 8184 (i.e. -8), so we treat all values greater than 8176 as
65  * negative and any other value as positive.
66  */
67 #define X_MAX_POSITIVE 8176
68 #define Y_MAX_POSITIVE 8176
69 
70 /*****************************************************************************
71  *	Stuff we need even when we do not want native Synaptics support
72  ****************************************************************************/
73 
74 /*
75  * Set the synaptics touchpad mode byte by special commands
76  */
77 static int synaptics_mode_cmd(struct psmouse *psmouse, unsigned char mode)
78 {
79 	unsigned char param[1];
80 
81 	if (psmouse_sliced_command(psmouse, mode))
82 		return -1;
83 	param[0] = SYN_PS_SET_MODE2;
84 	if (ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_SETRATE))
85 		return -1;
86 	return 0;
87 }
88 
89 int synaptics_detect(struct psmouse *psmouse, bool set_properties)
90 {
91 	struct ps2dev *ps2dev = &psmouse->ps2dev;
92 	unsigned char param[4];
93 
94 	param[0] = 0;
95 
96 	ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
97 	ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
98 	ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
99 	ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
100 	ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO);
101 
102 	if (param[1] != 0x47)
103 		return -ENODEV;
104 
105 	if (set_properties) {
106 		psmouse->vendor = "Synaptics";
107 		psmouse->name = "TouchPad";
108 	}
109 
110 	return 0;
111 }
112 
113 void synaptics_reset(struct psmouse *psmouse)
114 {
115 	/* reset touchpad back to relative mode, gestures enabled */
116 	synaptics_mode_cmd(psmouse, 0);
117 }
118 
119 #ifdef CONFIG_MOUSE_PS2_SYNAPTICS
120 
121 static bool cr48_profile_sensor;
122 
123 #define ANY_BOARD_ID 0
124 struct min_max_quirk {
125 	const char * const *pnp_ids;
126 	struct {
127 		unsigned long int min, max;
128 	} board_id;
129 	int x_min, x_max, y_min, y_max;
130 };
131 
132 static const struct min_max_quirk min_max_pnpid_table[] = {
133 	{
134 		(const char * const []){"LEN0033", NULL},
135 		{ANY_BOARD_ID, ANY_BOARD_ID},
136 		1024, 5052, 2258, 4832
137 	},
138 	{
139 		(const char * const []){"LEN0042", NULL},
140 		{ANY_BOARD_ID, ANY_BOARD_ID},
141 		1232, 5710, 1156, 4696
142 	},
143 	{
144 		(const char * const []){"LEN0034", "LEN0036", "LEN0037",
145 					"LEN0039", "LEN2002", "LEN2004",
146 					NULL},
147 		{ANY_BOARD_ID, 2961},
148 		1024, 5112, 2024, 4832
149 	},
150 	{
151 		(const char * const []){"LEN2001", NULL},
152 		{ANY_BOARD_ID, ANY_BOARD_ID},
153 		1024, 5022, 2508, 4832
154 	},
155 	{
156 		(const char * const []){"LEN2006", NULL},
157 		{2691, 2691},
158 		1024, 5045, 2457, 4832
159 	},
160 	{
161 		(const char * const []){"LEN2006", NULL},
162 		{ANY_BOARD_ID, ANY_BOARD_ID},
163 		1264, 5675, 1171, 4688
164 	},
165 	{ }
166 };
167 
168 /* This list has been kindly provided by Synaptics. */
169 static const char * const topbuttonpad_pnp_ids[] = {
170 	"LEN0017",
171 	"LEN0018",
172 	"LEN0019",
173 	"LEN0023",
174 	"LEN002A",
175 	"LEN002B",
176 	"LEN002C",
177 	"LEN002D",
178 	"LEN002E",
179 	"LEN0033", /* Helix */
180 	"LEN0034", /* T431s, L440, L540, T540, W540, X1 Carbon 2nd */
181 	"LEN0035", /* X240 */
182 	"LEN0036", /* T440 */
183 	"LEN0037", /* X1 Carbon 2nd */
184 	"LEN0038",
185 	"LEN0039", /* T440s */
186 	"LEN0041",
187 	"LEN0042", /* Yoga */
188 	"LEN0045",
189 	"LEN0047",
190 	"LEN0049",
191 	"LEN2000",
192 	"LEN2001", /* Edge E431 */
193 	"LEN2002", /* Edge E531 */
194 	"LEN2003",
195 	"LEN2004", /* L440 */
196 	"LEN2005",
197 	"LEN2006", /* Edge E440/E540 */
198 	"LEN2007",
199 	"LEN2008",
200 	"LEN2009",
201 	"LEN200A",
202 	"LEN200B",
203 	NULL
204 };
205 
206 /*****************************************************************************
207  *	Synaptics communications functions
208  ****************************************************************************/
209 
210 /*
211  * Synaptics touchpads report the y coordinate from bottom to top, which is
212  * opposite from what userspace expects.
213  * This function is used to invert y before reporting.
214  */
215 static int synaptics_invert_y(int y)
216 {
217 	return YMAX_NOMINAL + YMIN_NOMINAL - y;
218 }
219 
220 /*
221  * Send a command to the synpatics touchpad by special commands
222  */
223 static int synaptics_send_cmd(struct psmouse *psmouse, unsigned char c, unsigned char *param)
224 {
225 	if (psmouse_sliced_command(psmouse, c))
226 		return -1;
227 	if (ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_GETINFO))
228 		return -1;
229 	return 0;
230 }
231 
232 /*
233  * Read the model-id bytes from the touchpad
234  * see also SYN_MODEL_* macros
235  */
236 static int synaptics_model_id(struct psmouse *psmouse)
237 {
238 	struct synaptics_data *priv = psmouse->private;
239 	unsigned char mi[3];
240 
241 	if (synaptics_send_cmd(psmouse, SYN_QUE_MODEL, mi))
242 		return -1;
243 	priv->model_id = (mi[0]<<16) | (mi[1]<<8) | mi[2];
244 	return 0;
245 }
246 
247 static int synaptics_more_extended_queries(struct psmouse *psmouse)
248 {
249 	struct synaptics_data *priv = psmouse->private;
250 	unsigned char buf[3];
251 
252 	if (synaptics_send_cmd(psmouse, SYN_QUE_MEXT_CAPAB_10, buf))
253 		return -1;
254 
255 	priv->ext_cap_10 = (buf[0]<<16) | (buf[1]<<8) | buf[2];
256 
257 	return 0;
258 }
259 
260 /*
261  * Read the board id and the "More Extended Queries" from the touchpad
262  * The board id is encoded in the "QUERY MODES" response
263  */
264 static int synaptics_query_modes(struct psmouse *psmouse)
265 {
266 	struct synaptics_data *priv = psmouse->private;
267 	unsigned char bid[3];
268 
269 	/* firmwares prior 7.5 have no board_id encoded */
270 	if (SYN_ID_FULL(priv->identity) < 0x705)
271 		return 0;
272 
273 	if (synaptics_send_cmd(psmouse, SYN_QUE_MODES, bid))
274 		return -1;
275 	priv->board_id = ((bid[0] & 0xfc) << 6) | bid[1];
276 
277 	if (SYN_MEXT_CAP_BIT(bid[0]))
278 		return synaptics_more_extended_queries(psmouse);
279 
280 	return 0;
281 }
282 
283 /*
284  * Read the firmware id from the touchpad
285  */
286 static int synaptics_firmware_id(struct psmouse *psmouse)
287 {
288 	struct synaptics_data *priv = psmouse->private;
289 	unsigned char fwid[3];
290 
291 	if (synaptics_send_cmd(psmouse, SYN_QUE_FIRMWARE_ID, fwid))
292 		return -1;
293 	priv->firmware_id = (fwid[0] << 16) | (fwid[1] << 8) | fwid[2];
294 	return 0;
295 }
296 
297 /*
298  * Read the capability-bits from the touchpad
299  * see also the SYN_CAP_* macros
300  */
301 static int synaptics_capability(struct psmouse *psmouse)
302 {
303 	struct synaptics_data *priv = psmouse->private;
304 	unsigned char cap[3];
305 
306 	if (synaptics_send_cmd(psmouse, SYN_QUE_CAPABILITIES, cap))
307 		return -1;
308 	priv->capabilities = (cap[0] << 16) | (cap[1] << 8) | cap[2];
309 	priv->ext_cap = priv->ext_cap_0c = 0;
310 
311 	/*
312 	 * Older firmwares had submodel ID fixed to 0x47
313 	 */
314 	if (SYN_ID_FULL(priv->identity) < 0x705 &&
315 	    SYN_CAP_SUBMODEL_ID(priv->capabilities) != 0x47) {
316 		return -1;
317 	}
318 
319 	/*
320 	 * Unless capExtended is set the rest of the flags should be ignored
321 	 */
322 	if (!SYN_CAP_EXTENDED(priv->capabilities))
323 		priv->capabilities = 0;
324 
325 	if (SYN_EXT_CAP_REQUESTS(priv->capabilities) >= 1) {
326 		if (synaptics_send_cmd(psmouse, SYN_QUE_EXT_CAPAB, cap)) {
327 			psmouse_warn(psmouse,
328 				     "device claims to have extended capabilities, but I'm not able to read them.\n");
329 		} else {
330 			priv->ext_cap = (cap[0] << 16) | (cap[1] << 8) | cap[2];
331 
332 			/*
333 			 * if nExtBtn is greater than 8 it should be considered
334 			 * invalid and treated as 0
335 			 */
336 			if (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) > 8)
337 				priv->ext_cap &= 0xff0fff;
338 		}
339 	}
340 
341 	if (SYN_EXT_CAP_REQUESTS(priv->capabilities) >= 4) {
342 		if (synaptics_send_cmd(psmouse, SYN_QUE_EXT_CAPAB_0C, cap)) {
343 			psmouse_warn(psmouse,
344 				     "device claims to have extended capability 0x0c, but I'm not able to read it.\n");
345 		} else {
346 			priv->ext_cap_0c = (cap[0] << 16) | (cap[1] << 8) | cap[2];
347 		}
348 	}
349 
350 	return 0;
351 }
352 
353 /*
354  * Identify Touchpad
355  * See also the SYN_ID_* macros
356  */
357 static int synaptics_identify(struct psmouse *psmouse)
358 {
359 	struct synaptics_data *priv = psmouse->private;
360 	unsigned char id[3];
361 
362 	if (synaptics_send_cmd(psmouse, SYN_QUE_IDENTIFY, id))
363 		return -1;
364 	priv->identity = (id[0]<<16) | (id[1]<<8) | id[2];
365 	if (SYN_ID_IS_SYNAPTICS(priv->identity))
366 		return 0;
367 	return -1;
368 }
369 
370 /*
371  * Read touchpad resolution and maximum reported coordinates
372  * Resolution is left zero if touchpad does not support the query
373  */
374 
375 static int synaptics_resolution(struct psmouse *psmouse)
376 {
377 	struct synaptics_data *priv = psmouse->private;
378 	unsigned char resp[3];
379 
380 	if (SYN_ID_MAJOR(priv->identity) < 4)
381 		return 0;
382 
383 	if (synaptics_send_cmd(psmouse, SYN_QUE_RESOLUTION, resp) == 0) {
384 		if (resp[0] != 0 && (resp[1] & 0x80) && resp[2] != 0) {
385 			priv->x_res = resp[0]; /* x resolution in units/mm */
386 			priv->y_res = resp[2]; /* y resolution in units/mm */
387 		}
388 	}
389 
390 	if (SYN_EXT_CAP_REQUESTS(priv->capabilities) >= 5 &&
391 	    SYN_CAP_MAX_DIMENSIONS(priv->ext_cap_0c)) {
392 		if (synaptics_send_cmd(psmouse, SYN_QUE_EXT_MAX_COORDS, resp)) {
393 			psmouse_warn(psmouse,
394 				     "device claims to have max coordinates query, but I'm not able to read it.\n");
395 		} else {
396 			priv->x_max = (resp[0] << 5) | ((resp[1] & 0x0f) << 1);
397 			priv->y_max = (resp[2] << 5) | ((resp[1] & 0xf0) >> 3);
398 			psmouse_info(psmouse,
399 				     "queried max coordinates: x [..%d], y [..%d]\n",
400 				     priv->x_max, priv->y_max);
401 		}
402 	}
403 
404 	if (SYN_CAP_MIN_DIMENSIONS(priv->ext_cap_0c) &&
405 	    (SYN_EXT_CAP_REQUESTS(priv->capabilities) >= 7 ||
406 	     /*
407 	      * Firmware v8.1 does not report proper number of extended
408 	      * capabilities, but has been proven to report correct min
409 	      * coordinates.
410 	      */
411 	     SYN_ID_FULL(priv->identity) == 0x801)) {
412 		if (synaptics_send_cmd(psmouse, SYN_QUE_EXT_MIN_COORDS, resp)) {
413 			psmouse_warn(psmouse,
414 				     "device claims to have min coordinates query, but I'm not able to read it.\n");
415 		} else {
416 			priv->x_min = (resp[0] << 5) | ((resp[1] & 0x0f) << 1);
417 			priv->y_min = (resp[2] << 5) | ((resp[1] & 0xf0) >> 3);
418 			psmouse_info(psmouse,
419 				     "queried min coordinates: x [%d..], y [%d..]\n",
420 				     priv->x_min, priv->y_min);
421 		}
422 	}
423 
424 	return 0;
425 }
426 
427 /*
428  * Apply quirk(s) if the hardware matches
429  */
430 
431 static void synaptics_apply_quirks(struct psmouse *psmouse)
432 {
433 	struct synaptics_data *priv = psmouse->private;
434 	int i;
435 
436 	for (i = 0; min_max_pnpid_table[i].pnp_ids; i++) {
437 		if (!psmouse_matches_pnp_id(psmouse,
438 					    min_max_pnpid_table[i].pnp_ids))
439 			continue;
440 
441 		if (min_max_pnpid_table[i].board_id.min != ANY_BOARD_ID &&
442 		    priv->board_id < min_max_pnpid_table[i].board_id.min)
443 			continue;
444 
445 		if (min_max_pnpid_table[i].board_id.max != ANY_BOARD_ID &&
446 		    priv->board_id > min_max_pnpid_table[i].board_id.max)
447 			continue;
448 
449 		priv->x_min = min_max_pnpid_table[i].x_min;
450 		priv->x_max = min_max_pnpid_table[i].x_max;
451 		priv->y_min = min_max_pnpid_table[i].y_min;
452 		priv->y_max = min_max_pnpid_table[i].y_max;
453 		psmouse_info(psmouse,
454 			     "quirked min/max coordinates: x [%d..%d], y [%d..%d]\n",
455 			     priv->x_min, priv->x_max,
456 			     priv->y_min, priv->y_max);
457 		break;
458 	}
459 }
460 
461 static int synaptics_query_hardware(struct psmouse *psmouse)
462 {
463 	if (synaptics_identify(psmouse))
464 		return -1;
465 	if (synaptics_model_id(psmouse))
466 		return -1;
467 	if (synaptics_firmware_id(psmouse))
468 		return -1;
469 	if (synaptics_query_modes(psmouse))
470 		return -1;
471 	if (synaptics_capability(psmouse))
472 		return -1;
473 	if (synaptics_resolution(psmouse))
474 		return -1;
475 
476 	synaptics_apply_quirks(psmouse);
477 
478 	return 0;
479 }
480 
481 static int synaptics_set_advanced_gesture_mode(struct psmouse *psmouse)
482 {
483 	static unsigned char param = 0xc8;
484 	struct synaptics_data *priv = psmouse->private;
485 
486 	if (!(SYN_CAP_ADV_GESTURE(priv->ext_cap_0c) ||
487 	      SYN_CAP_IMAGE_SENSOR(priv->ext_cap_0c)))
488 		return 0;
489 
490 	if (psmouse_sliced_command(psmouse, SYN_QUE_MODEL))
491 		return -1;
492 
493 	if (ps2_command(&psmouse->ps2dev, &param, PSMOUSE_CMD_SETRATE))
494 		return -1;
495 
496 	/* Advanced gesture mode also sends multi finger data */
497 	priv->capabilities |= BIT(1);
498 
499 	return 0;
500 }
501 
502 static int synaptics_set_mode(struct psmouse *psmouse)
503 {
504 	struct synaptics_data *priv = psmouse->private;
505 
506 	priv->mode = 0;
507 	if (priv->absolute_mode)
508 		priv->mode |= SYN_BIT_ABSOLUTE_MODE;
509 	if (priv->disable_gesture)
510 		priv->mode |= SYN_BIT_DISABLE_GESTURE;
511 	if (psmouse->rate >= 80)
512 		priv->mode |= SYN_BIT_HIGH_RATE;
513 	if (SYN_CAP_EXTENDED(priv->capabilities))
514 		priv->mode |= SYN_BIT_W_MODE;
515 
516 	if (synaptics_mode_cmd(psmouse, priv->mode))
517 		return -1;
518 
519 	if (priv->absolute_mode &&
520 	    synaptics_set_advanced_gesture_mode(psmouse)) {
521 		psmouse_err(psmouse, "Advanced gesture mode init failed.\n");
522 		return -1;
523 	}
524 
525 	return 0;
526 }
527 
528 static void synaptics_set_rate(struct psmouse *psmouse, unsigned int rate)
529 {
530 	struct synaptics_data *priv = psmouse->private;
531 
532 	if (rate >= 80) {
533 		priv->mode |= SYN_BIT_HIGH_RATE;
534 		psmouse->rate = 80;
535 	} else {
536 		priv->mode &= ~SYN_BIT_HIGH_RATE;
537 		psmouse->rate = 40;
538 	}
539 
540 	synaptics_mode_cmd(psmouse, priv->mode);
541 }
542 
543 /*****************************************************************************
544  *	Synaptics pass-through PS/2 port support
545  ****************************************************************************/
546 static int synaptics_pt_write(struct serio *serio, unsigned char c)
547 {
548 	struct psmouse *parent = serio_get_drvdata(serio->parent);
549 	char rate_param = SYN_PS_CLIENT_CMD; /* indicates that we want pass-through port */
550 
551 	if (psmouse_sliced_command(parent, c))
552 		return -1;
553 	if (ps2_command(&parent->ps2dev, &rate_param, PSMOUSE_CMD_SETRATE))
554 		return -1;
555 	return 0;
556 }
557 
558 static int synaptics_pt_start(struct serio *serio)
559 {
560 	struct psmouse *parent = serio_get_drvdata(serio->parent);
561 	struct synaptics_data *priv = parent->private;
562 
563 	serio_pause_rx(parent->ps2dev.serio);
564 	priv->pt_port = serio;
565 	serio_continue_rx(parent->ps2dev.serio);
566 
567 	return 0;
568 }
569 
570 static void synaptics_pt_stop(struct serio *serio)
571 {
572 	struct psmouse *parent = serio_get_drvdata(serio->parent);
573 	struct synaptics_data *priv = parent->private;
574 
575 	serio_pause_rx(parent->ps2dev.serio);
576 	priv->pt_port = NULL;
577 	serio_continue_rx(parent->ps2dev.serio);
578 }
579 
580 static int synaptics_is_pt_packet(unsigned char *buf)
581 {
582 	return (buf[0] & 0xFC) == 0x84 && (buf[3] & 0xCC) == 0xC4;
583 }
584 
585 static void synaptics_pass_pt_packet(struct psmouse *psmouse,
586 				     struct serio *ptport,
587 				     unsigned char *packet)
588 {
589 	struct synaptics_data *priv = psmouse->private;
590 	struct psmouse *child = serio_get_drvdata(ptport);
591 
592 	if (child && child->state == PSMOUSE_ACTIVATED) {
593 		serio_interrupt(ptport, packet[1] | priv->pt_buttons, 0);
594 		serio_interrupt(ptport, packet[4], 0);
595 		serio_interrupt(ptport, packet[5], 0);
596 		if (child->pktsize == 4)
597 			serio_interrupt(ptport, packet[2], 0);
598 	} else {
599 		serio_interrupt(ptport, packet[1], 0);
600 	}
601 }
602 
603 static void synaptics_pt_activate(struct psmouse *psmouse)
604 {
605 	struct synaptics_data *priv = psmouse->private;
606 	struct psmouse *child = serio_get_drvdata(priv->pt_port);
607 
608 	/* adjust the touchpad to child's choice of protocol */
609 	if (child) {
610 		if (child->pktsize == 4)
611 			priv->mode |= SYN_BIT_FOUR_BYTE_CLIENT;
612 		else
613 			priv->mode &= ~SYN_BIT_FOUR_BYTE_CLIENT;
614 
615 		if (synaptics_mode_cmd(psmouse, priv->mode))
616 			psmouse_warn(psmouse,
617 				     "failed to switch guest protocol\n");
618 	}
619 }
620 
621 static void synaptics_pt_create(struct psmouse *psmouse)
622 {
623 	struct serio *serio;
624 
625 	serio = kzalloc(sizeof(struct serio), GFP_KERNEL);
626 	if (!serio) {
627 		psmouse_err(psmouse,
628 			    "not enough memory for pass-through port\n");
629 		return;
630 	}
631 
632 	serio->id.type = SERIO_PS_PSTHRU;
633 	strlcpy(serio->name, "Synaptics pass-through", sizeof(serio->name));
634 	strlcpy(serio->phys, "synaptics-pt/serio0", sizeof(serio->name));
635 	serio->write = synaptics_pt_write;
636 	serio->start = synaptics_pt_start;
637 	serio->stop = synaptics_pt_stop;
638 	serio->parent = psmouse->ps2dev.serio;
639 
640 	psmouse->pt_activate = synaptics_pt_activate;
641 
642 	psmouse_info(psmouse, "serio: %s port at %s\n",
643 		     serio->name, psmouse->phys);
644 	serio_register_port(serio);
645 }
646 
647 /*****************************************************************************
648  *	Functions to interpret the absolute mode packets
649  ****************************************************************************/
650 
651 static void synaptics_parse_agm(const unsigned char buf[],
652 				struct synaptics_data *priv,
653 				struct synaptics_hw_state *hw)
654 {
655 	struct synaptics_hw_state *agm = &priv->agm;
656 	int agm_packet_type;
657 
658 	agm_packet_type = (buf[5] & 0x30) >> 4;
659 	switch (agm_packet_type) {
660 	case 1:
661 		/* Gesture packet: (x, y, z) half resolution */
662 		agm->w = hw->w;
663 		agm->x = (((buf[4] & 0x0f) << 8) | buf[1]) << 1;
664 		agm->y = (((buf[4] & 0xf0) << 4) | buf[2]) << 1;
665 		agm->z = ((buf[3] & 0x30) | (buf[5] & 0x0f)) << 1;
666 		break;
667 
668 	case 2:
669 		/* AGM-CONTACT packet: we are only interested in the count */
670 		priv->agm_count = buf[1];
671 		break;
672 
673 	default:
674 		break;
675 	}
676 }
677 
678 static void synaptics_parse_ext_buttons(const unsigned char buf[],
679 					struct synaptics_data *priv,
680 					struct synaptics_hw_state *hw)
681 {
682 	unsigned int ext_bits =
683 		(SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) + 1) >> 1;
684 	unsigned int ext_mask = GENMASK(ext_bits - 1, 0);
685 
686 	hw->ext_buttons = buf[4] & ext_mask;
687 	hw->ext_buttons |= (buf[5] & ext_mask) << ext_bits;
688 }
689 
690 static bool is_forcepad;
691 
692 static int synaptics_parse_hw_state(const unsigned char buf[],
693 				    struct synaptics_data *priv,
694 				    struct synaptics_hw_state *hw)
695 {
696 	memset(hw, 0, sizeof(struct synaptics_hw_state));
697 
698 	if (SYN_MODEL_NEWABS(priv->model_id)) {
699 		hw->w = (((buf[0] & 0x30) >> 2) |
700 			 ((buf[0] & 0x04) >> 1) |
701 			 ((buf[3] & 0x04) >> 2));
702 
703 		if ((SYN_CAP_ADV_GESTURE(priv->ext_cap_0c) ||
704 			SYN_CAP_IMAGE_SENSOR(priv->ext_cap_0c)) &&
705 		    hw->w == 2) {
706 			synaptics_parse_agm(buf, priv, hw);
707 			return 1;
708 		}
709 
710 		hw->x = (((buf[3] & 0x10) << 8) |
711 			 ((buf[1] & 0x0f) << 8) |
712 			 buf[4]);
713 		hw->y = (((buf[3] & 0x20) << 7) |
714 			 ((buf[1] & 0xf0) << 4) |
715 			 buf[5]);
716 		hw->z = buf[2];
717 
718 		hw->left  = (buf[0] & 0x01) ? 1 : 0;
719 		hw->right = (buf[0] & 0x02) ? 1 : 0;
720 
721 		if (is_forcepad) {
722 			/*
723 			 * ForcePads, like Clickpads, use middle button
724 			 * bits to report primary button clicks.
725 			 * Unfortunately they report primary button not
726 			 * only when user presses on the pad above certain
727 			 * threshold, but also when there are more than one
728 			 * finger on the touchpad, which interferes with
729 			 * out multi-finger gestures.
730 			 */
731 			if (hw->z == 0) {
732 				/* No contacts */
733 				priv->press = priv->report_press = false;
734 			} else if (hw->w >= 4 && ((buf[0] ^ buf[3]) & 0x01)) {
735 				/*
736 				 * Single-finger touch with pressure above
737 				 * the threshold. If pressure stays long
738 				 * enough, we'll start reporting primary
739 				 * button. We rely on the device continuing
740 				 * sending data even if finger does not
741 				 * move.
742 				 */
743 				if  (!priv->press) {
744 					priv->press_start = jiffies;
745 					priv->press = true;
746 				} else if (time_after(jiffies,
747 						priv->press_start +
748 							msecs_to_jiffies(50))) {
749 					priv->report_press = true;
750 				}
751 			} else {
752 				priv->press = false;
753 			}
754 
755 			hw->left = priv->report_press;
756 
757 		} else if (SYN_CAP_CLICKPAD(priv->ext_cap_0c)) {
758 			/*
759 			 * Clickpad's button is transmitted as middle button,
760 			 * however, since it is primary button, we will report
761 			 * it as BTN_LEFT.
762 			 */
763 			hw->left = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
764 
765 		} else if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities)) {
766 			hw->middle = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
767 			if (hw->w == 2)
768 				hw->scroll = (signed char)(buf[1]);
769 		}
770 
771 		if (SYN_CAP_FOUR_BUTTON(priv->capabilities)) {
772 			hw->up   = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
773 			hw->down = ((buf[0] ^ buf[3]) & 0x02) ? 1 : 0;
774 		}
775 
776 		if (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) > 0 &&
777 		    ((buf[0] ^ buf[3]) & 0x02)) {
778 			synaptics_parse_ext_buttons(buf, priv, hw);
779 		}
780 	} else {
781 		hw->x = (((buf[1] & 0x1f) << 8) | buf[2]);
782 		hw->y = (((buf[4] & 0x1f) << 8) | buf[5]);
783 
784 		hw->z = (((buf[0] & 0x30) << 2) | (buf[3] & 0x3F));
785 		hw->w = (((buf[1] & 0x80) >> 4) | ((buf[0] & 0x04) >> 1));
786 
787 		hw->left  = (buf[0] & 0x01) ? 1 : 0;
788 		hw->right = (buf[0] & 0x02) ? 1 : 0;
789 	}
790 
791 	/*
792 	 * Convert wrap-around values to negative. (X|Y)_MAX_POSITIVE
793 	 * is used by some firmware to indicate a finger at the edge of
794 	 * the touchpad whose precise position cannot be determined, so
795 	 * convert these values to the maximum axis value.
796 	 */
797 	if (hw->x > X_MAX_POSITIVE)
798 		hw->x -= 1 << ABS_POS_BITS;
799 	else if (hw->x == X_MAX_POSITIVE)
800 		hw->x = XMAX;
801 
802 	if (hw->y > Y_MAX_POSITIVE)
803 		hw->y -= 1 << ABS_POS_BITS;
804 	else if (hw->y == Y_MAX_POSITIVE)
805 		hw->y = YMAX;
806 
807 	return 0;
808 }
809 
810 static void synaptics_report_semi_mt_slot(struct input_dev *dev, int slot,
811 					  bool active, int x, int y)
812 {
813 	input_mt_slot(dev, slot);
814 	input_mt_report_slot_state(dev, MT_TOOL_FINGER, active);
815 	if (active) {
816 		input_report_abs(dev, ABS_MT_POSITION_X, x);
817 		input_report_abs(dev, ABS_MT_POSITION_Y, synaptics_invert_y(y));
818 	}
819 }
820 
821 static void synaptics_report_semi_mt_data(struct input_dev *dev,
822 					  const struct synaptics_hw_state *a,
823 					  const struct synaptics_hw_state *b,
824 					  int num_fingers)
825 {
826 	if (num_fingers >= 2) {
827 		synaptics_report_semi_mt_slot(dev, 0, true, min(a->x, b->x),
828 					      min(a->y, b->y));
829 		synaptics_report_semi_mt_slot(dev, 1, true, max(a->x, b->x),
830 					      max(a->y, b->y));
831 	} else if (num_fingers == 1) {
832 		synaptics_report_semi_mt_slot(dev, 0, true, a->x, a->y);
833 		synaptics_report_semi_mt_slot(dev, 1, false, 0, 0);
834 	} else {
835 		synaptics_report_semi_mt_slot(dev, 0, false, 0, 0);
836 		synaptics_report_semi_mt_slot(dev, 1, false, 0, 0);
837 	}
838 }
839 
840 static void synaptics_report_ext_buttons(struct psmouse *psmouse,
841 					 const struct synaptics_hw_state *hw)
842 {
843 	struct input_dev *dev = psmouse->dev;
844 	struct synaptics_data *priv = psmouse->private;
845 	int ext_bits = (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) + 1) >> 1;
846 	char buf[6] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
847 	int i;
848 
849 	if (!SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap))
850 		return;
851 
852 	/* Bug in FW 8.1, buttons are reported only when ExtBit is 1 */
853 	if (SYN_ID_FULL(priv->identity) == 0x801 &&
854 	    !((psmouse->packet[0] ^ psmouse->packet[3]) & 0x02))
855 		return;
856 
857 	if (!SYN_CAP_EXT_BUTTONS_STICK(priv->ext_cap_10)) {
858 		for (i = 0; i < ext_bits; i++) {
859 			input_report_key(dev, BTN_0 + 2 * i,
860 				hw->ext_buttons & (1 << i));
861 			input_report_key(dev, BTN_1 + 2 * i,
862 				hw->ext_buttons & (1 << (i + ext_bits)));
863 		}
864 		return;
865 	}
866 
867 	/*
868 	 * This generation of touchpads has the trackstick buttons
869 	 * physically wired to the touchpad. Re-route them through
870 	 * the pass-through interface.
871 	 */
872 	if (!priv->pt_port)
873 		return;
874 
875 	/* The trackstick expects at most 3 buttons */
876 	priv->pt_buttons = SYN_CAP_EXT_BUTTON_STICK_L(hw->ext_buttons)      |
877 			   SYN_CAP_EXT_BUTTON_STICK_R(hw->ext_buttons) << 1 |
878 			   SYN_CAP_EXT_BUTTON_STICK_M(hw->ext_buttons) << 2;
879 
880 	synaptics_pass_pt_packet(psmouse, priv->pt_port, buf);
881 }
882 
883 static void synaptics_report_buttons(struct psmouse *psmouse,
884 				     const struct synaptics_hw_state *hw)
885 {
886 	struct input_dev *dev = psmouse->dev;
887 	struct synaptics_data *priv = psmouse->private;
888 
889 	input_report_key(dev, BTN_LEFT, hw->left);
890 	input_report_key(dev, BTN_RIGHT, hw->right);
891 
892 	if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities))
893 		input_report_key(dev, BTN_MIDDLE, hw->middle);
894 
895 	if (SYN_CAP_FOUR_BUTTON(priv->capabilities)) {
896 		input_report_key(dev, BTN_FORWARD, hw->up);
897 		input_report_key(dev, BTN_BACK, hw->down);
898 	}
899 
900 	synaptics_report_ext_buttons(psmouse, hw);
901 }
902 
903 static void synaptics_report_mt_data(struct psmouse *psmouse,
904 				     const struct synaptics_hw_state *sgm,
905 				     int num_fingers)
906 {
907 	struct input_dev *dev = psmouse->dev;
908 	struct synaptics_data *priv = psmouse->private;
909 	const struct synaptics_hw_state *hw[2] = { sgm, &priv->agm };
910 	struct input_mt_pos pos[2];
911 	int slot[2], nsemi, i;
912 
913 	nsemi = clamp_val(num_fingers, 0, 2);
914 
915 	for (i = 0; i < nsemi; i++) {
916 		pos[i].x = hw[i]->x;
917 		pos[i].y = synaptics_invert_y(hw[i]->y);
918 	}
919 
920 	input_mt_assign_slots(dev, slot, pos, nsemi, 0);
921 
922 	for (i = 0; i < nsemi; i++) {
923 		input_mt_slot(dev, slot[i]);
924 		input_mt_report_slot_state(dev, MT_TOOL_FINGER, true);
925 		input_report_abs(dev, ABS_MT_POSITION_X, pos[i].x);
926 		input_report_abs(dev, ABS_MT_POSITION_Y, pos[i].y);
927 		input_report_abs(dev, ABS_MT_PRESSURE, hw[i]->z);
928 	}
929 
930 	input_mt_drop_unused(dev);
931 
932 	/* Don't use active slot count to generate BTN_TOOL events. */
933 	input_mt_report_pointer_emulation(dev, false);
934 
935 	/* Send the number of fingers reported by touchpad itself. */
936 	input_mt_report_finger_count(dev, num_fingers);
937 
938 	synaptics_report_buttons(psmouse, sgm);
939 
940 	input_sync(dev);
941 }
942 
943 static void synaptics_image_sensor_process(struct psmouse *psmouse,
944 					   struct synaptics_hw_state *sgm)
945 {
946 	struct synaptics_data *priv = psmouse->private;
947 	int num_fingers;
948 
949 	/*
950 	 * Update mt_state using the new finger count and current mt_state.
951 	 */
952 	if (sgm->z == 0)
953 		num_fingers = 0;
954 	else if (sgm->w >= 4)
955 		num_fingers = 1;
956 	else if (sgm->w == 0)
957 		num_fingers = 2;
958 	else if (sgm->w == 1)
959 		num_fingers = priv->agm_count ? priv->agm_count : 3;
960 	else
961 		num_fingers = 4;
962 
963 	/* Send resulting input events to user space */
964 	synaptics_report_mt_data(psmouse, sgm, num_fingers);
965 }
966 
967 /*
968  *  called for each full received packet from the touchpad
969  */
970 static void synaptics_process_packet(struct psmouse *psmouse)
971 {
972 	struct input_dev *dev = psmouse->dev;
973 	struct synaptics_data *priv = psmouse->private;
974 	struct synaptics_hw_state hw;
975 	int num_fingers;
976 	int finger_width;
977 
978 	if (synaptics_parse_hw_state(psmouse->packet, priv, &hw))
979 		return;
980 
981 	if (SYN_CAP_IMAGE_SENSOR(priv->ext_cap_0c)) {
982 		synaptics_image_sensor_process(psmouse, &hw);
983 		return;
984 	}
985 
986 	if (hw.scroll) {
987 		priv->scroll += hw.scroll;
988 
989 		while (priv->scroll >= 4) {
990 			input_report_key(dev, BTN_BACK, !hw.down);
991 			input_sync(dev);
992 			input_report_key(dev, BTN_BACK, hw.down);
993 			input_sync(dev);
994 			priv->scroll -= 4;
995 		}
996 		while (priv->scroll <= -4) {
997 			input_report_key(dev, BTN_FORWARD, !hw.up);
998 			input_sync(dev);
999 			input_report_key(dev, BTN_FORWARD, hw.up);
1000 			input_sync(dev);
1001 			priv->scroll += 4;
1002 		}
1003 		return;
1004 	}
1005 
1006 	if (hw.z > 0 && hw.x > 1) {
1007 		num_fingers = 1;
1008 		finger_width = 5;
1009 		if (SYN_CAP_EXTENDED(priv->capabilities)) {
1010 			switch (hw.w) {
1011 			case 0 ... 1:
1012 				if (SYN_CAP_MULTIFINGER(priv->capabilities))
1013 					num_fingers = hw.w + 2;
1014 				break;
1015 			case 2:
1016 				if (SYN_MODEL_PEN(priv->model_id))
1017 					;   /* Nothing, treat a pen as a single finger */
1018 				break;
1019 			case 4 ... 15:
1020 				if (SYN_CAP_PALMDETECT(priv->capabilities))
1021 					finger_width = hw.w;
1022 				break;
1023 			}
1024 		}
1025 	} else {
1026 		num_fingers = 0;
1027 		finger_width = 0;
1028 	}
1029 
1030 	if (cr48_profile_sensor) {
1031 		synaptics_report_mt_data(psmouse, &hw, num_fingers);
1032 		return;
1033 	}
1034 
1035 	if (SYN_CAP_ADV_GESTURE(priv->ext_cap_0c))
1036 		synaptics_report_semi_mt_data(dev, &hw, &priv->agm,
1037 					      num_fingers);
1038 
1039 	/* Post events
1040 	 * BTN_TOUCH has to be first as mousedev relies on it when doing
1041 	 * absolute -> relative conversion
1042 	 */
1043 	if (hw.z > 30) input_report_key(dev, BTN_TOUCH, 1);
1044 	if (hw.z < 25) input_report_key(dev, BTN_TOUCH, 0);
1045 
1046 	if (num_fingers > 0) {
1047 		input_report_abs(dev, ABS_X, hw.x);
1048 		input_report_abs(dev, ABS_Y, synaptics_invert_y(hw.y));
1049 	}
1050 	input_report_abs(dev, ABS_PRESSURE, hw.z);
1051 
1052 	if (SYN_CAP_PALMDETECT(priv->capabilities))
1053 		input_report_abs(dev, ABS_TOOL_WIDTH, finger_width);
1054 
1055 	input_report_key(dev, BTN_TOOL_FINGER, num_fingers == 1);
1056 	if (SYN_CAP_MULTIFINGER(priv->capabilities)) {
1057 		input_report_key(dev, BTN_TOOL_DOUBLETAP, num_fingers == 2);
1058 		input_report_key(dev, BTN_TOOL_TRIPLETAP, num_fingers == 3);
1059 	}
1060 
1061 	synaptics_report_buttons(psmouse, &hw);
1062 
1063 	input_sync(dev);
1064 }
1065 
1066 static int synaptics_validate_byte(struct psmouse *psmouse,
1067 				   int idx, unsigned char pkt_type)
1068 {
1069 	static const unsigned char newabs_mask[]	= { 0xC8, 0x00, 0x00, 0xC8, 0x00 };
1070 	static const unsigned char newabs_rel_mask[]	= { 0xC0, 0x00, 0x00, 0xC0, 0x00 };
1071 	static const unsigned char newabs_rslt[]	= { 0x80, 0x00, 0x00, 0xC0, 0x00 };
1072 	static const unsigned char oldabs_mask[]	= { 0xC0, 0x60, 0x00, 0xC0, 0x60 };
1073 	static const unsigned char oldabs_rslt[]	= { 0xC0, 0x00, 0x00, 0x80, 0x00 };
1074 	const char *packet = psmouse->packet;
1075 
1076 	if (idx < 0 || idx > 4)
1077 		return 0;
1078 
1079 	switch (pkt_type) {
1080 
1081 	case SYN_NEWABS:
1082 	case SYN_NEWABS_RELAXED:
1083 		return (packet[idx] & newabs_rel_mask[idx]) == newabs_rslt[idx];
1084 
1085 	case SYN_NEWABS_STRICT:
1086 		return (packet[idx] & newabs_mask[idx]) == newabs_rslt[idx];
1087 
1088 	case SYN_OLDABS:
1089 		return (packet[idx] & oldabs_mask[idx]) == oldabs_rslt[idx];
1090 
1091 	default:
1092 		psmouse_err(psmouse, "unknown packet type %d\n", pkt_type);
1093 		return 0;
1094 	}
1095 }
1096 
1097 static unsigned char synaptics_detect_pkt_type(struct psmouse *psmouse)
1098 {
1099 	int i;
1100 
1101 	for (i = 0; i < 5; i++)
1102 		if (!synaptics_validate_byte(psmouse, i, SYN_NEWABS_STRICT)) {
1103 			psmouse_info(psmouse, "using relaxed packet validation\n");
1104 			return SYN_NEWABS_RELAXED;
1105 		}
1106 
1107 	return SYN_NEWABS_STRICT;
1108 }
1109 
1110 static psmouse_ret_t synaptics_process_byte(struct psmouse *psmouse)
1111 {
1112 	struct synaptics_data *priv = psmouse->private;
1113 
1114 	if (psmouse->pktcnt >= 6) { /* Full packet received */
1115 		if (unlikely(priv->pkt_type == SYN_NEWABS))
1116 			priv->pkt_type = synaptics_detect_pkt_type(psmouse);
1117 
1118 		if (SYN_CAP_PASS_THROUGH(priv->capabilities) &&
1119 		    synaptics_is_pt_packet(psmouse->packet)) {
1120 			if (priv->pt_port)
1121 				synaptics_pass_pt_packet(psmouse, priv->pt_port,
1122 							 psmouse->packet);
1123 		} else
1124 			synaptics_process_packet(psmouse);
1125 
1126 		return PSMOUSE_FULL_PACKET;
1127 	}
1128 
1129 	return synaptics_validate_byte(psmouse, psmouse->pktcnt - 1, priv->pkt_type) ?
1130 		PSMOUSE_GOOD_DATA : PSMOUSE_BAD_DATA;
1131 }
1132 
1133 /*****************************************************************************
1134  *	Driver initialization/cleanup functions
1135  ****************************************************************************/
1136 static void set_abs_position_params(struct input_dev *dev,
1137 				    struct synaptics_data *priv, int x_code,
1138 				    int y_code)
1139 {
1140 	int x_min = priv->x_min ?: XMIN_NOMINAL;
1141 	int x_max = priv->x_max ?: XMAX_NOMINAL;
1142 	int y_min = priv->y_min ?: YMIN_NOMINAL;
1143 	int y_max = priv->y_max ?: YMAX_NOMINAL;
1144 	int fuzz = SYN_CAP_REDUCED_FILTERING(priv->ext_cap_0c) ?
1145 			SYN_REDUCED_FILTER_FUZZ : 0;
1146 
1147 	input_set_abs_params(dev, x_code, x_min, x_max, fuzz, 0);
1148 	input_set_abs_params(dev, y_code, y_min, y_max, fuzz, 0);
1149 	input_abs_set_res(dev, x_code, priv->x_res);
1150 	input_abs_set_res(dev, y_code, priv->y_res);
1151 }
1152 
1153 static void set_input_params(struct psmouse *psmouse,
1154 			     struct synaptics_data *priv)
1155 {
1156 	struct input_dev *dev = psmouse->dev;
1157 	int i;
1158 
1159 	/* Things that apply to both modes */
1160 	__set_bit(INPUT_PROP_POINTER, dev->propbit);
1161 	__set_bit(EV_KEY, dev->evbit);
1162 	__set_bit(BTN_LEFT, dev->keybit);
1163 	__set_bit(BTN_RIGHT, dev->keybit);
1164 
1165 	if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities))
1166 		__set_bit(BTN_MIDDLE, dev->keybit);
1167 
1168 	if (!priv->absolute_mode) {
1169 		/* Relative mode */
1170 		__set_bit(EV_REL, dev->evbit);
1171 		__set_bit(REL_X, dev->relbit);
1172 		__set_bit(REL_Y, dev->relbit);
1173 		return;
1174 	}
1175 
1176 	/* Absolute mode */
1177 	__set_bit(EV_ABS, dev->evbit);
1178 	set_abs_position_params(dev, priv, ABS_X, ABS_Y);
1179 	input_set_abs_params(dev, ABS_PRESSURE, 0, 255, 0, 0);
1180 
1181 	if (cr48_profile_sensor)
1182 		input_set_abs_params(dev, ABS_MT_PRESSURE, 0, 255, 0, 0);
1183 
1184 	if (SYN_CAP_IMAGE_SENSOR(priv->ext_cap_0c)) {
1185 		set_abs_position_params(dev, priv, ABS_MT_POSITION_X,
1186 					ABS_MT_POSITION_Y);
1187 		/* Image sensors can report per-contact pressure */
1188 		input_set_abs_params(dev, ABS_MT_PRESSURE, 0, 255, 0, 0);
1189 		input_mt_init_slots(dev, 2, INPUT_MT_POINTER | INPUT_MT_TRACK);
1190 
1191 		/* Image sensors can signal 4 and 5 finger clicks */
1192 		__set_bit(BTN_TOOL_QUADTAP, dev->keybit);
1193 		__set_bit(BTN_TOOL_QUINTTAP, dev->keybit);
1194 	} else if (SYN_CAP_ADV_GESTURE(priv->ext_cap_0c)) {
1195 		set_abs_position_params(dev, priv, ABS_MT_POSITION_X,
1196 					ABS_MT_POSITION_Y);
1197 		/*
1198 		 * Profile sensor in CR-48 tracks contacts reasonably well,
1199 		 * other non-image sensors with AGM use semi-mt.
1200 		 */
1201 		input_mt_init_slots(dev, 2,
1202 				    INPUT_MT_POINTER |
1203 				    (cr48_profile_sensor ?
1204 					INPUT_MT_TRACK : INPUT_MT_SEMI_MT));
1205 	}
1206 
1207 	if (SYN_CAP_PALMDETECT(priv->capabilities))
1208 		input_set_abs_params(dev, ABS_TOOL_WIDTH, 0, 15, 0, 0);
1209 
1210 	__set_bit(BTN_TOUCH, dev->keybit);
1211 	__set_bit(BTN_TOOL_FINGER, dev->keybit);
1212 
1213 	if (SYN_CAP_MULTIFINGER(priv->capabilities)) {
1214 		__set_bit(BTN_TOOL_DOUBLETAP, dev->keybit);
1215 		__set_bit(BTN_TOOL_TRIPLETAP, dev->keybit);
1216 	}
1217 
1218 	if (SYN_CAP_FOUR_BUTTON(priv->capabilities) ||
1219 	    SYN_CAP_MIDDLE_BUTTON(priv->capabilities)) {
1220 		__set_bit(BTN_FORWARD, dev->keybit);
1221 		__set_bit(BTN_BACK, dev->keybit);
1222 	}
1223 
1224 	if (!SYN_CAP_EXT_BUTTONS_STICK(priv->ext_cap_10))
1225 		for (i = 0; i < SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap); i++)
1226 			__set_bit(BTN_0 + i, dev->keybit);
1227 
1228 	__clear_bit(EV_REL, dev->evbit);
1229 	__clear_bit(REL_X, dev->relbit);
1230 	__clear_bit(REL_Y, dev->relbit);
1231 
1232 	if (SYN_CAP_CLICKPAD(priv->ext_cap_0c)) {
1233 		__set_bit(INPUT_PROP_BUTTONPAD, dev->propbit);
1234 		if (psmouse_matches_pnp_id(psmouse, topbuttonpad_pnp_ids) &&
1235 		    !SYN_CAP_EXT_BUTTONS_STICK(priv->ext_cap_10))
1236 			__set_bit(INPUT_PROP_TOPBUTTONPAD, dev->propbit);
1237 		/* Clickpads report only left button */
1238 		__clear_bit(BTN_RIGHT, dev->keybit);
1239 		__clear_bit(BTN_MIDDLE, dev->keybit);
1240 	}
1241 }
1242 
1243 static ssize_t synaptics_show_disable_gesture(struct psmouse *psmouse,
1244 					      void *data, char *buf)
1245 {
1246 	struct synaptics_data *priv = psmouse->private;
1247 
1248 	return sprintf(buf, "%c\n", priv->disable_gesture ? '1' : '0');
1249 }
1250 
1251 static ssize_t synaptics_set_disable_gesture(struct psmouse *psmouse,
1252 					     void *data, const char *buf,
1253 					     size_t len)
1254 {
1255 	struct synaptics_data *priv = psmouse->private;
1256 	unsigned int value;
1257 	int err;
1258 
1259 	err = kstrtouint(buf, 10, &value);
1260 	if (err)
1261 		return err;
1262 
1263 	if (value > 1)
1264 		return -EINVAL;
1265 
1266 	if (value == priv->disable_gesture)
1267 		return len;
1268 
1269 	priv->disable_gesture = value;
1270 	if (value)
1271 		priv->mode |= SYN_BIT_DISABLE_GESTURE;
1272 	else
1273 		priv->mode &= ~SYN_BIT_DISABLE_GESTURE;
1274 
1275 	if (synaptics_mode_cmd(psmouse, priv->mode))
1276 		return -EIO;
1277 
1278 	return len;
1279 }
1280 
1281 PSMOUSE_DEFINE_ATTR(disable_gesture, S_IWUSR | S_IRUGO, NULL,
1282 		    synaptics_show_disable_gesture,
1283 		    synaptics_set_disable_gesture);
1284 
1285 static void synaptics_disconnect(struct psmouse *psmouse)
1286 {
1287 	struct synaptics_data *priv = psmouse->private;
1288 
1289 	if (!priv->absolute_mode && SYN_ID_DISGEST_SUPPORTED(priv->identity))
1290 		device_remove_file(&psmouse->ps2dev.serio->dev,
1291 				   &psmouse_attr_disable_gesture.dattr);
1292 
1293 	synaptics_reset(psmouse);
1294 	kfree(priv);
1295 	psmouse->private = NULL;
1296 }
1297 
1298 static int synaptics_reconnect(struct psmouse *psmouse)
1299 {
1300 	struct synaptics_data *priv = psmouse->private;
1301 	struct synaptics_data old_priv = *priv;
1302 	unsigned char param[2];
1303 	int retry = 0;
1304 	int error;
1305 
1306 	do {
1307 		psmouse_reset(psmouse);
1308 		if (retry) {
1309 			/*
1310 			 * On some boxes, right after resuming, the touchpad
1311 			 * needs some time to finish initializing (I assume
1312 			 * it needs time to calibrate) and start responding
1313 			 * to Synaptics-specific queries, so let's wait a
1314 			 * bit.
1315 			 */
1316 			ssleep(1);
1317 		}
1318 		ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_GETID);
1319 		error = synaptics_detect(psmouse, 0);
1320 	} while (error && ++retry < 3);
1321 
1322 	if (error)
1323 		return -1;
1324 
1325 	if (retry > 1)
1326 		psmouse_dbg(psmouse, "reconnected after %d tries\n", retry);
1327 
1328 	if (synaptics_query_hardware(psmouse)) {
1329 		psmouse_err(psmouse, "Unable to query device.\n");
1330 		return -1;
1331 	}
1332 
1333 	if (synaptics_set_mode(psmouse)) {
1334 		psmouse_err(psmouse, "Unable to initialize device.\n");
1335 		return -1;
1336 	}
1337 
1338 	if (old_priv.identity != priv->identity ||
1339 	    old_priv.model_id != priv->model_id ||
1340 	    old_priv.capabilities != priv->capabilities ||
1341 	    old_priv.ext_cap != priv->ext_cap) {
1342 		psmouse_err(psmouse,
1343 			    "hardware appears to be different: id(%ld-%ld), model(%ld-%ld), caps(%lx-%lx), ext(%lx-%lx).\n",
1344 			    old_priv.identity, priv->identity,
1345 			    old_priv.model_id, priv->model_id,
1346 			    old_priv.capabilities, priv->capabilities,
1347 			    old_priv.ext_cap, priv->ext_cap);
1348 		return -1;
1349 	}
1350 
1351 	return 0;
1352 }
1353 
1354 static bool impaired_toshiba_kbc;
1355 
1356 static const struct dmi_system_id toshiba_dmi_table[] __initconst = {
1357 #if defined(CONFIG_DMI) && defined(CONFIG_X86)
1358 	{
1359 		/* Toshiba Satellite */
1360 		.matches = {
1361 			DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
1362 			DMI_MATCH(DMI_PRODUCT_NAME, "Satellite"),
1363 		},
1364 	},
1365 	{
1366 		/* Toshiba Dynabook */
1367 		.matches = {
1368 			DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
1369 			DMI_MATCH(DMI_PRODUCT_NAME, "dynabook"),
1370 		},
1371 	},
1372 	{
1373 		/* Toshiba Portege M300 */
1374 		.matches = {
1375 			DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
1376 			DMI_MATCH(DMI_PRODUCT_NAME, "PORTEGE M300"),
1377 		},
1378 
1379 	},
1380 	{
1381 		/* Toshiba Portege M300 */
1382 		.matches = {
1383 			DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
1384 			DMI_MATCH(DMI_PRODUCT_NAME, "Portable PC"),
1385 			DMI_MATCH(DMI_PRODUCT_VERSION, "Version 1.0"),
1386 		},
1387 
1388 	},
1389 #endif
1390 	{ }
1391 };
1392 
1393 static bool broken_olpc_ec;
1394 
1395 static const struct dmi_system_id olpc_dmi_table[] __initconst = {
1396 #if defined(CONFIG_DMI) && defined(CONFIG_OLPC)
1397 	{
1398 		/* OLPC XO-1 or XO-1.5 */
1399 		.matches = {
1400 			DMI_MATCH(DMI_SYS_VENDOR, "OLPC"),
1401 			DMI_MATCH(DMI_PRODUCT_NAME, "XO"),
1402 		},
1403 	},
1404 #endif
1405 	{ }
1406 };
1407 
1408 static const struct dmi_system_id __initconst cr48_dmi_table[] = {
1409 #if defined(CONFIG_DMI) && defined(CONFIG_X86)
1410 	{
1411 		/* Cr-48 Chromebook (Codename Mario) */
1412 		.matches = {
1413 			DMI_MATCH(DMI_SYS_VENDOR, "IEC"),
1414 			DMI_MATCH(DMI_PRODUCT_NAME, "Mario"),
1415 		},
1416 	},
1417 #endif
1418 	{ }
1419 };
1420 
1421 static const struct dmi_system_id forcepad_dmi_table[] __initconst = {
1422 #if defined(CONFIG_DMI) && defined(CONFIG_X86)
1423 	{
1424 		.matches = {
1425 			DMI_MATCH(DMI_SYS_VENDOR, "Hewlett-Packard"),
1426 			DMI_MATCH(DMI_PRODUCT_NAME, "HP EliteBook Folio 1040 G1"),
1427 		},
1428 	},
1429 #endif
1430 	{ }
1431 };
1432 
1433 void __init synaptics_module_init(void)
1434 {
1435 	impaired_toshiba_kbc = dmi_check_system(toshiba_dmi_table);
1436 	broken_olpc_ec = dmi_check_system(olpc_dmi_table);
1437 	cr48_profile_sensor = dmi_check_system(cr48_dmi_table);
1438 
1439 	/*
1440 	 * Unfortunately ForcePad capability is not exported over PS/2,
1441 	 * so we have to resort to checking DMI.
1442 	 */
1443 	is_forcepad = dmi_check_system(forcepad_dmi_table);
1444 }
1445 
1446 static int __synaptics_init(struct psmouse *psmouse, bool absolute_mode)
1447 {
1448 	struct synaptics_data *priv;
1449 	int err = -1;
1450 
1451 	/*
1452 	 * The OLPC XO has issues with Synaptics' absolute mode; the constant
1453 	 * packet spew overloads the EC such that key presses on the keyboard
1454 	 * are missed.  Given that, don't even attempt to use Absolute mode.
1455 	 * Relative mode seems to work just fine.
1456 	 */
1457 	if (absolute_mode && broken_olpc_ec) {
1458 		psmouse_info(psmouse,
1459 			     "OLPC XO detected, not enabling Synaptics protocol.\n");
1460 		return -ENODEV;
1461 	}
1462 
1463 	psmouse->private = priv = kzalloc(sizeof(struct synaptics_data), GFP_KERNEL);
1464 	if (!priv)
1465 		return -ENOMEM;
1466 
1467 	psmouse_reset(psmouse);
1468 
1469 	if (synaptics_query_hardware(psmouse)) {
1470 		psmouse_err(psmouse, "Unable to query device.\n");
1471 		goto init_fail;
1472 	}
1473 
1474 	priv->absolute_mode = absolute_mode;
1475 	if (SYN_ID_DISGEST_SUPPORTED(priv->identity))
1476 		priv->disable_gesture = true;
1477 
1478 	if (synaptics_set_mode(psmouse)) {
1479 		psmouse_err(psmouse, "Unable to initialize device.\n");
1480 		goto init_fail;
1481 	}
1482 
1483 	priv->pkt_type = SYN_MODEL_NEWABS(priv->model_id) ? SYN_NEWABS : SYN_OLDABS;
1484 
1485 	psmouse_info(psmouse,
1486 		     "Touchpad model: %ld, fw: %ld.%ld, id: %#lx, caps: %#lx/%#lx/%#lx, board id: %lu, fw id: %lu\n",
1487 		     SYN_ID_MODEL(priv->identity),
1488 		     SYN_ID_MAJOR(priv->identity), SYN_ID_MINOR(priv->identity),
1489 		     priv->model_id,
1490 		     priv->capabilities, priv->ext_cap, priv->ext_cap_0c,
1491 		     priv->board_id, priv->firmware_id);
1492 
1493 	set_input_params(psmouse, priv);
1494 
1495 	/*
1496 	 * Encode touchpad model so that it can be used to set
1497 	 * input device->id.version and be visible to userspace.
1498 	 * Because version is __u16 we have to drop something.
1499 	 * Hardware info bits seem to be good candidates as they
1500 	 * are documented to be for Synaptics corp. internal use.
1501 	 */
1502 	psmouse->model = ((priv->model_id & 0x00ff0000) >> 8) |
1503 			  (priv->model_id & 0x000000ff);
1504 
1505 	if (absolute_mode) {
1506 		psmouse->protocol_handler = synaptics_process_byte;
1507 		psmouse->pktsize = 6;
1508 	} else {
1509 		/* Relative mode follows standard PS/2 mouse protocol */
1510 		psmouse->protocol_handler = psmouse_process_byte;
1511 		psmouse->pktsize = 3;
1512 	}
1513 
1514 	psmouse->set_rate = synaptics_set_rate;
1515 	psmouse->disconnect = synaptics_disconnect;
1516 	psmouse->reconnect = synaptics_reconnect;
1517 	psmouse->cleanup = synaptics_reset;
1518 	/* Synaptics can usually stay in sync without extra help */
1519 	psmouse->resync_time = 0;
1520 
1521 	if (SYN_CAP_PASS_THROUGH(priv->capabilities))
1522 		synaptics_pt_create(psmouse);
1523 
1524 	/*
1525 	 * Toshiba's KBC seems to have trouble handling data from
1526 	 * Synaptics at full rate.  Switch to a lower rate (roughly
1527 	 * the same rate as a standard PS/2 mouse).
1528 	 */
1529 	if (psmouse->rate >= 80 && impaired_toshiba_kbc) {
1530 		psmouse_info(psmouse,
1531 			     "Toshiba %s detected, limiting rate to 40pps.\n",
1532 			     dmi_get_system_info(DMI_PRODUCT_NAME));
1533 		psmouse->rate = 40;
1534 	}
1535 
1536 	if (!priv->absolute_mode && SYN_ID_DISGEST_SUPPORTED(priv->identity)) {
1537 		err = device_create_file(&psmouse->ps2dev.serio->dev,
1538 					 &psmouse_attr_disable_gesture.dattr);
1539 		if (err) {
1540 			psmouse_err(psmouse,
1541 				    "Failed to create disable_gesture attribute (%d)",
1542 				    err);
1543 			goto init_fail;
1544 		}
1545 	}
1546 
1547 	return 0;
1548 
1549  init_fail:
1550 	kfree(priv);
1551 	return err;
1552 }
1553 
1554 int synaptics_init(struct psmouse *psmouse)
1555 {
1556 	return __synaptics_init(psmouse, true);
1557 }
1558 
1559 int synaptics_init_relative(struct psmouse *psmouse)
1560 {
1561 	return __synaptics_init(psmouse, false);
1562 }
1563 
1564 #else /* CONFIG_MOUSE_PS2_SYNAPTICS */
1565 
1566 void __init synaptics_module_init(void)
1567 {
1568 }
1569 
1570 int synaptics_init(struct psmouse *psmouse)
1571 {
1572 	return -ENOSYS;
1573 }
1574 
1575 #endif /* CONFIG_MOUSE_PS2_SYNAPTICS */
1576