Loading...
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, ¶m, 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 */