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