xref: /linux/drivers/input/mouse/synaptics.c (revision cb299ba8b5ef2239429484072fea394cd7581bd7)
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/dmi.h>
28 #include <linux/input.h>
29 #include <linux/serio.h>
30 #include <linux/libps2.h>
31 #include <linux/slab.h>
32 #include "psmouse.h"
33 #include "synaptics.h"
34 
35 /*
36  * The x/y limits are taken from the Synaptics TouchPad interfacing Guide,
37  * section 2.3.2, which says that they should be valid regardless of the
38  * actual size of the sensor.
39  * Note that newer firmware allows querying device for maximum useable
40  * coordinates.
41  */
42 #define XMIN_NOMINAL 1472
43 #define XMAX_NOMINAL 5472
44 #define YMIN_NOMINAL 1408
45 #define YMAX_NOMINAL 4448
46 
47 
48 /*****************************************************************************
49  *	Stuff we need even when we do not want native Synaptics support
50  ****************************************************************************/
51 
52 /*
53  * Set the synaptics touchpad mode byte by special commands
54  */
55 static int synaptics_mode_cmd(struct psmouse *psmouse, unsigned char mode)
56 {
57 	unsigned char param[1];
58 
59 	if (psmouse_sliced_command(psmouse, mode))
60 		return -1;
61 	param[0] = SYN_PS_SET_MODE2;
62 	if (ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_SETRATE))
63 		return -1;
64 	return 0;
65 }
66 
67 int synaptics_detect(struct psmouse *psmouse, bool set_properties)
68 {
69 	struct ps2dev *ps2dev = &psmouse->ps2dev;
70 	unsigned char param[4];
71 
72 	param[0] = 0;
73 
74 	ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
75 	ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
76 	ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
77 	ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
78 	ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO);
79 
80 	if (param[1] != 0x47)
81 		return -ENODEV;
82 
83 	if (set_properties) {
84 		psmouse->vendor = "Synaptics";
85 		psmouse->name = "TouchPad";
86 	}
87 
88 	return 0;
89 }
90 
91 void synaptics_reset(struct psmouse *psmouse)
92 {
93 	/* reset touchpad back to relative mode, gestures enabled */
94 	synaptics_mode_cmd(psmouse, 0);
95 }
96 
97 #ifdef CONFIG_MOUSE_PS2_SYNAPTICS
98 
99 /*****************************************************************************
100  *	Synaptics communications functions
101  ****************************************************************************/
102 
103 /*
104  * Send a command to the synpatics touchpad by special commands
105  */
106 static int synaptics_send_cmd(struct psmouse *psmouse, unsigned char c, unsigned char *param)
107 {
108 	if (psmouse_sliced_command(psmouse, c))
109 		return -1;
110 	if (ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_GETINFO))
111 		return -1;
112 	return 0;
113 }
114 
115 /*
116  * Read the model-id bytes from the touchpad
117  * see also SYN_MODEL_* macros
118  */
119 static int synaptics_model_id(struct psmouse *psmouse)
120 {
121 	struct synaptics_data *priv = psmouse->private;
122 	unsigned char mi[3];
123 
124 	if (synaptics_send_cmd(psmouse, SYN_QUE_MODEL, mi))
125 		return -1;
126 	priv->model_id = (mi[0]<<16) | (mi[1]<<8) | mi[2];
127 	return 0;
128 }
129 
130 /*
131  * Read the capability-bits from the touchpad
132  * see also the SYN_CAP_* macros
133  */
134 static int synaptics_capability(struct psmouse *psmouse)
135 {
136 	struct synaptics_data *priv = psmouse->private;
137 	unsigned char cap[3];
138 
139 	if (synaptics_send_cmd(psmouse, SYN_QUE_CAPABILITIES, cap))
140 		return -1;
141 	priv->capabilities = (cap[0] << 16) | (cap[1] << 8) | cap[2];
142 	priv->ext_cap = priv->ext_cap_0c = 0;
143 
144 	/*
145 	 * Older firmwares had submodel ID fixed to 0x47
146 	 */
147 	if (SYN_ID_FULL(priv->identity) < 0x705 &&
148 	    SYN_CAP_SUBMODEL_ID(priv->capabilities) != 0x47) {
149 		return -1;
150 	}
151 
152 	/*
153 	 * Unless capExtended is set the rest of the flags should be ignored
154 	 */
155 	if (!SYN_CAP_EXTENDED(priv->capabilities))
156 		priv->capabilities = 0;
157 
158 	if (SYN_EXT_CAP_REQUESTS(priv->capabilities) >= 1) {
159 		if (synaptics_send_cmd(psmouse, SYN_QUE_EXT_CAPAB, cap)) {
160 			printk(KERN_ERR "Synaptics claims to have extended capabilities,"
161 			       " but I'm not able to read them.\n");
162 		} else {
163 			priv->ext_cap = (cap[0] << 16) | (cap[1] << 8) | cap[2];
164 
165 			/*
166 			 * if nExtBtn is greater than 8 it should be considered
167 			 * invalid and treated as 0
168 			 */
169 			if (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) > 8)
170 				priv->ext_cap &= 0xff0fff;
171 		}
172 	}
173 
174 	if (SYN_EXT_CAP_REQUESTS(priv->capabilities) >= 4) {
175 		if (synaptics_send_cmd(psmouse, SYN_QUE_EXT_CAPAB_0C, cap)) {
176 			printk(KERN_ERR "Synaptics claims to have extended capability 0x0c,"
177 			       " but I'm not able to read it.\n");
178 		} else {
179 			priv->ext_cap_0c = (cap[0] << 16) | (cap[1] << 8) | cap[2];
180 		}
181 	}
182 
183 	return 0;
184 }
185 
186 /*
187  * Identify Touchpad
188  * See also the SYN_ID_* macros
189  */
190 static int synaptics_identify(struct psmouse *psmouse)
191 {
192 	struct synaptics_data *priv = psmouse->private;
193 	unsigned char id[3];
194 
195 	if (synaptics_send_cmd(psmouse, SYN_QUE_IDENTIFY, id))
196 		return -1;
197 	priv->identity = (id[0]<<16) | (id[1]<<8) | id[2];
198 	if (SYN_ID_IS_SYNAPTICS(priv->identity))
199 		return 0;
200 	return -1;
201 }
202 
203 /*
204  * Read touchpad resolution and maximum reported coordinates
205  * Resolution is left zero if touchpad does not support the query
206  */
207 static int synaptics_resolution(struct psmouse *psmouse)
208 {
209 	struct synaptics_data *priv = psmouse->private;
210 	unsigned char res[3];
211 	unsigned char max[3];
212 
213 	if (SYN_ID_MAJOR(priv->identity) < 4)
214 		return 0;
215 
216 	if (synaptics_send_cmd(psmouse, SYN_QUE_RESOLUTION, res) == 0) {
217 		if (res[0] != 0 && (res[1] & 0x80) && res[2] != 0) {
218 			priv->x_res = res[0]; /* x resolution in units/mm */
219 			priv->y_res = res[2]; /* y resolution in units/mm */
220 		}
221 	}
222 
223 	if (SYN_EXT_CAP_REQUESTS(priv->capabilities) >= 5 &&
224 	    SYN_CAP_MAX_DIMENSIONS(priv->ext_cap_0c)) {
225 		if (synaptics_send_cmd(psmouse, SYN_QUE_EXT_DIMENSIONS, max)) {
226 			printk(KERN_ERR "Synaptics claims to have dimensions query,"
227 			       " but I'm not able to read it.\n");
228 		} else {
229 			priv->x_max = (max[0] << 5) | ((max[1] & 0x0f) << 1);
230 			priv->y_max = (max[2] << 5) | ((max[1] & 0xf0) >> 3);
231 		}
232 	}
233 
234 	return 0;
235 }
236 
237 static int synaptics_query_hardware(struct psmouse *psmouse)
238 {
239 	if (synaptics_identify(psmouse))
240 		return -1;
241 	if (synaptics_model_id(psmouse))
242 		return -1;
243 	if (synaptics_capability(psmouse))
244 		return -1;
245 	if (synaptics_resolution(psmouse))
246 		return -1;
247 
248 	return 0;
249 }
250 
251 static int synaptics_set_absolute_mode(struct psmouse *psmouse)
252 {
253 	struct synaptics_data *priv = psmouse->private;
254 
255 	priv->mode = SYN_BIT_ABSOLUTE_MODE;
256 	if (SYN_ID_MAJOR(priv->identity) >= 4)
257 		priv->mode |= SYN_BIT_DISABLE_GESTURE;
258 	if (SYN_CAP_EXTENDED(priv->capabilities))
259 		priv->mode |= SYN_BIT_W_MODE;
260 
261 	if (synaptics_mode_cmd(psmouse, priv->mode))
262 		return -1;
263 
264 	return 0;
265 }
266 
267 static void synaptics_set_rate(struct psmouse *psmouse, unsigned int rate)
268 {
269 	struct synaptics_data *priv = psmouse->private;
270 
271 	if (rate >= 80) {
272 		priv->mode |= SYN_BIT_HIGH_RATE;
273 		psmouse->rate = 80;
274 	} else {
275 		priv->mode &= ~SYN_BIT_HIGH_RATE;
276 		psmouse->rate = 40;
277 	}
278 
279 	synaptics_mode_cmd(psmouse, priv->mode);
280 }
281 
282 /*****************************************************************************
283  *	Synaptics pass-through PS/2 port support
284  ****************************************************************************/
285 static int synaptics_pt_write(struct serio *serio, unsigned char c)
286 {
287 	struct psmouse *parent = serio_get_drvdata(serio->parent);
288 	char rate_param = SYN_PS_CLIENT_CMD; /* indicates that we want pass-through port */
289 
290 	if (psmouse_sliced_command(parent, c))
291 		return -1;
292 	if (ps2_command(&parent->ps2dev, &rate_param, PSMOUSE_CMD_SETRATE))
293 		return -1;
294 	return 0;
295 }
296 
297 static int synaptics_pt_start(struct serio *serio)
298 {
299 	struct psmouse *parent = serio_get_drvdata(serio->parent);
300 	struct synaptics_data *priv = parent->private;
301 
302 	serio_pause_rx(parent->ps2dev.serio);
303 	priv->pt_port = serio;
304 	serio_continue_rx(parent->ps2dev.serio);
305 
306 	return 0;
307 }
308 
309 static void synaptics_pt_stop(struct serio *serio)
310 {
311 	struct psmouse *parent = serio_get_drvdata(serio->parent);
312 	struct synaptics_data *priv = parent->private;
313 
314 	serio_pause_rx(parent->ps2dev.serio);
315 	priv->pt_port = NULL;
316 	serio_continue_rx(parent->ps2dev.serio);
317 }
318 
319 static int synaptics_is_pt_packet(unsigned char *buf)
320 {
321 	return (buf[0] & 0xFC) == 0x84 && (buf[3] & 0xCC) == 0xC4;
322 }
323 
324 static void synaptics_pass_pt_packet(struct serio *ptport, unsigned char *packet)
325 {
326 	struct psmouse *child = serio_get_drvdata(ptport);
327 
328 	if (child && child->state == PSMOUSE_ACTIVATED) {
329 		serio_interrupt(ptport, packet[1], 0);
330 		serio_interrupt(ptport, packet[4], 0);
331 		serio_interrupt(ptport, packet[5], 0);
332 		if (child->pktsize == 4)
333 			serio_interrupt(ptport, packet[2], 0);
334 	} else
335 		serio_interrupt(ptport, packet[1], 0);
336 }
337 
338 static void synaptics_pt_activate(struct psmouse *psmouse)
339 {
340 	struct synaptics_data *priv = psmouse->private;
341 	struct psmouse *child = serio_get_drvdata(priv->pt_port);
342 
343 	/* adjust the touchpad to child's choice of protocol */
344 	if (child) {
345 		if (child->pktsize == 4)
346 			priv->mode |= SYN_BIT_FOUR_BYTE_CLIENT;
347 		else
348 			priv->mode &= ~SYN_BIT_FOUR_BYTE_CLIENT;
349 
350 		if (synaptics_mode_cmd(psmouse, priv->mode))
351 			printk(KERN_INFO "synaptics: failed to switch guest protocol\n");
352 	}
353 }
354 
355 static void synaptics_pt_create(struct psmouse *psmouse)
356 {
357 	struct serio *serio;
358 
359 	serio = kzalloc(sizeof(struct serio), GFP_KERNEL);
360 	if (!serio) {
361 		printk(KERN_ERR "synaptics: not enough memory to allocate pass-through port\n");
362 		return;
363 	}
364 
365 	serio->id.type = SERIO_PS_PSTHRU;
366 	strlcpy(serio->name, "Synaptics pass-through", sizeof(serio->name));
367 	strlcpy(serio->phys, "synaptics-pt/serio0", sizeof(serio->name));
368 	serio->write = synaptics_pt_write;
369 	serio->start = synaptics_pt_start;
370 	serio->stop = synaptics_pt_stop;
371 	serio->parent = psmouse->ps2dev.serio;
372 
373 	psmouse->pt_activate = synaptics_pt_activate;
374 
375 	printk(KERN_INFO "serio: %s port at %s\n", serio->name, psmouse->phys);
376 	serio_register_port(serio);
377 }
378 
379 /*****************************************************************************
380  *	Functions to interpret the absolute mode packets
381  ****************************************************************************/
382 
383 static void synaptics_parse_hw_state(unsigned char buf[], struct synaptics_data *priv, struct synaptics_hw_state *hw)
384 {
385 	memset(hw, 0, sizeof(struct synaptics_hw_state));
386 
387 	if (SYN_MODEL_NEWABS(priv->model_id)) {
388 		hw->x = (((buf[3] & 0x10) << 8) |
389 			 ((buf[1] & 0x0f) << 8) |
390 			 buf[4]);
391 		hw->y = (((buf[3] & 0x20) << 7) |
392 			 ((buf[1] & 0xf0) << 4) |
393 			 buf[5]);
394 
395 		hw->z = buf[2];
396 		hw->w = (((buf[0] & 0x30) >> 2) |
397 			 ((buf[0] & 0x04) >> 1) |
398 			 ((buf[3] & 0x04) >> 2));
399 
400 		hw->left  = (buf[0] & 0x01) ? 1 : 0;
401 		hw->right = (buf[0] & 0x02) ? 1 : 0;
402 
403 		if (SYN_CAP_CLICKPAD(priv->ext_cap_0c)) {
404 			/*
405 			 * Clickpad's button is transmitted as middle button,
406 			 * however, since it is primary button, we will report
407 			 * it as BTN_LEFT.
408 			 */
409 			hw->left = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
410 
411 		} else if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities)) {
412 			hw->middle = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
413 			if (hw->w == 2)
414 				hw->scroll = (signed char)(buf[1]);
415 		}
416 
417 		if (SYN_CAP_FOUR_BUTTON(priv->capabilities)) {
418 			hw->up   = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
419 			hw->down = ((buf[0] ^ buf[3]) & 0x02) ? 1 : 0;
420 		}
421 
422 		if (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) &&
423 		    ((buf[0] ^ buf[3]) & 0x02)) {
424 			switch (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) & ~0x01) {
425 			default:
426 				/*
427 				 * if nExtBtn is greater than 8 it should be
428 				 * considered invalid and treated as 0
429 				 */
430 				break;
431 			case 8:
432 				hw->ext_buttons |= ((buf[5] & 0x08)) ? 0x80 : 0;
433 				hw->ext_buttons |= ((buf[4] & 0x08)) ? 0x40 : 0;
434 			case 6:
435 				hw->ext_buttons |= ((buf[5] & 0x04)) ? 0x20 : 0;
436 				hw->ext_buttons |= ((buf[4] & 0x04)) ? 0x10 : 0;
437 			case 4:
438 				hw->ext_buttons |= ((buf[5] & 0x02)) ? 0x08 : 0;
439 				hw->ext_buttons |= ((buf[4] & 0x02)) ? 0x04 : 0;
440 			case 2:
441 				hw->ext_buttons |= ((buf[5] & 0x01)) ? 0x02 : 0;
442 				hw->ext_buttons |= ((buf[4] & 0x01)) ? 0x01 : 0;
443 			}
444 		}
445 	} else {
446 		hw->x = (((buf[1] & 0x1f) << 8) | buf[2]);
447 		hw->y = (((buf[4] & 0x1f) << 8) | buf[5]);
448 
449 		hw->z = (((buf[0] & 0x30) << 2) | (buf[3] & 0x3F));
450 		hw->w = (((buf[1] & 0x80) >> 4) | ((buf[0] & 0x04) >> 1));
451 
452 		hw->left  = (buf[0] & 0x01) ? 1 : 0;
453 		hw->right = (buf[0] & 0x02) ? 1 : 0;
454 	}
455 }
456 
457 /*
458  *  called for each full received packet from the touchpad
459  */
460 static void synaptics_process_packet(struct psmouse *psmouse)
461 {
462 	struct input_dev *dev = psmouse->dev;
463 	struct synaptics_data *priv = psmouse->private;
464 	struct synaptics_hw_state hw;
465 	int num_fingers;
466 	int finger_width;
467 	int i;
468 
469 	synaptics_parse_hw_state(psmouse->packet, priv, &hw);
470 
471 	if (hw.scroll) {
472 		priv->scroll += hw.scroll;
473 
474 		while (priv->scroll >= 4) {
475 			input_report_key(dev, BTN_BACK, !hw.down);
476 			input_sync(dev);
477 			input_report_key(dev, BTN_BACK, hw.down);
478 			input_sync(dev);
479 			priv->scroll -= 4;
480 		}
481 		while (priv->scroll <= -4) {
482 			input_report_key(dev, BTN_FORWARD, !hw.up);
483 			input_sync(dev);
484 			input_report_key(dev, BTN_FORWARD, hw.up);
485 			input_sync(dev);
486 			priv->scroll += 4;
487 		}
488 		return;
489 	}
490 
491 	if (hw.z > 0) {
492 		num_fingers = 1;
493 		finger_width = 5;
494 		if (SYN_CAP_EXTENDED(priv->capabilities)) {
495 			switch (hw.w) {
496 			case 0 ... 1:
497 				if (SYN_CAP_MULTIFINGER(priv->capabilities))
498 					num_fingers = hw.w + 2;
499 				break;
500 			case 2:
501 				if (SYN_MODEL_PEN(priv->model_id))
502 					;   /* Nothing, treat a pen as a single finger */
503 				break;
504 			case 4 ... 15:
505 				if (SYN_CAP_PALMDETECT(priv->capabilities))
506 					finger_width = hw.w;
507 				break;
508 			}
509 		}
510 	} else {
511 		num_fingers = 0;
512 		finger_width = 0;
513 	}
514 
515 	/* Post events
516 	 * BTN_TOUCH has to be first as mousedev relies on it when doing
517 	 * absolute -> relative conversion
518 	 */
519 	if (hw.z > 30) input_report_key(dev, BTN_TOUCH, 1);
520 	if (hw.z < 25) input_report_key(dev, BTN_TOUCH, 0);
521 
522 	if (hw.z > 0) {
523 		input_report_abs(dev, ABS_X, hw.x);
524 		input_report_abs(dev, ABS_Y, YMAX_NOMINAL + YMIN_NOMINAL - hw.y);
525 	}
526 	input_report_abs(dev, ABS_PRESSURE, hw.z);
527 
528 	if (SYN_CAP_PALMDETECT(priv->capabilities))
529 		input_report_abs(dev, ABS_TOOL_WIDTH, finger_width);
530 
531 	input_report_key(dev, BTN_TOOL_FINGER, num_fingers == 1);
532 	input_report_key(dev, BTN_LEFT, hw.left);
533 	input_report_key(dev, BTN_RIGHT, hw.right);
534 
535 	if (SYN_CAP_MULTIFINGER(priv->capabilities)) {
536 		input_report_key(dev, BTN_TOOL_DOUBLETAP, num_fingers == 2);
537 		input_report_key(dev, BTN_TOOL_TRIPLETAP, num_fingers == 3);
538 	}
539 
540 	if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities))
541 		input_report_key(dev, BTN_MIDDLE, hw.middle);
542 
543 	if (SYN_CAP_FOUR_BUTTON(priv->capabilities)) {
544 		input_report_key(dev, BTN_FORWARD, hw.up);
545 		input_report_key(dev, BTN_BACK, hw.down);
546 	}
547 
548 	for (i = 0; i < SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap); i++)
549 		input_report_key(dev, BTN_0 + i, hw.ext_buttons & (1 << i));
550 
551 	input_sync(dev);
552 }
553 
554 static int synaptics_validate_byte(unsigned char packet[], int idx, unsigned char pkt_type)
555 {
556 	static const unsigned char newabs_mask[]	= { 0xC8, 0x00, 0x00, 0xC8, 0x00 };
557 	static const unsigned char newabs_rel_mask[]	= { 0xC0, 0x00, 0x00, 0xC0, 0x00 };
558 	static const unsigned char newabs_rslt[]	= { 0x80, 0x00, 0x00, 0xC0, 0x00 };
559 	static const unsigned char oldabs_mask[]	= { 0xC0, 0x60, 0x00, 0xC0, 0x60 };
560 	static const unsigned char oldabs_rslt[]	= { 0xC0, 0x00, 0x00, 0x80, 0x00 };
561 
562 	if (idx < 0 || idx > 4)
563 		return 0;
564 
565 	switch (pkt_type) {
566 
567 	case SYN_NEWABS:
568 	case SYN_NEWABS_RELAXED:
569 		return (packet[idx] & newabs_rel_mask[idx]) == newabs_rslt[idx];
570 
571 	case SYN_NEWABS_STRICT:
572 		return (packet[idx] & newabs_mask[idx]) == newabs_rslt[idx];
573 
574 	case SYN_OLDABS:
575 		return (packet[idx] & oldabs_mask[idx]) == oldabs_rslt[idx];
576 
577 	default:
578 		printk(KERN_ERR "synaptics: unknown packet type %d\n", pkt_type);
579 		return 0;
580 	}
581 }
582 
583 static unsigned char synaptics_detect_pkt_type(struct psmouse *psmouse)
584 {
585 	int i;
586 
587 	for (i = 0; i < 5; i++)
588 		if (!synaptics_validate_byte(psmouse->packet, i, SYN_NEWABS_STRICT)) {
589 			printk(KERN_INFO "synaptics: using relaxed packet validation\n");
590 			return SYN_NEWABS_RELAXED;
591 		}
592 
593 	return SYN_NEWABS_STRICT;
594 }
595 
596 static psmouse_ret_t synaptics_process_byte(struct psmouse *psmouse)
597 {
598 	struct synaptics_data *priv = psmouse->private;
599 
600 	if (psmouse->pktcnt >= 6) { /* Full packet received */
601 		if (unlikely(priv->pkt_type == SYN_NEWABS))
602 			priv->pkt_type = synaptics_detect_pkt_type(psmouse);
603 
604 		if (SYN_CAP_PASS_THROUGH(priv->capabilities) &&
605 		    synaptics_is_pt_packet(psmouse->packet)) {
606 			if (priv->pt_port)
607 				synaptics_pass_pt_packet(priv->pt_port, psmouse->packet);
608 		} else
609 			synaptics_process_packet(psmouse);
610 
611 		return PSMOUSE_FULL_PACKET;
612 	}
613 
614 	return synaptics_validate_byte(psmouse->packet, psmouse->pktcnt - 1, priv->pkt_type) ?
615 		PSMOUSE_GOOD_DATA : PSMOUSE_BAD_DATA;
616 }
617 
618 /*****************************************************************************
619  *	Driver initialization/cleanup functions
620  ****************************************************************************/
621 static void set_input_params(struct input_dev *dev, struct synaptics_data *priv)
622 {
623 	int i;
624 
625 	__set_bit(EV_ABS, dev->evbit);
626 	input_set_abs_params(dev, ABS_X,
627 			     XMIN_NOMINAL, priv->x_max ?: XMAX_NOMINAL, 0, 0);
628 	input_set_abs_params(dev, ABS_Y,
629 			     YMIN_NOMINAL, priv->y_max ?: YMAX_NOMINAL, 0, 0);
630 	input_set_abs_params(dev, ABS_PRESSURE, 0, 255, 0, 0);
631 
632 	if (SYN_CAP_PALMDETECT(priv->capabilities))
633 		input_set_abs_params(dev, ABS_TOOL_WIDTH, 0, 15, 0, 0);
634 
635 	__set_bit(EV_KEY, dev->evbit);
636 	__set_bit(BTN_TOUCH, dev->keybit);
637 	__set_bit(BTN_TOOL_FINGER, dev->keybit);
638 	__set_bit(BTN_LEFT, dev->keybit);
639 	__set_bit(BTN_RIGHT, dev->keybit);
640 
641 	if (SYN_CAP_MULTIFINGER(priv->capabilities)) {
642 		__set_bit(BTN_TOOL_DOUBLETAP, dev->keybit);
643 		__set_bit(BTN_TOOL_TRIPLETAP, dev->keybit);
644 	}
645 
646 	if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities))
647 		__set_bit(BTN_MIDDLE, dev->keybit);
648 
649 	if (SYN_CAP_FOUR_BUTTON(priv->capabilities) ||
650 	    SYN_CAP_MIDDLE_BUTTON(priv->capabilities)) {
651 		__set_bit(BTN_FORWARD, dev->keybit);
652 		__set_bit(BTN_BACK, dev->keybit);
653 	}
654 
655 	for (i = 0; i < SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap); i++)
656 		__set_bit(BTN_0 + i, dev->keybit);
657 
658 	__clear_bit(EV_REL, dev->evbit);
659 	__clear_bit(REL_X, dev->relbit);
660 	__clear_bit(REL_Y, dev->relbit);
661 
662 	input_abs_set_res(dev, ABS_X, priv->x_res);
663 	input_abs_set_res(dev, ABS_Y, priv->y_res);
664 
665 	if (SYN_CAP_CLICKPAD(priv->ext_cap_0c)) {
666 		/* Clickpads report only left button */
667 		__clear_bit(BTN_RIGHT, dev->keybit);
668 		__clear_bit(BTN_MIDDLE, dev->keybit);
669 	}
670 }
671 
672 static void synaptics_disconnect(struct psmouse *psmouse)
673 {
674 	synaptics_reset(psmouse);
675 	kfree(psmouse->private);
676 	psmouse->private = NULL;
677 }
678 
679 static int synaptics_reconnect(struct psmouse *psmouse)
680 {
681 	struct synaptics_data *priv = psmouse->private;
682 	struct synaptics_data old_priv = *priv;
683 
684 	psmouse_reset(psmouse);
685 
686 	if (synaptics_detect(psmouse, 0))
687 		return -1;
688 
689 	if (synaptics_query_hardware(psmouse)) {
690 		printk(KERN_ERR "Unable to query Synaptics hardware.\n");
691 		return -1;
692 	}
693 
694 	if (old_priv.identity != priv->identity ||
695 	    old_priv.model_id != priv->model_id ||
696 	    old_priv.capabilities != priv->capabilities ||
697 	    old_priv.ext_cap != priv->ext_cap)
698 		return -1;
699 
700 	if (synaptics_set_absolute_mode(psmouse)) {
701 		printk(KERN_ERR "Unable to initialize Synaptics hardware.\n");
702 		return -1;
703 	}
704 
705 	return 0;
706 }
707 
708 static bool impaired_toshiba_kbc;
709 
710 static const struct dmi_system_id __initconst toshiba_dmi_table[] = {
711 #if defined(CONFIG_DMI) && defined(CONFIG_X86)
712 	{
713 		/* Toshiba Satellite */
714 		.matches = {
715 			DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
716 			DMI_MATCH(DMI_PRODUCT_NAME, "Satellite"),
717 		},
718 	},
719 	{
720 		/* Toshiba Dynabook */
721 		.matches = {
722 			DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
723 			DMI_MATCH(DMI_PRODUCT_NAME, "dynabook"),
724 		},
725 	},
726 	{
727 		/* Toshiba Portege M300 */
728 		.matches = {
729 			DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
730 			DMI_MATCH(DMI_PRODUCT_NAME, "PORTEGE M300"),
731 		},
732 
733 	},
734 	{
735 		/* Toshiba Portege M300 */
736 		.matches = {
737 			DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
738 			DMI_MATCH(DMI_PRODUCT_NAME, "Portable PC"),
739 			DMI_MATCH(DMI_PRODUCT_VERSION, "Version 1.0"),
740 		},
741 
742 	},
743 	{ }
744 #endif
745 };
746 
747 void __init synaptics_module_init(void)
748 {
749 	impaired_toshiba_kbc = dmi_check_system(toshiba_dmi_table);
750 }
751 
752 int synaptics_init(struct psmouse *psmouse)
753 {
754 	struct synaptics_data *priv;
755 
756 	psmouse->private = priv = kzalloc(sizeof(struct synaptics_data), GFP_KERNEL);
757 	if (!priv)
758 		return -ENOMEM;
759 
760 	psmouse_reset(psmouse);
761 
762 	if (synaptics_query_hardware(psmouse)) {
763 		printk(KERN_ERR "Unable to query Synaptics hardware.\n");
764 		goto init_fail;
765 	}
766 
767 	if (synaptics_set_absolute_mode(psmouse)) {
768 		printk(KERN_ERR "Unable to initialize Synaptics hardware.\n");
769 		goto init_fail;
770 	}
771 
772 	priv->pkt_type = SYN_MODEL_NEWABS(priv->model_id) ? SYN_NEWABS : SYN_OLDABS;
773 
774 	printk(KERN_INFO "Synaptics Touchpad, model: %ld, fw: %ld.%ld, id: %#lx, caps: %#lx/%#lx/%#lx\n",
775 		SYN_ID_MODEL(priv->identity),
776 		SYN_ID_MAJOR(priv->identity), SYN_ID_MINOR(priv->identity),
777 		priv->model_id, priv->capabilities, priv->ext_cap, priv->ext_cap_0c);
778 
779 	set_input_params(psmouse->dev, priv);
780 
781 	/*
782 	 * Encode touchpad model so that it can be used to set
783 	 * input device->id.version and be visible to userspace.
784 	 * Because version is __u16 we have to drop something.
785 	 * Hardware info bits seem to be good candidates as they
786 	 * are documented to be for Synaptics corp. internal use.
787 	 */
788 	psmouse->model = ((priv->model_id & 0x00ff0000) >> 8) |
789 			  (priv->model_id & 0x000000ff);
790 
791 	psmouse->protocol_handler = synaptics_process_byte;
792 	psmouse->set_rate = synaptics_set_rate;
793 	psmouse->disconnect = synaptics_disconnect;
794 	psmouse->reconnect = synaptics_reconnect;
795 	psmouse->cleanup = synaptics_reset;
796 	psmouse->pktsize = 6;
797 	/* Synaptics can usually stay in sync without extra help */
798 	psmouse->resync_time = 0;
799 
800 	if (SYN_CAP_PASS_THROUGH(priv->capabilities))
801 		synaptics_pt_create(psmouse);
802 
803 	/*
804 	 * Toshiba's KBC seems to have trouble handling data from
805 	 * Synaptics as full rate, switch to lower rate which is roughly
806 	 * thye same as rate of standard PS/2 mouse.
807 	 */
808 	if (psmouse->rate >= 80 && impaired_toshiba_kbc) {
809 		printk(KERN_INFO "synaptics: Toshiba %s detected, limiting rate to 40pps.\n",
810 			dmi_get_system_info(DMI_PRODUCT_NAME));
811 		psmouse->rate = 40;
812 	}
813 
814 	return 0;
815 
816  init_fail:
817 	kfree(priv);
818 	return -1;
819 }
820 
821 bool synaptics_supported(void)
822 {
823 	return true;
824 }
825 
826 #else /* CONFIG_MOUSE_PS2_SYNAPTICS */
827 
828 void __init synaptics_module_init(void)
829 {
830 }
831 
832 int synaptics_init(struct psmouse *psmouse)
833 {
834 	return -ENOSYS;
835 }
836 
837 bool synaptics_supported(void)
838 {
839 	return false;
840 }
841 
842 #endif /* CONFIG_MOUSE_PS2_SYNAPTICS */
843 
844