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