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 */
80static 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
92int 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
116void 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
124static bool cr48_profile_sensor;
125
126#define ANY_BOARD_ID 0
127struct 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
135static 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. */
177static 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. */
215static 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 */
230static 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 */
238static 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 */
251static 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
262static 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 */
279static 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 */
301static 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 */
316static 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 */
372static 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
390static 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
446static 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
476static 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
496static 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
517static int synaptics_set_mode(struct psmouse *psmouse)
518{
519	struct synaptics_data *priv = psmouse->private;
520
521	priv->mode = 0;
522	if (priv->absolute_mode)
523		priv->mode |= SYN_BIT_ABSOLUTE_MODE;
524	if (priv->disable_gesture)
525		priv->mode |= SYN_BIT_DISABLE_GESTURE;
526	if (psmouse->rate >= 80)
527		priv->mode |= SYN_BIT_HIGH_RATE;
528	if (SYN_CAP_EXTENDED(priv->capabilities))
529		priv->mode |= SYN_BIT_W_MODE;
530
531	if (synaptics_mode_cmd(psmouse, priv->mode))
532		return -1;
533
534	if (priv->absolute_mode &&
535	    synaptics_set_advanced_gesture_mode(psmouse)) {
536		psmouse_err(psmouse, "Advanced gesture mode init failed.\n");
537		return -1;
538	}
539
540	return 0;
541}
542
543static void synaptics_set_rate(struct psmouse *psmouse, unsigned int rate)
544{
545	struct synaptics_data *priv = psmouse->private;
546
547	if (rate >= 80) {
548		priv->mode |= SYN_BIT_HIGH_RATE;
549		psmouse->rate = 80;
550	} else {
551		priv->mode &= ~SYN_BIT_HIGH_RATE;
552		psmouse->rate = 40;
553	}
554
555	synaptics_mode_cmd(psmouse, priv->mode);
556}
557
558/*****************************************************************************
559 *	Synaptics pass-through PS/2 port support
560 ****************************************************************************/
561static int synaptics_pt_write(struct serio *serio, unsigned char c)
562{
563	struct psmouse *parent = serio_get_drvdata(serio->parent);
564	char rate_param = SYN_PS_CLIENT_CMD; /* indicates that we want pass-through port */
565
566	if (psmouse_sliced_command(parent, c))
567		return -1;
568	if (ps2_command(&parent->ps2dev, &rate_param, PSMOUSE_CMD_SETRATE))
569		return -1;
570	return 0;
571}
572
573static int synaptics_pt_start(struct serio *serio)
574{
575	struct psmouse *parent = serio_get_drvdata(serio->parent);
576	struct synaptics_data *priv = parent->private;
577
578	serio_pause_rx(parent->ps2dev.serio);
579	priv->pt_port = serio;
580	serio_continue_rx(parent->ps2dev.serio);
581
582	return 0;
583}
584
585static void synaptics_pt_stop(struct serio *serio)
586{
587	struct psmouse *parent = serio_get_drvdata(serio->parent);
588	struct synaptics_data *priv = parent->private;
589
590	serio_pause_rx(parent->ps2dev.serio);
591	priv->pt_port = NULL;
592	serio_continue_rx(parent->ps2dev.serio);
593}
594
595static int synaptics_is_pt_packet(unsigned char *buf)
596{
597	return (buf[0] & 0xFC) == 0x84 && (buf[3] & 0xCC) == 0xC4;
598}
599
600static void synaptics_pass_pt_packet(struct psmouse *psmouse,
601				     struct serio *ptport,
602				     unsigned char *packet)
603{
604	struct synaptics_data *priv = psmouse->private;
605	struct psmouse *child = serio_get_drvdata(ptport);
606
607	if (child && child->state == PSMOUSE_ACTIVATED) {
608		serio_interrupt(ptport, packet[1] | priv->pt_buttons, 0);
609		serio_interrupt(ptport, packet[4], 0);
610		serio_interrupt(ptport, packet[5], 0);
611		if (child->pktsize == 4)
612			serio_interrupt(ptport, packet[2], 0);
613	} else {
614		serio_interrupt(ptport, packet[1], 0);
615	}
616}
617
618static void synaptics_pt_activate(struct psmouse *psmouse)
619{
620	struct synaptics_data *priv = psmouse->private;
621	struct psmouse *child = serio_get_drvdata(priv->pt_port);
622
623	/* adjust the touchpad to child's choice of protocol */
624	if (child) {
625		if (child->pktsize == 4)
626			priv->mode |= SYN_BIT_FOUR_BYTE_CLIENT;
627		else
628			priv->mode &= ~SYN_BIT_FOUR_BYTE_CLIENT;
629
630		if (synaptics_mode_cmd(psmouse, priv->mode))
631			psmouse_warn(psmouse,
632				     "failed to switch guest protocol\n");
633	}
634}
635
636static void synaptics_pt_create(struct psmouse *psmouse)
637{
638	struct serio *serio;
639
640	serio = kzalloc(sizeof(struct serio), GFP_KERNEL);
641	if (!serio) {
642		psmouse_err(psmouse,
643			    "not enough memory for pass-through port\n");
644		return;
645	}
646
647	serio->id.type = SERIO_PS_PSTHRU;
648	strlcpy(serio->name, "Synaptics pass-through", sizeof(serio->name));
649	strlcpy(serio->phys, "synaptics-pt/serio0", sizeof(serio->name));
650	serio->write = synaptics_pt_write;
651	serio->start = synaptics_pt_start;
652	serio->stop = synaptics_pt_stop;
653	serio->parent = psmouse->ps2dev.serio;
654
655	psmouse->pt_activate = synaptics_pt_activate;
656
657	psmouse_info(psmouse, "serio: %s port at %s\n",
658		     serio->name, psmouse->phys);
659	serio_register_port(serio);
660}
661
662/*****************************************************************************
663 *	Functions to interpret the absolute mode packets
664 ****************************************************************************/
665
666static void synaptics_parse_agm(const unsigned char buf[],
667				struct synaptics_data *priv,
668				struct synaptics_hw_state *hw)
669{
670	struct synaptics_hw_state *agm = &priv->agm;
671	int agm_packet_type;
672
673	agm_packet_type = (buf[5] & 0x30) >> 4;
674	switch (agm_packet_type) {
675	case 1:
676		/* Gesture packet: (x, y, z) half resolution */
677		agm->w = hw->w;
678		agm->x = (((buf[4] & 0x0f) << 8) | buf[1]) << 1;
679		agm->y = (((buf[4] & 0xf0) << 4) | buf[2]) << 1;
680		agm->z = ((buf[3] & 0x30) | (buf[5] & 0x0f)) << 1;
681		break;
682
683	case 2:
684		/* AGM-CONTACT packet: we are only interested in the count */
685		priv->agm_count = buf[1];
686		break;
687
688	default:
689		break;
690	}
691}
692
693static void synaptics_parse_ext_buttons(const unsigned char buf[],
694					struct synaptics_data *priv,
695					struct synaptics_hw_state *hw)
696{
697	unsigned int ext_bits =
698		(SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) + 1) >> 1;
699	unsigned int ext_mask = GENMASK(ext_bits - 1, 0);
700
701	hw->ext_buttons = buf[4] & ext_mask;
702	hw->ext_buttons |= (buf[5] & ext_mask) << ext_bits;
703}
704
705static int synaptics_parse_hw_state(const unsigned char buf[],
706				    struct synaptics_data *priv,
707				    struct synaptics_hw_state *hw)
708{
709	memset(hw, 0, sizeof(struct synaptics_hw_state));
710
711	if (SYN_MODEL_NEWABS(priv->model_id)) {
712		hw->w = (((buf[0] & 0x30) >> 2) |
713			 ((buf[0] & 0x04) >> 1) |
714			 ((buf[3] & 0x04) >> 2));
715
716		if ((SYN_CAP_ADV_GESTURE(priv->ext_cap_0c) ||
717			SYN_CAP_IMAGE_SENSOR(priv->ext_cap_0c)) &&
718		    hw->w == 2) {
719			synaptics_parse_agm(buf, priv, hw);
720			return 1;
721		}
722
723		hw->x = (((buf[3] & 0x10) << 8) |
724			 ((buf[1] & 0x0f) << 8) |
725			 buf[4]);
726		hw->y = (((buf[3] & 0x20) << 7) |
727			 ((buf[1] & 0xf0) << 4) |
728			 buf[5]);
729		hw->z = buf[2];
730
731		hw->left  = (buf[0] & 0x01) ? 1 : 0;
732		hw->right = (buf[0] & 0x02) ? 1 : 0;
733
734		if (priv->is_forcepad) {
735			/*
736			 * ForcePads, like Clickpads, use middle button
737			 * bits to report primary button clicks.
738			 * Unfortunately they report primary button not
739			 * only when user presses on the pad above certain
740			 * threshold, but also when there are more than one
741			 * finger on the touchpad, which interferes with
742			 * out multi-finger gestures.
743			 */
744			if (hw->z == 0) {
745				/* No contacts */
746				priv->press = priv->report_press = false;
747			} else if (hw->w >= 4 && ((buf[0] ^ buf[3]) & 0x01)) {
748				/*
749				 * Single-finger touch with pressure above
750				 * the threshold. If pressure stays long
751				 * enough, we'll start reporting primary
752				 * button. We rely on the device continuing
753				 * sending data even if finger does not
754				 * move.
755				 */
756				if  (!priv->press) {
757					priv->press_start = jiffies;
758					priv->press = true;
759				} else if (time_after(jiffies,
760						priv->press_start +
761							msecs_to_jiffies(50))) {
762					priv->report_press = true;
763				}
764			} else {
765				priv->press = false;
766			}
767
768			hw->left = priv->report_press;
769
770		} else if (SYN_CAP_CLICKPAD(priv->ext_cap_0c)) {
771			/*
772			 * Clickpad's button is transmitted as middle button,
773			 * however, since it is primary button, we will report
774			 * it as BTN_LEFT.
775			 */
776			hw->left = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
777
778		} else if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities)) {
779			hw->middle = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
780			if (hw->w == 2)
781				hw->scroll = (signed char)(buf[1]);
782		}
783
784		if (SYN_CAP_FOUR_BUTTON(priv->capabilities)) {
785			hw->up   = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
786			hw->down = ((buf[0] ^ buf[3]) & 0x02) ? 1 : 0;
787		}
788
789		if (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) > 0 &&
790		    ((buf[0] ^ buf[3]) & 0x02)) {
791			synaptics_parse_ext_buttons(buf, priv, hw);
792		}
793	} else {
794		hw->x = (((buf[1] & 0x1f) << 8) | buf[2]);
795		hw->y = (((buf[4] & 0x1f) << 8) | buf[5]);
796
797		hw->z = (((buf[0] & 0x30) << 2) | (buf[3] & 0x3F));
798		hw->w = (((buf[1] & 0x80) >> 4) | ((buf[0] & 0x04) >> 1));
799
800		hw->left  = (buf[0] & 0x01) ? 1 : 0;
801		hw->right = (buf[0] & 0x02) ? 1 : 0;
802	}
803
804	/*
805	 * Convert wrap-around values to negative. (X|Y)_MAX_POSITIVE
806	 * is used by some firmware to indicate a finger at the edge of
807	 * the touchpad whose precise position cannot be determined, so
808	 * convert these values to the maximum axis value.
809	 */
810	if (hw->x > X_MAX_POSITIVE)
811		hw->x -= 1 << ABS_POS_BITS;
812	else if (hw->x == X_MAX_POSITIVE)
813		hw->x = XMAX;
814
815	if (hw->y > Y_MAX_POSITIVE)
816		hw->y -= 1 << ABS_POS_BITS;
817	else if (hw->y == Y_MAX_POSITIVE)
818		hw->y = YMAX;
819
820	return 0;
821}
822
823static void synaptics_report_semi_mt_slot(struct input_dev *dev, int slot,
824					  bool active, int x, int y)
825{
826	input_mt_slot(dev, slot);
827	input_mt_report_slot_state(dev, MT_TOOL_FINGER, active);
828	if (active) {
829		input_report_abs(dev, ABS_MT_POSITION_X, x);
830		input_report_abs(dev, ABS_MT_POSITION_Y, synaptics_invert_y(y));
831	}
832}
833
834static void synaptics_report_semi_mt_data(struct input_dev *dev,
835					  const struct synaptics_hw_state *a,
836					  const struct synaptics_hw_state *b,
837					  int num_fingers)
838{
839	if (num_fingers >= 2) {
840		synaptics_report_semi_mt_slot(dev, 0, true, min(a->x, b->x),
841					      min(a->y, b->y));
842		synaptics_report_semi_mt_slot(dev, 1, true, max(a->x, b->x),
843					      max(a->y, b->y));
844	} else if (num_fingers == 1) {
845		synaptics_report_semi_mt_slot(dev, 0, true, a->x, a->y);
846		synaptics_report_semi_mt_slot(dev, 1, false, 0, 0);
847	} else {
848		synaptics_report_semi_mt_slot(dev, 0, false, 0, 0);
849		synaptics_report_semi_mt_slot(dev, 1, false, 0, 0);
850	}
851}
852
853static void synaptics_report_ext_buttons(struct psmouse *psmouse,
854					 const struct synaptics_hw_state *hw)
855{
856	struct input_dev *dev = psmouse->dev;
857	struct synaptics_data *priv = psmouse->private;
858	int ext_bits = (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) + 1) >> 1;
859	char buf[6] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
860	int i;
861
862	if (!SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap))
863		return;
864
865	/* Bug in FW 8.1 & 8.2, buttons are reported only when ExtBit is 1 */
866	if ((SYN_ID_FULL(priv->identity) == 0x801 ||
867	     SYN_ID_FULL(priv->identity) == 0x802) &&
868	    !((psmouse->packet[0] ^ psmouse->packet[3]) & 0x02))
869		return;
870
871	if (!SYN_CAP_EXT_BUTTONS_STICK(priv->ext_cap_10)) {
872		for (i = 0; i < ext_bits; i++) {
873			input_report_key(dev, BTN_0 + 2 * i,
874				hw->ext_buttons & (1 << i));
875			input_report_key(dev, BTN_1 + 2 * i,
876				hw->ext_buttons & (1 << (i + ext_bits)));
877		}
878		return;
879	}
880
881	/*
882	 * This generation of touchpads has the trackstick buttons
883	 * physically wired to the touchpad. Re-route them through
884	 * the pass-through interface.
885	 */
886	if (!priv->pt_port)
887		return;
888
889	/* The trackstick expects at most 3 buttons */
890	priv->pt_buttons = SYN_CAP_EXT_BUTTON_STICK_L(hw->ext_buttons)      |
891			   SYN_CAP_EXT_BUTTON_STICK_R(hw->ext_buttons) << 1 |
892			   SYN_CAP_EXT_BUTTON_STICK_M(hw->ext_buttons) << 2;
893
894	synaptics_pass_pt_packet(psmouse, priv->pt_port, buf);
895}
896
897static void synaptics_report_buttons(struct psmouse *psmouse,
898				     const struct synaptics_hw_state *hw)
899{
900	struct input_dev *dev = psmouse->dev;
901	struct synaptics_data *priv = psmouse->private;
902
903	input_report_key(dev, BTN_LEFT, hw->left);
904	input_report_key(dev, BTN_RIGHT, hw->right);
905
906	if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities))
907		input_report_key(dev, BTN_MIDDLE, hw->middle);
908
909	if (SYN_CAP_FOUR_BUTTON(priv->capabilities)) {
910		input_report_key(dev, BTN_FORWARD, hw->up);
911		input_report_key(dev, BTN_BACK, hw->down);
912	}
913
914	synaptics_report_ext_buttons(psmouse, hw);
915}
916
917static void synaptics_report_mt_data(struct psmouse *psmouse,
918				     const struct synaptics_hw_state *sgm,
919				     int num_fingers)
920{
921	struct input_dev *dev = psmouse->dev;
922	struct synaptics_data *priv = psmouse->private;
923	const struct synaptics_hw_state *hw[2] = { sgm, &priv->agm };
924	struct input_mt_pos pos[2];
925	int slot[2], nsemi, i;
926
927	nsemi = clamp_val(num_fingers, 0, 2);
928
929	for (i = 0; i < nsemi; i++) {
930		pos[i].x = hw[i]->x;
931		pos[i].y = synaptics_invert_y(hw[i]->y);
932	}
933
934	input_mt_assign_slots(dev, slot, pos, nsemi, DMAX * priv->x_res);
935
936	for (i = 0; i < nsemi; i++) {
937		input_mt_slot(dev, slot[i]);
938		input_mt_report_slot_state(dev, MT_TOOL_FINGER, true);
939		input_report_abs(dev, ABS_MT_POSITION_X, pos[i].x);
940		input_report_abs(dev, ABS_MT_POSITION_Y, pos[i].y);
941		input_report_abs(dev, ABS_MT_PRESSURE, hw[i]->z);
942	}
943
944	input_mt_drop_unused(dev);
945
946	/* Don't use active slot count to generate BTN_TOOL events. */
947	input_mt_report_pointer_emulation(dev, false);
948
949	/* Send the number of fingers reported by touchpad itself. */
950	input_mt_report_finger_count(dev, num_fingers);
951
952	synaptics_report_buttons(psmouse, sgm);
953
954	input_sync(dev);
955}
956
957static void synaptics_image_sensor_process(struct psmouse *psmouse,
958					   struct synaptics_hw_state *sgm)
959{
960	struct synaptics_data *priv = psmouse->private;
961	int num_fingers;
962
963	/*
964	 * Update mt_state using the new finger count and current mt_state.
965	 */
966	if (sgm->z == 0)
967		num_fingers = 0;
968	else if (sgm->w >= 4)
969		num_fingers = 1;
970	else if (sgm->w == 0)
971		num_fingers = 2;
972	else if (sgm->w == 1)
973		num_fingers = priv->agm_count ? priv->agm_count : 3;
974	else
975		num_fingers = 4;
976
977	/* Send resulting input events to user space */
978	synaptics_report_mt_data(psmouse, sgm, num_fingers);
979}
980
981/*
982 *  called for each full received packet from the touchpad
983 */
984static void synaptics_process_packet(struct psmouse *psmouse)
985{
986	struct input_dev *dev = psmouse->dev;
987	struct synaptics_data *priv = psmouse->private;
988	struct synaptics_hw_state hw;
989	int num_fingers;
990	int finger_width;
991
992	if (synaptics_parse_hw_state(psmouse->packet, priv, &hw))
993		return;
994
995	if (SYN_CAP_IMAGE_SENSOR(priv->ext_cap_0c)) {
996		synaptics_image_sensor_process(psmouse, &hw);
997		return;
998	}
999
1000	if (hw.scroll) {
1001		priv->scroll += hw.scroll;
1002
1003		while (priv->scroll >= 4) {
1004			input_report_key(dev, BTN_BACK, !hw.down);
1005			input_sync(dev);
1006			input_report_key(dev, BTN_BACK, hw.down);
1007			input_sync(dev);
1008			priv->scroll -= 4;
1009		}
1010		while (priv->scroll <= -4) {
1011			input_report_key(dev, BTN_FORWARD, !hw.up);
1012			input_sync(dev);
1013			input_report_key(dev, BTN_FORWARD, hw.up);
1014			input_sync(dev);
1015			priv->scroll += 4;
1016		}
1017		return;
1018	}
1019
1020	if (hw.z > 0 && hw.x > 1) {
1021		num_fingers = 1;
1022		finger_width = 5;
1023		if (SYN_CAP_EXTENDED(priv->capabilities)) {
1024			switch (hw.w) {
1025			case 0 ... 1:
1026				if (SYN_CAP_MULTIFINGER(priv->capabilities))
1027					num_fingers = hw.w + 2;
1028				break;
1029			case 2:
1030				if (SYN_MODEL_PEN(priv->model_id))
1031					;   /* Nothing, treat a pen as a single finger */
1032				break;
1033			case 4 ... 15:
1034				if (SYN_CAP_PALMDETECT(priv->capabilities))
1035					finger_width = hw.w;
1036				break;
1037			}
1038		}
1039	} else {
1040		num_fingers = 0;
1041		finger_width = 0;
1042	}
1043
1044	if (cr48_profile_sensor) {
1045		synaptics_report_mt_data(psmouse, &hw, num_fingers);
1046		return;
1047	}
1048
1049	if (SYN_CAP_ADV_GESTURE(priv->ext_cap_0c))
1050		synaptics_report_semi_mt_data(dev, &hw, &priv->agm,
1051					      num_fingers);
1052
1053	/* Post events
1054	 * BTN_TOUCH has to be first as mousedev relies on it when doing
1055	 * absolute -> relative conversion
1056	 */
1057	if (hw.z > 30) input_report_key(dev, BTN_TOUCH, 1);
1058	if (hw.z < 25) input_report_key(dev, BTN_TOUCH, 0);
1059
1060	if (num_fingers > 0) {
1061		input_report_abs(dev, ABS_X, hw.x);
1062		input_report_abs(dev, ABS_Y, synaptics_invert_y(hw.y));
1063	}
1064	input_report_abs(dev, ABS_PRESSURE, hw.z);
1065
1066	if (SYN_CAP_PALMDETECT(priv->capabilities))
1067		input_report_abs(dev, ABS_TOOL_WIDTH, finger_width);
1068
1069	input_report_key(dev, BTN_TOOL_FINGER, num_fingers == 1);
1070	if (SYN_CAP_MULTIFINGER(priv->capabilities)) {
1071		input_report_key(dev, BTN_TOOL_DOUBLETAP, num_fingers == 2);
1072		input_report_key(dev, BTN_TOOL_TRIPLETAP, num_fingers == 3);
1073	}
1074
1075	synaptics_report_buttons(psmouse, &hw);
1076
1077	input_sync(dev);
1078}
1079
1080static int synaptics_validate_byte(struct psmouse *psmouse,
1081				   int idx, unsigned char pkt_type)
1082{
1083	static const unsigned char newabs_mask[]	= { 0xC8, 0x00, 0x00, 0xC8, 0x00 };
1084	static const unsigned char newabs_rel_mask[]	= { 0xC0, 0x00, 0x00, 0xC0, 0x00 };
1085	static const unsigned char newabs_rslt[]	= { 0x80, 0x00, 0x00, 0xC0, 0x00 };
1086	static const unsigned char oldabs_mask[]	= { 0xC0, 0x60, 0x00, 0xC0, 0x60 };
1087	static const unsigned char oldabs_rslt[]	= { 0xC0, 0x00, 0x00, 0x80, 0x00 };
1088	const char *packet = psmouse->packet;
1089
1090	if (idx < 0 || idx > 4)
1091		return 0;
1092
1093	switch (pkt_type) {
1094
1095	case SYN_NEWABS:
1096	case SYN_NEWABS_RELAXED:
1097		return (packet[idx] & newabs_rel_mask[idx]) == newabs_rslt[idx];
1098
1099	case SYN_NEWABS_STRICT:
1100		return (packet[idx] & newabs_mask[idx]) == newabs_rslt[idx];
1101
1102	case SYN_OLDABS:
1103		return (packet[idx] & oldabs_mask[idx]) == oldabs_rslt[idx];
1104
1105	default:
1106		psmouse_err(psmouse, "unknown packet type %d\n", pkt_type);
1107		return 0;
1108	}
1109}
1110
1111static unsigned char synaptics_detect_pkt_type(struct psmouse *psmouse)
1112{
1113	int i;
1114
1115	for (i = 0; i < 5; i++)
1116		if (!synaptics_validate_byte(psmouse, i, SYN_NEWABS_STRICT)) {
1117			psmouse_info(psmouse, "using relaxed packet validation\n");
1118			return SYN_NEWABS_RELAXED;
1119		}
1120
1121	return SYN_NEWABS_STRICT;
1122}
1123
1124static psmouse_ret_t synaptics_process_byte(struct psmouse *psmouse)
1125{
1126	struct synaptics_data *priv = psmouse->private;
1127
1128	if (psmouse->pktcnt >= 6) { /* Full packet received */
1129		if (unlikely(priv->pkt_type == SYN_NEWABS))
1130			priv->pkt_type = synaptics_detect_pkt_type(psmouse);
1131
1132		if (SYN_CAP_PASS_THROUGH(priv->capabilities) &&
1133		    synaptics_is_pt_packet(psmouse->packet)) {
1134			if (priv->pt_port)
1135				synaptics_pass_pt_packet(psmouse, priv->pt_port,
1136							 psmouse->packet);
1137		} else
1138			synaptics_process_packet(psmouse);
1139
1140		return PSMOUSE_FULL_PACKET;
1141	}
1142
1143	return synaptics_validate_byte(psmouse, psmouse->pktcnt - 1, priv->pkt_type) ?
1144		PSMOUSE_GOOD_DATA : PSMOUSE_BAD_DATA;
1145}
1146
1147/*****************************************************************************
1148 *	Driver initialization/cleanup functions
1149 ****************************************************************************/
1150static void set_abs_position_params(struct input_dev *dev,
1151				    struct synaptics_data *priv, int x_code,
1152				    int y_code)
1153{
1154	int x_min = priv->x_min ?: XMIN_NOMINAL;
1155	int x_max = priv->x_max ?: XMAX_NOMINAL;
1156	int y_min = priv->y_min ?: YMIN_NOMINAL;
1157	int y_max = priv->y_max ?: YMAX_NOMINAL;
1158	int fuzz = SYN_CAP_REDUCED_FILTERING(priv->ext_cap_0c) ?
1159			SYN_REDUCED_FILTER_FUZZ : 0;
1160
1161	input_set_abs_params(dev, x_code, x_min, x_max, fuzz, 0);
1162	input_set_abs_params(dev, y_code, y_min, y_max, fuzz, 0);
1163	input_abs_set_res(dev, x_code, priv->x_res);
1164	input_abs_set_res(dev, y_code, priv->y_res);
1165}
1166
1167static void set_input_params(struct psmouse *psmouse,
1168			     struct synaptics_data *priv)
1169{
1170	struct input_dev *dev = psmouse->dev;
1171	int i;
1172
1173	/* Things that apply to both modes */
1174	__set_bit(INPUT_PROP_POINTER, dev->propbit);
1175	__set_bit(EV_KEY, dev->evbit);
1176	__set_bit(BTN_LEFT, dev->keybit);
1177	__set_bit(BTN_RIGHT, dev->keybit);
1178
1179	if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities))
1180		__set_bit(BTN_MIDDLE, dev->keybit);
1181
1182	if (!priv->absolute_mode) {
1183		/* Relative mode */
1184		__set_bit(EV_REL, dev->evbit);
1185		__set_bit(REL_X, dev->relbit);
1186		__set_bit(REL_Y, dev->relbit);
1187		return;
1188	}
1189
1190	/* Absolute mode */
1191	__set_bit(EV_ABS, dev->evbit);
1192	set_abs_position_params(dev, priv, ABS_X, ABS_Y);
1193	input_set_abs_params(dev, ABS_PRESSURE, 0, 255, 0, 0);
1194
1195	if (cr48_profile_sensor)
1196		input_set_abs_params(dev, ABS_MT_PRESSURE, 0, 255, 0, 0);
1197
1198	if (SYN_CAP_IMAGE_SENSOR(priv->ext_cap_0c)) {
1199		set_abs_position_params(dev, priv, ABS_MT_POSITION_X,
1200					ABS_MT_POSITION_Y);
1201		/* Image sensors can report per-contact pressure */
1202		input_set_abs_params(dev, ABS_MT_PRESSURE, 0, 255, 0, 0);
1203		input_mt_init_slots(dev, 2, INPUT_MT_POINTER | INPUT_MT_TRACK);
1204
1205		/* Image sensors can signal 4 and 5 finger clicks */
1206		__set_bit(BTN_TOOL_QUADTAP, dev->keybit);
1207		__set_bit(BTN_TOOL_QUINTTAP, dev->keybit);
1208	} else if (SYN_CAP_ADV_GESTURE(priv->ext_cap_0c)) {
1209		set_abs_position_params(dev, priv, ABS_MT_POSITION_X,
1210					ABS_MT_POSITION_Y);
1211		/*
1212		 * Profile sensor in CR-48 tracks contacts reasonably well,
1213		 * other non-image sensors with AGM use semi-mt.
1214		 */
1215		input_mt_init_slots(dev, 2,
1216				    INPUT_MT_POINTER |
1217				    (cr48_profile_sensor ?
1218					INPUT_MT_TRACK : INPUT_MT_SEMI_MT));
1219	}
1220
1221	if (SYN_CAP_PALMDETECT(priv->capabilities))
1222		input_set_abs_params(dev, ABS_TOOL_WIDTH, 0, 15, 0, 0);
1223
1224	__set_bit(BTN_TOUCH, dev->keybit);
1225	__set_bit(BTN_TOOL_FINGER, dev->keybit);
1226
1227	if (SYN_CAP_MULTIFINGER(priv->capabilities)) {
1228		__set_bit(BTN_TOOL_DOUBLETAP, dev->keybit);
1229		__set_bit(BTN_TOOL_TRIPLETAP, dev->keybit);
1230	}
1231
1232	if (SYN_CAP_FOUR_BUTTON(priv->capabilities) ||
1233	    SYN_CAP_MIDDLE_BUTTON(priv->capabilities)) {
1234		__set_bit(BTN_FORWARD, dev->keybit);
1235		__set_bit(BTN_BACK, dev->keybit);
1236	}
1237
1238	if (!SYN_CAP_EXT_BUTTONS_STICK(priv->ext_cap_10))
1239		for (i = 0; i < SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap); i++)
1240			__set_bit(BTN_0 + i, dev->keybit);
1241
1242	__clear_bit(EV_REL, dev->evbit);
1243	__clear_bit(REL_X, dev->relbit);
1244	__clear_bit(REL_Y, dev->relbit);
1245
1246	if (SYN_CAP_CLICKPAD(priv->ext_cap_0c)) {
1247		__set_bit(INPUT_PROP_BUTTONPAD, dev->propbit);
1248		if (psmouse_matches_pnp_id(psmouse, topbuttonpad_pnp_ids) &&
1249		    !SYN_CAP_EXT_BUTTONS_STICK(priv->ext_cap_10))
1250			__set_bit(INPUT_PROP_TOPBUTTONPAD, dev->propbit);
1251		/* Clickpads report only left button */
1252		__clear_bit(BTN_RIGHT, dev->keybit);
1253		__clear_bit(BTN_MIDDLE, dev->keybit);
1254	}
1255}
1256
1257static ssize_t synaptics_show_disable_gesture(struct psmouse *psmouse,
1258					      void *data, char *buf)
1259{
1260	struct synaptics_data *priv = psmouse->private;
1261
1262	return sprintf(buf, "%c\n", priv->disable_gesture ? '1' : '0');
1263}
1264
1265static ssize_t synaptics_set_disable_gesture(struct psmouse *psmouse,
1266					     void *data, const char *buf,
1267					     size_t len)
1268{
1269	struct synaptics_data *priv = psmouse->private;
1270	unsigned int value;
1271	int err;
1272
1273	err = kstrtouint(buf, 10, &value);
1274	if (err)
1275		return err;
1276
1277	if (value > 1)
1278		return -EINVAL;
1279
1280	if (value == priv->disable_gesture)
1281		return len;
1282
1283	priv->disable_gesture = value;
1284	if (value)
1285		priv->mode |= SYN_BIT_DISABLE_GESTURE;
1286	else
1287		priv->mode &= ~SYN_BIT_DISABLE_GESTURE;
1288
1289	if (synaptics_mode_cmd(psmouse, priv->mode))
1290		return -EIO;
1291
1292	return len;
1293}
1294
1295PSMOUSE_DEFINE_ATTR(disable_gesture, S_IWUSR | S_IRUGO, NULL,
1296		    synaptics_show_disable_gesture,
1297		    synaptics_set_disable_gesture);
1298
1299static void synaptics_disconnect(struct psmouse *psmouse)
1300{
1301	struct synaptics_data *priv = psmouse->private;
1302
1303	if (!priv->absolute_mode && SYN_ID_DISGEST_SUPPORTED(priv->identity))
1304		device_remove_file(&psmouse->ps2dev.serio->dev,
1305				   &psmouse_attr_disable_gesture.dattr);
1306
1307	synaptics_reset(psmouse);
1308	kfree(priv);
1309	psmouse->private = NULL;
1310}
1311
1312static int synaptics_reconnect(struct psmouse *psmouse)
1313{
1314	struct synaptics_data *priv = psmouse->private;
1315	struct synaptics_data old_priv = *priv;
1316	unsigned char param[2];
1317	int retry = 0;
1318	int error;
1319
1320	do {
1321		psmouse_reset(psmouse);
1322		if (retry) {
1323			/*
1324			 * On some boxes, right after resuming, the touchpad
1325			 * needs some time to finish initializing (I assume
1326			 * it needs time to calibrate) and start responding
1327			 * to Synaptics-specific queries, so let's wait a
1328			 * bit.
1329			 */
1330			ssleep(1);
1331		}
1332		ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_GETID);
1333		error = synaptics_detect(psmouse, 0);
1334	} while (error && ++retry < 3);
1335
1336	if (error)
1337		return -1;
1338
1339	if (retry > 1)
1340		psmouse_dbg(psmouse, "reconnected after %d tries\n", retry);
1341
1342	if (synaptics_query_hardware(psmouse)) {
1343		psmouse_err(psmouse, "Unable to query device.\n");
1344		return -1;
1345	}
1346
1347	if (synaptics_set_mode(psmouse)) {
1348		psmouse_err(psmouse, "Unable to initialize device.\n");
1349		return -1;
1350	}
1351
1352	if (old_priv.identity != priv->identity ||
1353	    old_priv.model_id != priv->model_id ||
1354	    old_priv.capabilities != priv->capabilities ||
1355	    old_priv.ext_cap != priv->ext_cap) {
1356		psmouse_err(psmouse,
1357			    "hardware appears to be different: id(%ld-%ld), model(%ld-%ld), caps(%lx-%lx), ext(%lx-%lx).\n",
1358			    old_priv.identity, priv->identity,
1359			    old_priv.model_id, priv->model_id,
1360			    old_priv.capabilities, priv->capabilities,
1361			    old_priv.ext_cap, priv->ext_cap);
1362		return -1;
1363	}
1364
1365	return 0;
1366}
1367
1368static bool impaired_toshiba_kbc;
1369
1370static const struct dmi_system_id toshiba_dmi_table[] __initconst = {
1371#if defined(CONFIG_DMI) && defined(CONFIG_X86)
1372	{
1373		/* Toshiba Satellite */
1374		.matches = {
1375			DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
1376			DMI_MATCH(DMI_PRODUCT_NAME, "Satellite"),
1377		},
1378	},
1379	{
1380		/* Toshiba Dynabook */
1381		.matches = {
1382			DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
1383			DMI_MATCH(DMI_PRODUCT_NAME, "dynabook"),
1384		},
1385	},
1386	{
1387		/* Toshiba Portege M300 */
1388		.matches = {
1389			DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
1390			DMI_MATCH(DMI_PRODUCT_NAME, "PORTEGE M300"),
1391		},
1392
1393	},
1394	{
1395		/* Toshiba Portege M300 */
1396		.matches = {
1397			DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
1398			DMI_MATCH(DMI_PRODUCT_NAME, "Portable PC"),
1399			DMI_MATCH(DMI_PRODUCT_VERSION, "Version 1.0"),
1400		},
1401
1402	},
1403#endif
1404	{ }
1405};
1406
1407static bool broken_olpc_ec;
1408
1409static const struct dmi_system_id olpc_dmi_table[] __initconst = {
1410#if defined(CONFIG_DMI) && defined(CONFIG_OLPC)
1411	{
1412		/* OLPC XO-1 or XO-1.5 */
1413		.matches = {
1414			DMI_MATCH(DMI_SYS_VENDOR, "OLPC"),
1415			DMI_MATCH(DMI_PRODUCT_NAME, "XO"),
1416		},
1417	},
1418#endif
1419	{ }
1420};
1421
1422static const struct dmi_system_id __initconst cr48_dmi_table[] = {
1423#if defined(CONFIG_DMI) && defined(CONFIG_X86)
1424	{
1425		/* Cr-48 Chromebook (Codename Mario) */
1426		.matches = {
1427			DMI_MATCH(DMI_SYS_VENDOR, "IEC"),
1428			DMI_MATCH(DMI_PRODUCT_NAME, "Mario"),
1429		},
1430	},
1431#endif
1432	{ }
1433};
1434
1435void __init synaptics_module_init(void)
1436{
1437	impaired_toshiba_kbc = dmi_check_system(toshiba_dmi_table);
1438	broken_olpc_ec = dmi_check_system(olpc_dmi_table);
1439	cr48_profile_sensor = dmi_check_system(cr48_dmi_table);
1440}
1441
1442static int __synaptics_init(struct psmouse *psmouse, bool absolute_mode)
1443{
1444	struct synaptics_data *priv;
1445	int err = -1;
1446
1447	/*
1448	 * The OLPC XO has issues with Synaptics' absolute mode; the constant
1449	 * packet spew overloads the EC such that key presses on the keyboard
1450	 * are missed.  Given that, don't even attempt to use Absolute mode.
1451	 * Relative mode seems to work just fine.
1452	 */
1453	if (absolute_mode && broken_olpc_ec) {
1454		psmouse_info(psmouse,
1455			     "OLPC XO detected, not enabling Synaptics protocol.\n");
1456		return -ENODEV;
1457	}
1458
1459	psmouse->private = priv = kzalloc(sizeof(struct synaptics_data), GFP_KERNEL);
1460	if (!priv)
1461		return -ENOMEM;
1462
1463	psmouse_reset(psmouse);
1464
1465	if (synaptics_query_hardware(psmouse)) {
1466		psmouse_err(psmouse, "Unable to query device.\n");
1467		goto init_fail;
1468	}
1469
1470	priv->absolute_mode = absolute_mode;
1471	if (SYN_ID_DISGEST_SUPPORTED(priv->identity))
1472		priv->disable_gesture = true;
1473
1474	/*
1475	 * Unfortunately ForcePad capability is not exported over PS/2,
1476	 * so we have to resort to checking PNP IDs.
1477	 */
1478	priv->is_forcepad = psmouse_matches_pnp_id(psmouse, forcepad_pnp_ids);
1479
1480	if (synaptics_set_mode(psmouse)) {
1481		psmouse_err(psmouse, "Unable to initialize device.\n");
1482		goto init_fail;
1483	}
1484
1485	priv->pkt_type = SYN_MODEL_NEWABS(priv->model_id) ? SYN_NEWABS : SYN_OLDABS;
1486
1487	psmouse_info(psmouse,
1488		     "Touchpad model: %ld, fw: %ld.%ld, id: %#lx, caps: %#lx/%#lx/%#lx, board id: %lu, fw id: %lu\n",
1489		     SYN_ID_MODEL(priv->identity),
1490		     SYN_ID_MAJOR(priv->identity), SYN_ID_MINOR(priv->identity),
1491		     priv->model_id,
1492		     priv->capabilities, priv->ext_cap, priv->ext_cap_0c,
1493		     priv->board_id, priv->firmware_id);
1494
1495	set_input_params(psmouse, priv);
1496
1497	/*
1498	 * Encode touchpad model so that it can be used to set
1499	 * input device->id.version and be visible to userspace.
1500	 * Because version is __u16 we have to drop something.
1501	 * Hardware info bits seem to be good candidates as they
1502	 * are documented to be for Synaptics corp. internal use.
1503	 */
1504	psmouse->model = ((priv->model_id & 0x00ff0000) >> 8) |
1505			  (priv->model_id & 0x000000ff);
1506
1507	if (absolute_mode) {
1508		psmouse->protocol_handler = synaptics_process_byte;
1509		psmouse->pktsize = 6;
1510	} else {
1511		/* Relative mode follows standard PS/2 mouse protocol */
1512		psmouse->protocol_handler = psmouse_process_byte;
1513		psmouse->pktsize = 3;
1514	}
1515
1516	psmouse->set_rate = synaptics_set_rate;
1517	psmouse->disconnect = synaptics_disconnect;
1518	psmouse->reconnect = synaptics_reconnect;
1519	psmouse->cleanup = synaptics_reset;
1520	/* Synaptics can usually stay in sync without extra help */
1521	psmouse->resync_time = 0;
1522
1523	if (SYN_CAP_PASS_THROUGH(priv->capabilities))
1524		synaptics_pt_create(psmouse);
1525
1526	/*
1527	 * Toshiba's KBC seems to have trouble handling data from
1528	 * Synaptics at full rate.  Switch to a lower rate (roughly
1529	 * the same rate as a standard PS/2 mouse).
1530	 */
1531	if (psmouse->rate >= 80 && impaired_toshiba_kbc) {
1532		psmouse_info(psmouse,
1533			     "Toshiba %s detected, limiting rate to 40pps.\n",
1534			     dmi_get_system_info(DMI_PRODUCT_NAME));
1535		psmouse->rate = 40;
1536	}
1537
1538	if (!priv->absolute_mode && SYN_ID_DISGEST_SUPPORTED(priv->identity)) {
1539		err = device_create_file(&psmouse->ps2dev.serio->dev,
1540					 &psmouse_attr_disable_gesture.dattr);
1541		if (err) {
1542			psmouse_err(psmouse,
1543				    "Failed to create disable_gesture attribute (%d)",
1544				    err);
1545			goto init_fail;
1546		}
1547	}
1548
1549	return 0;
1550
1551 init_fail:
1552	kfree(priv);
1553	return err;
1554}
1555
1556int synaptics_init(struct psmouse *psmouse)
1557{
1558	return __synaptics_init(psmouse, true);
1559}
1560
1561int synaptics_init_relative(struct psmouse *psmouse)
1562{
1563	return __synaptics_init(psmouse, false);
1564}
1565
1566#else /* CONFIG_MOUSE_PS2_SYNAPTICS */
1567
1568void __init synaptics_module_init(void)
1569{
1570}
1571
1572int synaptics_init(struct psmouse *psmouse)
1573{
1574	return -ENOSYS;
1575}
1576
1577#endif /* CONFIG_MOUSE_PS2_SYNAPTICS */
1578