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