Linux Audio

Check our new training course

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